Initial commit.

DAPNETNetwork.cpp

@@ -0,0 +1,176 @@
+/*
+ *   Copyright (C) 2018 by Jonathan Naylor G4KLX
+ *
+ *   This program is free software; you can redistribute it and/or modify
+ *   it under the terms of the GNU General Public License as published by
+ *   the Free Software Foundation; either version 2 of the License, or
+ *   (at your option) any later version.
+ *
+ *   This program is distributed in the hope that it will be useful,
+ *   but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *   GNU General Public License for more details.
+ *
+ *   You should have received a copy of the GNU General Public License
+ *   along with this program; if not, write to the Free Software
+ *   Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
+ */
+
+#include "DAPNETNetwork.h"
+#include "Thread.h"
+#include "Utils.h"
+#include "Log.h"
+
+#include <cstdio>
+#include <cassert>
+#include <cstring>
+
+const unsigned int BUFFER_LENGTH = 200U;
+
+CDAPNETNetwork::CDAPNETNetwork(const std::string& address, unsigned int port, const std::string& callsign, const std::string& authKey, const char* version, bool debug) :
+m_socket(address, port),
+m_callsign(callsign),
+m_authKey(authKey),
+m_version(version),
+m_debug(debug),
+m_message(NULL)
+{
+	assert(!callsign.empty());
+	assert(!authKey.empty());
+	assert(version != NULL);
+}
+
+CDAPNETNetwork::~CDAPNETNetwork()
+{
+	delete m_message;
+}
+
+bool CDAPNETNetwork::open()
+{
+	LogMessage("Opening DAPNET connection");
+
+	return m_socket.open();
+}
+
+bool CDAPNETNetwork::login()
+{
+	LogMessage("Logging into DAPNET");
+
+	char login[200U];
+	::snprintf(login, 200, "[MMDVM %s %s %s]\r\n", m_version, m_callsign.c_str(), m_authKey.c_str());
+
+	return write((unsigned char*)login);
+}
+
+bool CDAPNETNetwork::read()
+{
+	unsigned char buffer[BUFFER_LENGTH];
+
+	int length = m_socket.read(buffer, BUFFER_LENGTH, 0U);
+	if (length < 0)
+		return false;
+	if (length == 0)
+		return true;
+
+	if (m_debug)
+		CUtils::dump(1U, "DAPNET Data Received", buffer, length);
+
+	// Turn it into a C string
+	buffer[length] = 0x00U;
+
+	if (buffer[0U] == '+') {
+		// Success
+		return true;
+	} else if (buffer[0U] == '-') {
+		// Error
+		LogWarning("An error has been reported by DAPNET");
+		return true;
+	} else if (buffer[0U] == '2') {
+		// Time synchronisation
+		char* p = ::strchr((char*)buffer, '\r');
+		if (p != NULL)
+			::strcpy(p, ":0000\r\n");
+		else
+			::strcat((char*)buffer, ":0000\r\n");
+
+		bool ok = write(buffer);
+		if (!ok)
+			return false;
+
+		return write((unsigned char*)"+\r\n");
+	} else if (buffer[0U] == '3') {
+		// ???
+		return write((unsigned char*)"+\r\n");
+	} else if (buffer[0U] == '4') {
+		// Timeslot information
+		return write((unsigned char*)"+\r\n");
+	} else if (buffer[0U] == '#') {
+		// A message
+		unsigned long id = ::strtoul((char*)buffer + 1U, NULL, 16);
+
+		char* p1 = ::strtok((char*)buffer + 4U, ":\r\n");
+		char* p2 = ::strtok(NULL, ":\r\n");
+		char* p3 = ::strtok(NULL, ":\r\n");
+		char* p4 = ::strtok(NULL, ":\r\n");
+		char* p5 = ::strtok(NULL, ":\r\n");
+
+		if (p1 == NULL || p2 == NULL || p3 == NULL || p4 == NULL || p5 == NULL) {
+			CUtils::dump(3U, "Received a malformed message from DAPNET", buffer, length);
+
+			id = (id + 1U) % 256UL;
+
+			char reply[20U];
+			::snprintf(reply, 20U, "#%02X -\r\n", id);
+			return write((unsigned char*)reply);
+		} else {
+			unsigned int type  = ::strtoul(p1, NULL, 10);
+			unsigned int speed = ::strtoul(p2, NULL, 10);
+			unsigned int addr  = ::strtoul(p3, NULL, 10);
+			unsigned int func  = ::strtoul(p4, NULL, 10);
+
+			m_message = new CPOCSAGMessage(type == 1U ? TYPE_ALPHA_NUMERIC : TYPE_NUMERIC, addr, func, (unsigned char*)p5, ::strlen(p5));
+
+			id = (id + 1U) % 256UL;
+
+			char reply[20U];
+			::snprintf(reply, 20U, "#%02X +\r\n", id);
+			return write((unsigned char*)reply);
+		}
+	} else {
+		CUtils::dump(3U, "An unknown message from DAPNET", buffer, length);
+		return write((unsigned char*)"-\r\n");
+	}
+
+	return true;
+}
+
+CPOCSAGMessage* CDAPNETNetwork::readMessage()
+{
+	if (m_message == NULL)
+		return NULL;
+
+	CPOCSAGMessage* message = m_message;
+
+	m_message = NULL;
+
+	return message;
+}
+
+void CDAPNETNetwork::close()
+{
+	m_socket.close();
+
+	LogMessage("Closing DAPNET connection");
+}
+
+bool CDAPNETNetwork::write(unsigned char* data)
+{
+	assert(data != NULL);
+
+	unsigned int length = ::strlen((char*)data);
+
+	if (m_debug)
+		CUtils::dump(1U, "DAPNET data Transmitted", data, length);
+
+	return m_socket.write(data, length);
+}