void CVersionUnit::clock(unsigned int ms)
{
m_timer.clock(ms);
if (m_status == VS_WAIT && m_timer.hasExpired()) {
m_timer.stop();
// RPT1 and RPT2 will be filled in later
CHeaderData header;
header.setMyCall1(m_callsign);
header.setMyCall2(wxT("VERS"));
header.setYourCall(wxT("CQCQCQ "));
header.setId(m_id);
m_handler->process(header, DIR_INCOMING, AS_VERSION);
m_out = 0U;
m_status = VS_TRANSMIT;
m_time.Start();
return;
}
if (m_status == VS_TRANSMIT) {
unsigned int needed = m_time.Time() / DSTAR_FRAME_TIME_MS;
while (m_out < needed) {
CAMBEData* data = m_data[m_out];
data->setId(m_id);
m_out++;
m_handler->process(*data, DIR_INCOMING, AS_VERSION);
if (m_out == NUM_FRAMES) {
m_out = 0U;
m_status = VS_IDLE;
return;
}
}
return;
}
}
void CStarNetHandler::sendAck(const CUserData& user, const wxString& text) const
{
unsigned int id = CHeaderData::createId();
CHeaderData header(m_groupCallsign, wxT(" "), user.getUser(), user.getGateway(), user.getRepeater());
header.setDestination(user.getAddress(), G2_DV_PORT);
header.setId(id);
m_g2Handler->writeHeader(header);
CSlowDataEncoder slowData;
slowData.setTextData(text);
CAMBEData data;
data.setId(id);
data.setDestination(user.getAddress(), G2_DV_PORT);
unsigned char buffer[DV_FRAME_MAX_LENGTH_BYTES];
::memcpy(buffer + 0U, NULL_AMBE_DATA_BYTES, VOICE_FRAME_LENGTH_BYTES);
for (unsigned int i = 0U; i < 20U; i++) {
if (i == 0U) {
// The first AMBE packet is a sync
::memcpy(buffer + VOICE_FRAME_LENGTH_BYTES, DATA_SYNC_BYTES, DATA_FRAME_LENGTH_BYTES);
data.setData(buffer, DV_FRAME_LENGTH_BYTES);
data.setSeq(i);
} else if (i == 19U) {
// The last packet of the ack
::memcpy(buffer + VOICE_FRAME_LENGTH_BYTES, END_PATTERN_BYTES, END_PATTERN_LENGTH_BYTES);
data.setData(buffer, DV_FRAME_MAX_LENGTH_BYTES);
data.setSeq(i);
data.setEnd(true);
} else {
// The packets containing the text data
unsigned char slowDataBuffer[DATA_FRAME_LENGTH_BYTES];
slowData.getTextData(slowDataBuffer);
::memcpy(buffer + VOICE_FRAME_LENGTH_BYTES, slowDataBuffer, DATA_FRAME_LENGTH_BYTES);
data.setData(buffer, DV_FRAME_LENGTH_BYTES);
data.setSeq(i);
}
m_g2Handler->writeAMBE(data);
}
}
void CDPlusHandler::unlink(IReflectorCallback* handler, const wxString& exclude)
{
for (unsigned int i = 0U; i < m_maxReflectors; i++) {
CDPlusHandler* reflector = m_reflectors[i];
if (reflector != NULL) {
if (reflector->m_direction == DIR_OUTGOING && reflector->m_destination == handler && !reflector->m_reflector.IsSameAs(exclude)) {
wxLogMessage(wxT("Removing outgoing D-Plus link %s, %s"), reflector->m_repeater.c_str(), reflector->m_reflector.c_str());
if (reflector->m_linkState == DPLUS_LINKING || reflector->m_linkState == DPLUS_LINKED) {
CConnectData connect(CT_UNLINK, reflector->m_yourAddress, DPLUS_PORT);
reflector->m_handler->writeConnect(connect);
reflector->m_handler->writeConnect(connect);
reflector->m_linkState = DPLUS_UNLINKING;
reflector->m_tryTimer.setTimeout(1U);
reflector->m_tryTimer.start();
reflector->m_pollTimer.stop();
reflector->m_pollInactivityTimer.stop();
reflector->m_tryCount = 0U;
}
// If an active link with incoming traffic, send an EOT to the repeater
if (reflector->m_dPlusId != 0x00U) {
unsigned int seq = reflector->m_dPlusSeq + 1U;
if (seq == 21U)
seq = 0U;
CAMBEData data;
data.setData(END_PATTERN_BYTES, DV_FRAME_LENGTH_BYTES);
data.setSeq(seq);
data.setEnd(true);
data.setId(reflector->m_dPlusId);
reflector->m_destination->process(data, AS_DPLUS);
}
m_stateChange = true;
}
}
}
}
void CStarNetHandler::sendFromText(const wxString& my) const
{
wxString text;
switch (m_callsignSwitch) {
case SCS_GROUP_CALLSIGN:
text.Printf(wxT("FROM %s"), my.c_str());
break;
case SCS_USER_CALLSIGN:
text.Printf(wxT("VIA STARnet %s"), m_groupCallsign.c_str());
break;
default:
break;
}
CSlowDataEncoder slowData;
slowData.setTextData(text);
CAMBEData data;
data.setId(m_id);
unsigned char buffer[DV_FRAME_LENGTH_BYTES];
::memcpy(buffer + 0U, NULL_AMBE_DATA_BYTES, VOICE_FRAME_LENGTH_BYTES);
for (unsigned int i = 0U; i < 21U; i++) {
if (i == 0U) {
// The first AMBE packet is a sync
::memcpy(buffer + VOICE_FRAME_LENGTH_BYTES, DATA_SYNC_BYTES, DATA_FRAME_LENGTH_BYTES);
data.setData(buffer, DV_FRAME_LENGTH_BYTES);
data.setSeq(i);
} else {
// The packets containing the text data
unsigned char slowDataBuffer[DATA_FRAME_LENGTH_BYTES];
slowData.getTextData(slowDataBuffer);
::memcpy(buffer + VOICE_FRAME_LENGTH_BYTES, slowDataBuffer, DATA_FRAME_LENGTH_BYTES);
data.setData(buffer, DV_FRAME_LENGTH_BYTES);
data.setSeq(i);
}
sendToRepeaters(data);
}
}
void CDExtraHandler::unlink(IReflectorCallback* handler, const wxString& exclude)
{
for (unsigned int i = 0U; i < m_maxReflectors; i++) {
CDExtraHandler* reflector = m_reflectors[i];
if (reflector != NULL) {
if (reflector->m_direction == DIR_OUTGOING && reflector->m_destination == handler && !reflector->m_reflector.IsSameAs(exclude)) {
wxLogMessage(wxT("Removing outgoing DExtra link %s, %s"), reflector->m_repeater.c_str(), reflector->m_reflector.c_str());
if (reflector->m_linkState == DEXTRA_LINKING || reflector->m_linkState == DEXTRA_LINKED) {
CConnectData connect(reflector->m_repeater, reflector->m_address, reflector->m_port);
m_handler->writeConnect(connect);
reflector->m_linkState = DEXTRA_UNLINKING;
reflector->m_destination->linkDown(DP_DEXTRA, reflector->m_reflector, false);
}
// If an active link with incoming traffic, send an EOT to the repeater
if (reflector->m_dExtraId != 0x00U) {
unsigned int seq = reflector->m_dExtraSeq + 1U;
if (seq == 21U)
seq = 0U;
CAMBEData data;
data.setData(END_PATTERN_BYTES, DV_FRAME_LENGTH_BYTES);
data.setSeq(seq);
data.setEnd(true);
data.setId(reflector->m_dExtraId);
reflector->m_destination->process(data, AS_DEXTRA);
}
m_stateChange = true;
delete m_reflectors[i];
m_reflectors[i] = NULL;
}
}
}
}
bool CTimeServerThread::send(const wxArrayString &words, unsigned int hour, unsigned int min)
{
unsigned int idA = CHeaderData::createId();
unsigned int idB = CHeaderData::createId();
unsigned int idC = CHeaderData::createId();
unsigned int idD = CHeaderData::createId();
CHeaderData header;
header.setMyCall1(m_callsign);
header.setRptCall1(m_callsignG);
header.setRptCall2(m_callsign); // Just for the slow data header
header.setYourCall(wxT("CQCQCQ "));
header.setDestination(m_address, G2_DV_PORT);
wxString slowData;
switch (m_language) {
case LANG_DEUTSCH_1:
case LANG_DEUTSCH_2:
header.setMyCall2(wxT("ZEIT"));
slowData.Printf(wxT("Es ist %02u:%02u Uhr"), hour, min);
break;
case LANG_FRANCAIS:
header.setMyCall2(wxT("TIME"));
slowData.Printf(wxT("Il est %02u:%02u"), hour, min);
break;
case LANG_NEDERLANDS:
header.setMyCall2(wxT("TIJD"));
slowData.Printf(wxT("Het is %02u:%02u"), hour, min);
break;
case LANG_SVENSKA:
header.setMyCall2(wxT("TID "));
slowData.Printf(wxT("Klockan ar %02u:%02u"), hour, min);
break;
case LANG_ENGLISH_US_1:
case LANG_ENGLISH_UK_1:
header.setMyCall2(wxT("TIME"));
if (hour == 0U)
slowData.Printf(wxT("It is 12:%02u AM"), min);
else if (hour == 12U)
slowData.Printf(wxT("It is 12:%02u PM"), min);
else if (hour > 12U)
slowData.Printf(wxT("It is %02u:%02u PM"), hour - 12U, min);
else
slowData.Printf(wxT("It is %02u:%02u AM"), hour, min);
break;
default:
header.setMyCall2(wxT("TIME"));
slowData.Printf(wxT("It is %02u:%02u"), hour, min);
break;
}
m_encoder.setHeaderData(header);
m_encoder.setTextData(slowData);
m_in = 0U;
if (m_format != FORMAT_TEXT_TIME) {
wxString text = words.Item(0U);
for (unsigned int i = 1U; i < words.GetCount(); i++) {
text.Append(wxT(" "));
text.Append(words.Item(i));
}
text.Replace(wxT("_"), wxT(" "));
wxLogMessage(wxT("Sending voice \"%s\", sending text \"%s\""), text.c_str(), slowData.c_str());
m_seqNo = 0U;
// Build the audio
lookup(wxT(" "));
lookup(wxT(" "));
lookup(wxT(" "));
lookup(wxT(" "));
for (unsigned int i = 0U; i < words.GetCount(); i++)
lookup(words.Item(i));
lookup(wxT(" "));
lookup(wxT(" "));
lookup(wxT(" "));
lookup(wxT(" "));
end();
} else {
wxLogMessage(wxT("Sending text \"%s\""), slowData.c_str());
for (unsigned int i = 0U; i < 21U; i++) {
CAMBEData* dataOut = new CAMBEData;
dataOut->setDestination(m_address, G2_DV_PORT);
dataOut->setSeq(i);
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 (i == 0U) {
::memcpy(buffer + VOICE_FRAME_LENGTH_BYTES, DATA_SYNC_BYTES, DATA_FRAME_LENGTH_BYTES);
m_encoder.sync();
} else {
m_encoder.getTextData(buffer + VOICE_FRAME_LENGTH_BYTES);
}
dataOut->setData(buffer, DV_FRAME_LENGTH_BYTES);
m_data[m_in] = dataOut;
m_in++;
}
CAMBEData* dataOut = new CAMBEData;
dataOut->setData(END_PATTERN_BYTES, DV_FRAME_LENGTH_BYTES);
dataOut->setDestination(m_address, G2_DV_PORT);
dataOut->setSeq(0U);
dataOut->setEnd(true);
m_data[m_in] = dataOut;
m_in++;
}
if (m_in == 0U) {
wxLogWarning(wxT("Not sending, no audio files loaded"));
return false;
}
if (!m_callsignA.IsEmpty()) {
header.setRptCall2(m_callsignA);
header.setId(idA);
sendHeader(header);
}
if (!m_callsignB.IsEmpty()) {
header.setRptCall2(m_callsignB);
header.setId(idB);
sendHeader(header);
}
if (!m_callsignC.IsEmpty()) {
header.setRptCall2(m_callsignC);
header.setId(idC);
sendHeader(header);
}
if (!m_callsignD.IsEmpty()) {
header.setRptCall2(m_callsignD);
header.setId(idD);
sendHeader(header);
}
unsigned int out = 0U;
wxStopWatch timer;
timer.Start();
for (;;) {
unsigned int needed = timer.Time() / DSTAR_FRAME_TIME_MS;
while (out < needed) {
CAMBEData* data = m_data[out];
m_data[out] = NULL;
out++;
if (!m_callsignA.IsEmpty()) {
data->setId(idA);
sendData(*data);
}
if (!m_callsignB.IsEmpty()) {
data->setId(idB);
sendData(*data);
}
if (!m_callsignC.IsEmpty()) {
data->setId(idC);
sendData(*data);
}
if (!m_callsignD.IsEmpty()) {
data->setId(idD);
sendData(*data);
}
delete data;
if (m_in == out)
return true;
}
::wxMilliSleep(10UL);
}
}
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;
}
void* CDRATSServer::Entry()
{
wxLogMessage(wxT("Starting the D-RATS Server thread for %s"), m_callsign.c_str());
bool sending = false;
unsigned int id = 0U;
unsigned char seqNo = 0U;
unsigned int sent = 0U;
wxStopWatch time;
try {
while (!m_stopped) {
serviceSocket();
if (m_readEnd && !sending) {
id = CHeaderData::createId();
// Write header
CHeaderData header;
header.setMyCall1(m_callsign);
header.setMyCall2(wxT("DATA"));
header.setYourCall(wxT("CQCQCQ "));
header.setId(id);
#if defined(LOOPBACK)
writeHeader(header);
#else
m_handler->process(header, DIR_INCOMING, AS_DRATS);
#endif
m_readState = SS_FIRST;
m_readPos = 0U;
sending = true;
seqNo = 0U;
sent = 0U;
time.Start();
}
if (m_readEnd && sending) {
unsigned int needed = time.Time() / DSTAR_FRAME_TIME_MS;
while (sent < needed && sending) {
// Write AMBE data
CAMBEData data;
data.setId(id);
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 (seqNo == 0U) {
::memcpy(buffer + VOICE_FRAME_LENGTH_BYTES, DATA_SYNC_BYTES, DATA_FRAME_LENGTH_BYTES);
m_readState = SS_FIRST;
} else {
if (m_readState == SS_FIRST) {
unsigned char readText[3U];
::memset(readText, 'f', 3U);
unsigned int length = m_readLength - m_readPos;
unsigned char bytes = 5U;
if (length < 5U)
bytes = length;
readText[0U] = SLOW_DATA_TYPE_GPS | bytes;
for (unsigned int i = 0U; i < 2U && m_readPos < m_readLength; i++)
readText[i + 1U] = m_readBuffer[m_readPos++];
readText[0U] ^= SCRAMBLER_BYTE1;
readText[1U] ^= SCRAMBLER_BYTE2;
readText[2U] ^= SCRAMBLER_BYTE3;
::memcpy(buffer + VOICE_FRAME_LENGTH_BYTES, readText, DATA_FRAME_LENGTH_BYTES);
m_readState = SS_SECOND;
} else {
unsigned char readText[3U];
::memset(readText, 'f', 3U);
for (unsigned int i = 0U; i < 3U && m_readPos < m_readLength; i++)
readText[i] = m_readBuffer[m_readPos++];
readText[0U] ^= SCRAMBLER_BYTE1;
readText[1U] ^= SCRAMBLER_BYTE2;
readText[2U] ^= SCRAMBLER_BYTE3;
::memcpy(buffer + VOICE_FRAME_LENGTH_BYTES, readText, DATA_FRAME_LENGTH_BYTES);
m_readState = SS_FIRST;
}
}
data.setSeq(seqNo);
data.setData(buffer, DV_FRAME_LENGTH_BYTES);
sent++;
#if defined(LOOPBACK)
writeData(data);
#else
m_handler->process(data, DIR_INCOMING, AS_DRATS);
#endif
if (m_readPos == m_readLength) {
if (m_readState == SS_SECOND) {
seqNo++;
if (seqNo == 21U)
seqNo = 0U;
unsigned char readText[3U];
readText[0U] = 'f' ^ SCRAMBLER_BYTE1;
readText[1U] = 'f' ^ SCRAMBLER_BYTE2;
readText[2U] = 'f' ^ SCRAMBLER_BYTE3;
::memcpy(buffer + VOICE_FRAME_LENGTH_BYTES, readText, DATA_FRAME_LENGTH_BYTES);
data.setSeq(seqNo);
data.setData(buffer, DV_FRAME_LENGTH_BYTES);
sent++;
#if defined(LOOPBACK)
writeData(data);
#else
m_handler->process(data, DIR_INCOMING, AS_DRATS);
#endif
}
seqNo++;
if (seqNo == 21U)
seqNo = 0U;
if (seqNo == 0U)
::memcpy(buffer + VOICE_FRAME_LENGTH_BYTES, DATA_SYNC_BYTES, DATA_FRAME_LENGTH_BYTES);
else
::memcpy(buffer + VOICE_FRAME_LENGTH_BYTES, NULL_SLOW_DATA_BYTES, DATA_FRAME_LENGTH_BYTES);
data.setData(buffer, DV_FRAME_LENGTH_BYTES);
data.setSeq(seqNo);
data.setEnd(true);
sent++;
#if defined(LOOPBACK)
writeData(data);
#else
m_handler->process(data, DIR_INCOMING, AS_DRATS);
#endif
m_readLength = 0U;
m_readPos = 0U;
m_readEnd = false;
sending = false;
sent = 0U;
}
seqNo++;
if (seqNo == 21U)
seqNo = 0U;
}
}
// 50ms
Sleep(50UL);
}
if (m_socket != NULL)
m_socket->stop();
}
catch (std::exception& e) {
wxString message(e.what(), wxConvLocal);
wxLogError(wxT("Exception raised in the D-RATS Server thread - \"%s\""), message.c_str());
}
catch (...) {
wxLogError(wxT("Unknown exception raised in the D-RATS Server thread"));
}
wxLogMessage(wxT("Stopping the D-RATS Server thread for %s"), m_callsign.c_str());
return NULL;
}
