Improve the displayed information about System Fusion.

This commit is contained in:
Jonathan Naylor 2016-02-29 22:43:26 +00:00
parent e43bc459ea
commit 5074136a6e
9 changed files with 114 additions and 64 deletions

View file

@ -39,7 +39,7 @@ public:
virtual void clearDMR(unsigned int slotNo) = 0; virtual void clearDMR(unsigned int slotNo) = 0;
virtual void setFusion() = 0; virtual void setFusion() = 0;
virtual void writeFusion(const std::string& callsign) = 0; virtual void writeFusion(const char* source, const char* dest) = 0;
virtual void clearFusion() = 0; virtual void clearFusion() = 0;
virtual void close() = 0; virtual void close() = 0;

View file

@ -63,7 +63,7 @@ void CNullDisplay::setFusion()
{ {
} }
void CNullDisplay::writeFusion(const std::string& callsign) void CNullDisplay::writeFusion(const char* source, const char* dest)
{ {
} }

View file

@ -42,7 +42,7 @@ public:
virtual void clearDMR(unsigned int slotNo); virtual void clearDMR(unsigned int slotNo);
virtual void setFusion(); virtual void setFusion();
virtual void writeFusion(const std::string& callsign); virtual void writeFusion(const char* source, const char* dest);
virtual void clearFusion(); virtual void clearFusion();
virtual void close(); virtual void close();

View file

@ -104,7 +104,7 @@ void CTFTSerial::writeDStar(const char* my1, const char* my2, const char* your)
assert(my2 != NULL); assert(my2 != NULL);
assert(your != NULL); assert(your != NULL);
char text[20U]; char text[30U];
::sprintf(text, "%8.8s/%4.4s -> %8.8s", my1, my2, your); ::sprintf(text, "%8.8s/%4.4s -> %8.8s", my1, my2, your);
gotoPosText(0U, 8U); gotoPosText(0U, 8U);
@ -146,12 +146,12 @@ void CTFTSerial::writeDMR(unsigned int slotNo, unsigned int srcId, bool group, u
assert(type != NULL); assert(type != NULL);
if (slotNo == 1U) { if (slotNo == 1U) {
char text[20U]; char text[30U];
::sprintf(text, "1: %s %u -> %s%u", type, srcId, group ? "TG" : "", dstId); ::sprintf(text, "1: %s %u -> %s%u", type, srcId, group ? "TG" : "", dstId);
gotoPosText(0U, 8U); gotoPosText(0U, 8U);
displayText(text); displayText(text);
} else { } else {
char text[20U]; char text[30U];
::sprintf(text, "2: %s %u -> %s%u", type, srcId, group ? "TG" : "", dstId); ::sprintf(text, "2: %s %u -> %s%u", type, srcId, group ? "TG" : "", dstId);
gotoPosText(0U, 9U); gotoPosText(0U, 9U);
displayText(text); displayText(text);
@ -184,10 +184,13 @@ void CTFTSerial::setFusion()
displayText("Listening"); displayText("Listening");
} }
void CTFTSerial::writeFusion(const std::string& callsign) void CTFTSerial::writeFusion(const char* source, const char* dest)
{ {
char text[20U]; assert(source != NULL);
::sprintf(text, "%s", callsign.c_str()); assert(dest != NULL);
char text[30U];
::sprintf(text, "%s -> %s", source, dest);
gotoPosText(0U, 8U); gotoPosText(0U, 8U);
displayText(text); displayText(text);

View file

@ -43,7 +43,7 @@ public:
virtual void clearDMR(unsigned int slotNo); virtual void clearDMR(unsigned int slotNo);
virtual void setFusion(); virtual void setFusion();
virtual void writeFusion(const std::string& callsign); virtual void writeFusion(const char* source, const char* dest);
virtual void clearFusion(); virtual void clearFusion();
virtual void close(); virtual void close();

View file

@ -36,6 +36,8 @@ m_state(RS_RF_LISTENING),
m_timeoutTimer(1000U, timeout), m_timeoutTimer(1000U, timeout),
m_frames(0U), m_frames(0U),
m_fich(), m_fich(),
m_source(NULL),
m_dest(NULL),
m_payload(), m_payload(),
m_parrot(NULL), m_parrot(NULL),
m_fp(NULL) m_fp(NULL)
@ -78,9 +80,8 @@ bool CYSFControl::writeModem(unsigned char *data)
if (type == TAG_DATA && valid && m_state == RS_RF_LISTENING) { if (type == TAG_DATA && valid && m_state == RS_RF_LISTENING) {
m_frames = 0U; m_frames = 0U;
m_timeoutTimer.start(); m_timeoutTimer.start();
m_display->writeFusion("XXXXXX"); m_payload.reset();
m_state = RS_RF_AUDIO; m_state = RS_RF_AUDIO;
LogMessage("YSF, received RF header");
#if defined(DUMP_YSF) #if defined(DUMP_YSF)
openFile(); openFile();
#endif #endif
@ -92,23 +93,22 @@ bool CYSFControl::writeModem(unsigned char *data)
if (type == TAG_EOT) { if (type == TAG_EOT) {
CSync::addYSFSync(data + 2U); CSync::addYSFSync(data + 2U);
CYSFFICH fich; m_fich.decode(data + 2U);
fich.decode(data + 2U);
unsigned char fi = fich.getFI(); unsigned char fi = m_fich.getFI();
unsigned char fn = fich.getFN(); unsigned char fn = m_fich.getFN();
unsigned char dt = fich.getDT(); unsigned char dt = m_fich.getDT();
LogMessage("YSF, EOT, FI=%X FN=%u DT=%X", fi, fn, dt); LogMessage("YSF, EOT, FI=%X FN=%u DT=%X", fi, fn, dt);
m_payload.decode(data + 2U, fi, fn, dt); m_payload.decode(data + 2U, fi, fn, dt);
// m_payload.encode(data + 2U); // m_payload.encode(data + 2U); XXX
m_frames++; m_frames++;
if (m_duplex) { if (m_duplex) {
fich.setMR(YSF_MR_BUSY); m_fich.setMR(YSF_MR_BUSY);
fich.encode(data + 2U); m_fich.encode(data + 2U);
data[0U] = TAG_EOT; data[0U] = TAG_EOT;
data[1U] = 0x00U; data[1U] = 0x00U;
@ -116,8 +116,8 @@ bool CYSFControl::writeModem(unsigned char *data)
} }
if (m_parrot != NULL) { if (m_parrot != NULL) {
fich.setMR(YSF_MR_NOT_BUSY); m_fich.setMR(YSF_MR_NOT_BUSY);
fich.encode(data + 2U); m_fich.encode(data + 2U);
data[0U] = TAG_EOT; data[0U] = TAG_EOT;
data[1U] = 0x00U; data[1U] = 0x00U;
@ -140,13 +140,42 @@ bool CYSFControl::writeModem(unsigned char *data)
assert(ret); assert(ret);
unsigned char fi = m_fich.getFI(); unsigned char fi = m_fich.getFI();
unsigned char cm = m_fich.getCM();
unsigned char fn = m_fich.getFN(); unsigned char fn = m_fich.getFN();
unsigned char dt = m_fich.getDT(); unsigned char dt = m_fich.getDT();
LogMessage("YSF, Valid FICH, FI=%X FN=%u DT=%X", m_fich.getFI(), m_fich.getFN(), m_fich.getDT()); LogMessage("YSF, Valid FICH, FI=%X FN=%u DT=%X", m_fich.getFI(), m_fich.getFN(), m_fich.getDT());
m_payload.decode(data + 2U, fi, fn, dt); m_payload.decode(data + 2U, fi, fn, dt);
// payload.encode(data + 2U); // payload.encode(data + 2U); XXX
bool change = false;
if (cm == 0x00U && m_dest == NULL) {
m_dest = (unsigned char*)"CQCQCQ";
change = true;
}
if (m_source == NULL) {
m_source = m_payload.getSource();
if (m_source != NULL)
change = true;
}
if (m_dest == NULL) {
m_dest = m_payload.getDest();
if (m_dest != NULL)
change = true;
}
if (change) {
if (m_source != NULL && m_dest != NULL)
m_display->writeFusion((char*)m_source, (char*)m_dest);
if (m_source != NULL && m_dest == NULL)
m_display->writeFusion((char*)m_source, "??????");
if (m_source == NULL && m_dest != NULL)
m_display->writeFusion("??????", (char*)m_dest);
}
} else { } else {
LogMessage("YSF, invalid FICH"); LogMessage("YSF, invalid FICH");
@ -201,8 +230,14 @@ void CYSFControl::writeEndOfTransmission()
m_timeoutTimer.stop(); m_timeoutTimer.stop();
m_payload.reset();
m_display->clearFusion(); m_display->clearFusion();
// These variables are free'd by YSFPayload
m_source = NULL;
m_dest = NULL;
#if defined(DUMP_YSF) #if defined(DUMP_YSF)
closeFile(); closeFile();
#endif #endif

View file

@ -50,6 +50,8 @@ private:
CTimer m_timeoutTimer; CTimer m_timeoutTimer;
unsigned int m_frames; unsigned int m_frames;
CYSFFICH m_fich; CYSFFICH m_fich;
unsigned char* m_source;
unsigned char* m_dest;
CYSFPayload m_payload; CYSFPayload m_payload;
CYSFParrot* m_parrot; CYSFParrot* m_parrot;
FILE* m_fp; FILE* m_fp;

View file

@ -89,6 +89,8 @@ CYSFPayload::~CYSFPayload()
delete[] m_data; delete[] m_data;
delete[] m_uplink; delete[] m_uplink;
delete[] m_downlink; delete[] m_downlink;
delete[] m_source;
delete[] m_dest;
} }
bool CYSFPayload::decode(const unsigned char* bytes, unsigned char fi, unsigned char fn, unsigned char dt) bool CYSFPayload::decode(const unsigned char* bytes, unsigned char fi, unsigned char fn, unsigned char dt)
@ -159,13 +161,15 @@ bool CYSFPayload::decodeHeader()
CUtils::dump("Header/Trailer, Source", output + 0U, 10U); CUtils::dump("Header/Trailer, Source", output + 0U, 10U);
CUtils::dump("Header/Trailer, Destination", output + 10U, 10U); CUtils::dump("Header/Trailer, Destination", output + 10U, 10U);
if (m_source == NULL) if (m_source == NULL) {
m_source = new unsigned char[10U]; m_source = new unsigned char[10U];
if (m_dest == NULL) ::memcpy(m_source, output + 0U, 10U);
m_dest = new unsigned char[10U]; }
::memcpy(m_source, output + 0U, 10U); if (m_dest == NULL) {
::memcpy(m_dest, output + 10U, 10U); m_dest = new unsigned char[10U];
::memcpy(m_dest, output + 10U, 10U);
}
for (unsigned int i = 0U; i < 20U; i++) for (unsigned int i = 0U; i < 20U; i++)
output[i] ^= WHITENING_DATA[i]; output[i] ^= WHITENING_DATA[i];
@ -278,17 +282,24 @@ bool CYSFPayload::decodeVDMode1(unsigned char fn)
case 0U: case 0U:
CUtils::dump("V/D Mode 1, Destination", output + 0U, 10U); CUtils::dump("V/D Mode 1, Destination", output + 0U, 10U);
CUtils::dump("V/D Mode 1, Source", output + 10U, 10U); CUtils::dump("V/D Mode 1, Source", output + 10U, 10U);
if (m_dest == NULL)
if (m_dest == NULL) {
m_dest = new unsigned char[10U]; m_dest = new unsigned char[10U];
if (m_source == NULL) ::memcpy(m_dest, output + 0U, 10U);
}
if (m_source == NULL) {
m_source = new unsigned char[10U]; m_source = new unsigned char[10U];
::memcpy(m_dest, output, 10U); ::memcpy(m_source, output + 10U, 10U);
::memcpy(m_source, output, 10U); }
break; break;
case 2U: case 2U:
CUtils::dump("V/D Mode 1, Rem 1+2", output + 0U, 10U); CUtils::dump("V/D Mode 1, Rem 1+2", output + 0U, 10U);
CUtils::dump("V/D Mode 1, Rem 3+4", output + 10U, 10U); CUtils::dump("V/D Mode 1, Rem 3+4", output + 10U, 10U);
break; break;
default: default:
break; break;
} }
@ -382,15 +393,17 @@ bool CYSFPayload::decodeVDMode2(unsigned char fn)
switch (fn) { switch (fn) {
case 0U: case 0U:
CUtils::dump("V/D Mode 2, Destination", output, 10U); CUtils::dump("V/D Mode 2, Destination", output, 10U);
if (m_dest == NULL) if (m_dest == NULL) {
m_dest = new unsigned char[10U]; m_dest = new unsigned char[10U];
::memcpy(m_dest, output, 10U); ::memcpy(m_dest, output, 10U);
}
break; break;
case 1U: case 1U:
CUtils::dump("V/D Mode 2, Source", output, 10U); CUtils::dump("V/D Mode 2, Source", output, 10U);
if (m_source == NULL) if (m_source == NULL) {
m_source = new unsigned char[10U]; m_source = new unsigned char[10U];
::memcpy(m_source, output, 10U); ::memcpy(m_source, output, 10U);
}
break; break;
case 4U: case 4U:
CUtils::dump("V/D Mode 2, Rem 1+2", output, 10U); CUtils::dump("V/D Mode 2, Rem 1+2", output, 10U);
@ -496,13 +509,19 @@ bool CYSFPayload::decodeDataFRMode(unsigned char fn)
case 0U: case 0U:
CUtils::dump("Data FR Mode, Destination", output + 0U, 10U); CUtils::dump("Data FR Mode, Destination", output + 0U, 10U);
CUtils::dump("Data FR Mode, Source", output + 10U, 10U); CUtils::dump("Data FR Mode, Source", output + 10U, 10U);
if (m_dest == NULL)
if (m_dest == NULL) {
m_dest = new unsigned char[10U]; m_dest = new unsigned char[10U];
if (m_source == NULL) ::memcpy(m_dest, output + 0U, 10U);
}
if (m_source == NULL) {
m_source = new unsigned char[10U]; m_source = new unsigned char[10U];
::memcpy(m_dest, output, 10U); ::memcpy(m_source, output + 10U, 10U);
::memcpy(m_source, output, 10U); }
break; break;
case 1U: case 1U:
CUtils::dump("Data FR Mode, Rem 1+2", output + 0U, 10U); CUtils::dump("Data FR Mode, Rem 1+2", output + 0U, 10U);
CUtils::dump("Data FR Mode, Rem 3+4", output + 10U, 10U); CUtils::dump("Data FR Mode, Rem 3+4", output + 10U, 10U);
@ -643,32 +662,21 @@ void CYSFPayload::setDownlink(const std::string& callsign)
m_downlink[i] = downlink.at(i); m_downlink[i] = downlink.at(i);
} }
bool CYSFPayload::getSource(unsigned char* callsign) unsigned char* CYSFPayload::getSource()
{ {
assert(callsign != NULL); return m_source;
}
if (m_source == NULL) unsigned char* CYSFPayload::getDest()
return false; {
return m_dest;
::memcpy(callsign, m_source, 10U); }
void CYSFPayload::reset()
{
delete[] m_source; delete[] m_source;
m_source = NULL;
return true;
}
bool CYSFPayload::getDest(unsigned char* callsign)
{
assert(callsign != NULL);
if (m_dest == NULL)
return false;
::memcpy(callsign, m_dest, 10U);
delete[] m_dest; delete[] m_dest;
m_dest = NULL;
return true; m_source = NULL;
m_dest = NULL;
} }

View file

@ -30,12 +30,14 @@ public:
void encode(unsigned char* bytes); void encode(unsigned char* bytes);
bool getSource(unsigned char* callsign); unsigned char* getSource();
bool getDest(unsigned char* callsign); unsigned char* getDest();
void setUplink(const std::string& callsign); void setUplink(const std::string& callsign);
void setDownlink(const std::string& callsign); void setDownlink(const std::string& callsign);
void reset();
private: private:
unsigned char* m_data; unsigned char* m_data;
unsigned char* m_uplink; unsigned char* m_uplink;