Initial commit.

APRSTransmit/APRSTransmit.cpp

@@ -0,0 +1,174 @@
+/*
+ *   Copyright (C) 2014 by Jonathan Naylor G4KLX
+ *   APRSTransmit Copyright (C) 2015 Geoffrey Merck F4FXL / KC3FRA
+ *
+ *   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 "SlowDataEncoder.h"
+#include "DStarDefines.h"
+#include "APRSTransmit.h"
+#include "APRSParser.h"
+
+
+CAPRSTransmit::CAPRSTransmit(const wxString& callsign, const wxString& text) :
+m_socket(wxEmptyString, 0U),
+m_repeaterCallsign(callsign),
+m_APRSCallsign(callsign),
+m_text(text)
+{
+	int index = m_text.Find(wxT(">"));
+	if(index != wxNOT_FOUND)
+		m_APRSCallsign = m_text.Left(index);
+}
+
+CAPRSTransmit::~CAPRSTransmit()
+{
+}
+
+bool CAPRSTransmit::run()
+{
+	//First see if the packet is Icom supported...
+	CAPRSPacket aprsPacket;
+	if(!CAPRSParser::Parse(m_text, aprsPacket)){
+		wxLogWarning(wxT("Unsupported APRS Format, ignoring => ") + m_text.Trim(true));
+		return false;
+	}
+
+	wxString textWithCRC(aprsPacket.Raw());
+	wxLogMessage(wxT("Supported APRS Format => ") + textWithCRC.Trim(true));
+	//add nececessary stuff to text, but keep it the original
+	textWithCRC.Replace(wxT("\n"), wxEmptyString);
+	if(!textWithCRC.EndsWith(wxT("\r"))) textWithCRC.Append(wxT("\r"));
+	wxString crc = wxString::Format(wxT("$$CRC%04X,"), calcCRC(textWithCRC));
+	textWithCRC.Prepend(crc);
+
+	bool opened = m_socket.open();
+	if (!opened)
+		return false;
+
+	in_addr address = CUDPReaderWriter::lookup(wxT("127.0.0.1"));
+
+	unsigned int id = CHeaderData::createId();
+
+	wxString callsignG = m_repeaterCallsign.Left(LONG_CALLSIGN_LENGTH - 1U);
+	callsignG.Append(wxT("G"));
+
+	CHeaderData header;
+	header.setId(id);
+	header.setMyCall1(m_APRSCallsign);
+	header.setMyCall2(wxT("APRS"));
+	header.setRptCall1(callsignG);
+	header.setRptCall2(m_repeaterCallsign);
+	header.setYourCall(wxT("CQCQCQ  "));
+	header.setDestination(address, G2_DV_PORT);
+
+	sendHeader(header);
+
+	CSlowDataEncoder encoder;
+	encoder.setHeaderData(header);
+	encoder.setGPSData(textWithCRC);
+	encoder.setTextData(wxT("APRS to DPRS"));
+
+	CAMBEData data;
+	data.setDestination(address, G2_DV_PORT);
+	data.setId(id);
+
+	wxStopWatch timer;
+	timer.Start();
+
+	unsigned int out = 0U;
+        unsigned int dataOut = 0U;
+	unsigned int needed = (encoder.getInterleavedDataLength() / (DATA_FRAME_LENGTH_BYTES)) * 2U;
+
+	while (dataOut < needed) {
+		data.setSeq(out);
+
+		unsigned char buffer[DV_FRAME_LENGTH_BYTES];
+		::memcpy(buffer + 0U, NULL_AMBE_DATA_BYTES, VOICE_FRAME_LENGTH_BYTES);
+
+		// Insert sync bytes when the sequence number is zero, slow data otherwise
+		if (out == 0U) {
+			::memcpy(buffer + VOICE_FRAME_LENGTH_BYTES, DATA_SYNC_BYTES, DATA_FRAME_LENGTH_BYTES);
+		} else {
+			encoder.getInterleavedData(buffer + VOICE_FRAME_LENGTH_BYTES);		
+			dataOut++;
+		}
+
+		data.setData(buffer, DV_FRAME_LENGTH_BYTES);
+
+		sendData(data);
+		out++;
+
+		if (out == 21U) out = 0U;
+	}
+
+	data.setData(END_PATTERN_BYTES, DV_FRAME_LENGTH_BYTES);
+	data.setSeq(out >= 21U ? 0U : out);
+	data.setEnd(true);
+
+	sendData(data);
+
+	m_socket.close();
+
+	return true;
+}
+
+bool CAPRSTransmit::sendHeader(const CHeaderData& header)
+{
+	unsigned char buffer[60U];
+	unsigned int length = header.getG2Data(buffer, 60U, true);
+
+	for (unsigned int i = 0U; i < 2U; i++) {
+		bool res = m_socket.write(buffer, length, header.getYourAddress(), header.getYourPort());
+		if (!res)
+			return false;
+	}
+
+	return true;
+}
+
+bool CAPRSTransmit::sendData(const CAMBEData& data)
+{
+	unsigned char buffer[60U];
+	unsigned int length = data.getG2Data(buffer, 60U);
+
+	return m_socket.write(buffer, length, data.getYourAddress(), data.getYourPort());
+}
+
+unsigned int CAPRSTransmit::calcCRC(const wxString& gpsData)
+{
+	size_t length = gpsData.length();
+	wxASSERT(length > 0U);
+
+	unsigned int icomcrc = 0xFFFFU;
+
+	for (unsigned int j = 0U; j < length; j++) {
+		unsigned char ch = gpsData.GetChar(j);
+
+		for (unsigned int i = 0U; i < 8U; i++) {
+			bool xorflag = (((icomcrc ^ ch) & 0x01U) == 0x01U);
+
+			icomcrc >>= 1;
+
+			if (xorflag)
+				icomcrc ^= 0x8408U;
+
+			ch >>= 1;
+		} 
+	}
+
+	return ~icomcrc & 0xFFFFU;
+}