Digital_Voice_Modem_Project
/
dvmhost
mirror of https://github.com/DVMProject/dvmhost.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

neuter the DFSI implementation (we only use parts of the TIA-102.BAHA spec here, the real DFSI work will happen elsewhere);

Browse Source
pull/39/head
Bryan Biedenkapp 3 years ago
parent 7cb639027d
commit 3e25951d9d
3 changed files with 0 additions and 341 deletions
Show Stats Download Patch File Download Diff File

31
src/p25/dfsi/DFSIDefines.h
Unescape View File

@ -44,13 +44,6 @@ namespace p25
// Constants // Constants
// --------------------------------------------------------------------------- // ---------------------------------------------------------------------------
const uint32_t P25_DFSI_START_LENGTH_BYTES = 4U;
const uint32_t P25_DFSI_SS_FRAME_LENGTH_BYTES = 10U;
const uint32_t P25_DFSI_VHDR1_FRAME_LENGTH_BYTES = 30U;
const uint32_t P25_DFSI_VHDR2_FRAME_LENGTH_BYTES = 22U;
const uint32_t P25_DFSI_LDU1_VOICE1_FRAME_LENGTH_BYTES = 22U; const uint32_t P25_DFSI_LDU1_VOICE1_FRAME_LENGTH_BYTES = 22U;
const uint32_t P25_DFSI_LDU1_VOICE2_FRAME_LENGTH_BYTES = 14U; const uint32_t P25_DFSI_LDU1_VOICE2_FRAME_LENGTH_BYTES = 14U;
const uint32_t P25_DFSI_LDU1_VOICE3_FRAME_LENGTH_BYTES = 17U; const uint32_t P25_DFSI_LDU1_VOICE3_FRAME_LENGTH_BYTES = 17U;
@ -71,31 +64,7 @@ namespace p25
const uint32_t P25_DFSI_LDU2_VOICE17_FRAME_LENGTH_BYTES = 17U; const uint32_t P25_DFSI_LDU2_VOICE17_FRAME_LENGTH_BYTES = 17U;
const uint32_t P25_DFSI_LDU2_VOICE18_FRAME_LENGTH_BYTES = 16U; const uint32_t P25_DFSI_LDU2_VOICE18_FRAME_LENGTH_BYTES = 16U;
const uint32_t P25_DFSI_TSBK_FRAME_LENGTH_BYTES = 25U;
const uint8_t P25_DFSI_STATUS_NO_ERROR = 0x00U; //
const uint8_t P25_DFSI_STATUS_ERASE = 0x02U; //
const uint8_t P25_DFSI_RT_ENABLED = 0x02U; //
const uint8_t P25_DFSI_RT_DISABLED = 0x04U; //
const uint8_t P25_DFSI_START_FLAG = 0x0CU; //
const uint8_t P25_DFSI_STOP_FLAG = 0x25U; //
const uint8_t P25_DFSI_TYPE_DATA_PAYLOAD = 0x06U; //
const uint8_t P25_DFSI_TYPE_VOICE = 0x0BU; //
const uint8_t P25_DFSI_TYPE_DATA = 0x0CU; //
const uint8_t P25_DFSI_TYPE_TSBK = 0x0FU; //
const uint8_t P25_DFSI_DEF_ICW_SOURCE = 0x00U; // Infrastructure Source - Default Source
const uint8_t P25_DFSI_DEF_SOURCE = 0x00U; //
// Frame Type(s) // Frame Type(s)
const uint8_t P25_DFSI_START_STOP = 0x00U; // Start/Stop
const uint8_t P25_DFSI_VHDR1 = 0x60U; // Voice Header 1
const uint8_t P25_DFSI_VHDR2 = 0x61U; // Voice Header 2
const uint8_t P25_DFSI_LDU1_VOICE1 = 0x62U; // IMBE LDU1 - Voice 1 const uint8_t P25_DFSI_LDU1_VOICE1 = 0x62U; // IMBE LDU1 - Voice 1
const uint8_t P25_DFSI_LDU1_VOICE2 = 0x63U; // IMBE LDU1 - Voice 2 const uint8_t P25_DFSI_LDU1_VOICE2 = 0x63U; // IMBE LDU1 - Voice 2
const uint8_t P25_DFSI_LDU1_VOICE3 = 0x64U; // IMBE LDU1 - Voice 3 + Link Control const uint8_t P25_DFSI_LDU1_VOICE3 = 0x64U; // IMBE LDU1 - Voice 3 + Link Control

272
src/p25/dfsi/LC.cpp
Unescape View File

@ -47,15 +47,9 @@ using namespace p25;
/// Initializes a new instance of the LC class. /// Initializes a new instance of the LC class.
/// </summary> /// </summary>
LC::LC() : LC::LC() :
m_rtModeFlag(P25_DFSI_RT_ENABLED),
m_startStopFlag(P25_DFSI_START_FLAG),
m_typeFlag(P25_DFSI_TYPE_VOICE),
m_icwFlag(P25_DFSI_DEF_ICW_SOURCE),
m_rssi(0U), m_rssi(0U),
m_source(P25_DFSI_DEF_SOURCE),
m_control(nullptr), m_control(nullptr),
m_lsd(nullptr), m_lsd(nullptr),
m_tsbk(nullptr),
m_rs(), m_rs(),
m_mi(nullptr) m_mi(nullptr)
{ {
@ -124,146 +118,6 @@ void LC::setControl(const lc::LC& data)
m_control = new lc::LC(data); m_control = new lc::LC(data);
} }
/// <summary>
/// Decode a NID start/stop.
/// </summary>
/// <param name="data"></param>
/// <returns>True, if decoded, otherwise false.</returns>
bool LC::decodeNID(const uint8_t* data)
{
assert(data != nullptr);
m_frameType = data[0U]; // Frame Type
return decodeStart(data + 1U);
}
/// <summary>
/// Encode a NID start/stop.
/// </summary>
/// <param name="data"></param>
void LC::encodeNID(uint8_t* data)
{
assert(data != nullptr);
uint8_t dfsiFrame[P25_DFSI_SS_FRAME_LENGTH_BYTES];
::memset(dfsiFrame, 0x00U, P25_DFSI_SS_FRAME_LENGTH_BYTES);
dfsiFrame[0U] = m_frameType; // Frame Type
// encode start record
encodeStart(dfsiFrame + 1U);
#if DEBUG_P25_DFSI
Utils::dump(2U, "LC::encodeNID(), DFSI Start/Stop Frame", dfsiFrame, P25_DFSI_SS_FRAME_LENGTH_BYTES);
#endif
::memcpy(data, dfsiFrame, P25_DFSI_SS_FRAME_LENGTH_BYTES);
}
/// <summary>
/// Decode a voice header 1.
/// </summary>
/// <param name="data"></param>
/// <returns>True, if decoded, otherwise false.</returns>
bool LC::decodeVHDR1(const uint8_t* data)
{
assert(data != nullptr);
m_frameType = data[0U]; // Frame Type
if (m_frameType != P25_DFSI_VHDR1) {
LogError(LOG_P25, "LC::decodeVHDR1(), invalid frametype, frameType = $%02X", m_frameType);
return false;
}
if (!decodeStart(data + 1U)) {
LogError(LOG_P25, "LC::decodeVHDR1(), failed to decode start record");
return false;
}
m_icwFlag = data[5U]; // ICW Flag
m_rssi = data[6U]; // RSSI
return true;
}
/// <summary>
/// Encode a voice header 1.
/// </summary>
/// <param name="data"></param>
void LC::encodeVHDR1(uint8_t* data)
{
assert(data != nullptr);
uint8_t dfsiFrame[P25_DFSI_VHDR1_FRAME_LENGTH_BYTES];
::memset(dfsiFrame, 0x00U, P25_DFSI_VHDR1_FRAME_LENGTH_BYTES);
dfsiFrame[0U] = P25_DFSI_VHDR1; // Frame Type
// encode start record
encodeStart(dfsiFrame + 1U);
dfsiFrame[5U] = m_icwFlag; // ICW Flag
dfsiFrame[6U] = m_rssi; // RSSI
#if DEBUG_P25_DFSI
Utils::dump(2U, "LC::encodeVHDR1(), DFSI Voice Header 1 Frame", dfsiFrame, P25_DFSI_VHDR1_FRAME_LENGTH_BYTES);
#endif
::memcpy(data, dfsiFrame, P25_DFSI_VHDR1_FRAME_LENGTH_BYTES);
}
/// <summary>
/// Decode a voice header 2.
/// </summary>
/// <param name="data"></param>
/// <returns>True, if decoded, otherwise false.</returns>
bool LC::decodeVHDR2(const uint8_t* data)
{
assert(data != nullptr);
if (m_control != nullptr) {
delete m_control;
}
m_control = new lc::LC();
m_frameType = data[0U]; // Frame Type
if (m_frameType != P25_DFSI_VHDR2) {
LogError(LOG_P25, "LC::decodeVHDR2(), invalid frametype, frameType = $%02X", m_frameType);
return false;
}
uint32_t dstId = (data[1U] << 16) | (data[2U] << 8) | (data[3U] << 0);
m_control->setDstId(dstId); // Talkgroup Address
return true;
}
/// <summary>
/// Encode a voice header 2.
/// </summary>
/// <param name="data"></param>
void LC::encodeVHDR2(uint8_t* data)
{
assert(data != nullptr);
uint8_t dfsiFrame[P25_DFSI_VHDR2_FRAME_LENGTH_BYTES];
::memset(dfsiFrame, 0x00U, P25_DFSI_VHDR2_FRAME_LENGTH_BYTES);
dfsiFrame[0U] = P25_DFSI_VHDR2; // Frame Type
uint32_t dstId = m_control->getDstId();
dfsiFrame[1U] = (dstId >> 16) & 0xFFU; // Talkgroup Address
dfsiFrame[2U] = (dstId >> 8) & 0xFFU;
dfsiFrame[3U] = (dstId >> 0) & 0xFFU;
#if DEBUG_P25_DFSI
Utils::dump(2U, "LC::encodeVHDR2(), DFSI Voice Header 2 Frame", dfsiFrame, P25_DFSI_VHDR2_FRAME_LENGTH_BYTES);
#endif
::memcpy(data, dfsiFrame, P25_DFSI_VHDR2_FRAME_LENGTH_BYTES);
}
/// <summary> /// <summary>
/// Decode a logical link data unit 1. /// Decode a logical link data unit 1.
/// </summary> /// </summary>
@ -291,17 +145,13 @@ bool LC::decodeLDU1(const uint8_t* data, uint8_t* imbe)
m_lsd = new data::LowSpeedData(); m_lsd = new data::LowSpeedData();
} }
decodeStart(data + 1U); // Start Record
m_icwFlag = data[5U]; // ICW Flag
m_rssi = data[6U]; // RSSI m_rssi = data[6U]; // RSSI
::memcpy(imbe, data + 10U, P25_RAW_IMBE_LENGTH_BYTES); // IMBE ::memcpy(imbe, data + 10U, P25_RAW_IMBE_LENGTH_BYTES); // IMBE
m_source = data[21U]; // Source
} }
break; break;
case P25_DFSI_LDU1_VOICE2: case P25_DFSI_LDU1_VOICE2:
{ {
::memcpy(imbe, data + 1U, P25_RAW_IMBE_LENGTH_BYTES); // IMBE ::memcpy(imbe, data + 1U, P25_RAW_IMBE_LENGTH_BYTES); // IMBE
m_source = data[12U]; // Source
} }
break; break;
case P25_DFSI_LDU1_VOICE3: case P25_DFSI_LDU1_VOICE3:
@ -445,7 +295,6 @@ void LC::encodeLDU1(uint8_t* data, const uint8_t* imbe)
case P25_DFSI_LDU1_VOICE2: case P25_DFSI_LDU1_VOICE2:
{ {
::memcpy(dfsiFrame + 1U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE ::memcpy(dfsiFrame + 1U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE
dfsiFrame[12U] = m_source; // Source
} }
break; break;
case P25_DFSI_LDU1_VOICE3: case P25_DFSI_LDU1_VOICE3:
@ -454,7 +303,6 @@ void LC::encodeLDU1(uint8_t* data, const uint8_t* imbe)
dfsiFrame[2U] = rs[1U]; // MFId dfsiFrame[2U] = rs[1U]; // MFId
dfsiFrame[3U] = rs[2U]; // Service Options dfsiFrame[3U] = rs[2U]; // Service Options
::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE ::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE
dfsiFrame[16U] = P25_DFSI_STATUS_ERASE; // Status
} }
break; break;
case P25_DFSI_LDU1_VOICE4: case P25_DFSI_LDU1_VOICE4:
@ -463,7 +311,6 @@ void LC::encodeLDU1(uint8_t* data, const uint8_t* imbe)
dfsiFrame[2U] = rs[4U]; dfsiFrame[2U] = rs[4U];
dfsiFrame[3U] = rs[5U]; dfsiFrame[3U] = rs[5U];
::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE ::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE
dfsiFrame[16U] = P25_DFSI_STATUS_ERASE; // Status
} }
break; break;
case P25_DFSI_LDU1_VOICE5: case P25_DFSI_LDU1_VOICE5:
@ -472,7 +319,6 @@ void LC::encodeLDU1(uint8_t* data, const uint8_t* imbe)
dfsiFrame[2U] = rs[7U]; dfsiFrame[2U] = rs[7U];
dfsiFrame[3U] = rs[8U]; dfsiFrame[3U] = rs[8U];
::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE ::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE
dfsiFrame[16U] = P25_DFSI_STATUS_ERASE; // Status
} }
break; break;
case P25_DFSI_LDU1_VOICE6: case P25_DFSI_LDU1_VOICE6:
@ -481,7 +327,6 @@ void LC::encodeLDU1(uint8_t* data, const uint8_t* imbe)
dfsiFrame[2U] = rs[10U]; // RS (24,12,13) dfsiFrame[2U] = rs[10U]; // RS (24,12,13)
dfsiFrame[3U] = rs[11U]; // RS (24,12,13) dfsiFrame[3U] = rs[11U]; // RS (24,12,13)
::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE ::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE
dfsiFrame[16U] = P25_DFSI_STATUS_ERASE; // Status
} }
break; break;
case P25_DFSI_LDU1_VOICE7: case P25_DFSI_LDU1_VOICE7:
@ -490,7 +335,6 @@ void LC::encodeLDU1(uint8_t* data, const uint8_t* imbe)
dfsiFrame[2U] = rs[13U]; // RS (24,12,13) dfsiFrame[2U] = rs[13U]; // RS (24,12,13)
dfsiFrame[3U] = rs[14U]; // RS (24,12,13) dfsiFrame[3U] = rs[14U]; // RS (24,12,13)
::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE ::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE
dfsiFrame[16U] = P25_DFSI_STATUS_ERASE; // Status
} }
break; break;
case P25_DFSI_LDU1_VOICE8: case P25_DFSI_LDU1_VOICE8:
@ -499,7 +343,6 @@ void LC::encodeLDU1(uint8_t* data, const uint8_t* imbe)
dfsiFrame[2U] = rs[16U]; // RS (24,12,13) dfsiFrame[2U] = rs[16U]; // RS (24,12,13)
dfsiFrame[3U] = rs[17U]; // RS (24,12,13) dfsiFrame[3U] = rs[17U]; // RS (24,12,13)
::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE ::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE
dfsiFrame[16U] = P25_DFSI_STATUS_ERASE; // Status
} }
break; break;
case P25_DFSI_LDU1_VOICE9: case P25_DFSI_LDU1_VOICE9:
@ -513,11 +356,8 @@ void LC::encodeLDU1(uint8_t* data, const uint8_t* imbe)
case P25_DFSI_LDU1_VOICE1: case P25_DFSI_LDU1_VOICE1:
default: default:
{ {
encodeStart(dfsiFrame + 1U); // Start Record
dfsiFrame[5U] = m_icwFlag; // ICW Flag
dfsiFrame[6U] = m_rssi; // RSSI dfsiFrame[6U] = m_rssi; // RSSI
::memcpy(dfsiFrame + 10U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE ::memcpy(dfsiFrame + 10U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE
dfsiFrame[21U] = m_source; // Source
} }
break; break;
} }
@ -555,11 +395,8 @@ bool LC::decodeLDU2(const uint8_t* data, uint8_t* imbe)
} }
m_lsd = new data::LowSpeedData(); m_lsd = new data::LowSpeedData();
decodeStart(data + 1U); // Start Record
m_icwFlag = data[5U]; // ICW Flag
m_rssi = data[6U]; // RSSI m_rssi = data[6U]; // RSSI
::memcpy(imbe, data + 10U, P25_RAW_IMBE_LENGTH_BYTES); // IMBE ::memcpy(imbe, data + 10U, P25_RAW_IMBE_LENGTH_BYTES); // IMBE
m_source = data[21U]; // Source
} }
break; break;
case P25_DFSI_LDU2_VOICE11: case P25_DFSI_LDU2_VOICE11:
@ -693,7 +530,6 @@ void LC::encodeLDU2(uint8_t* data, const uint8_t* imbe)
case P25_DFSI_LDU2_VOICE11: case P25_DFSI_LDU2_VOICE11:
{ {
::memcpy(dfsiFrame + 1U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE ::memcpy(dfsiFrame + 1U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE
dfsiFrame[12U] = P25_DFSI_STATUS_ERASE; // Status
} }
break; break;
case P25_DFSI_LDU2_VOICE12: case P25_DFSI_LDU2_VOICE12:
@ -702,7 +538,6 @@ void LC::encodeLDU2(uint8_t* data, const uint8_t* imbe)
dfsiFrame[2U] = mi[1U]; dfsiFrame[2U] = mi[1U];
dfsiFrame[3U] = mi[2U]; dfsiFrame[3U] = mi[2U];
::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE ::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE
dfsiFrame[16U] = P25_DFSI_STATUS_ERASE; // Status
} }
break; break;
case P25_DFSI_LDU2_VOICE13: case P25_DFSI_LDU2_VOICE13:
@ -711,7 +546,6 @@ void LC::encodeLDU2(uint8_t* data, const uint8_t* imbe)
dfsiFrame[2U] = mi[4U]; dfsiFrame[2U] = mi[4U];
dfsiFrame[3U] = mi[5U]; dfsiFrame[3U] = mi[5U];
::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE ::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE
dfsiFrame[16U] = P25_DFSI_STATUS_ERASE; // Status
} }
break; break;
case P25_DFSI_LDU2_VOICE14: case P25_DFSI_LDU2_VOICE14:
@ -720,7 +554,6 @@ void LC::encodeLDU2(uint8_t* data, const uint8_t* imbe)
dfsiFrame[2U] = mi[7U]; dfsiFrame[2U] = mi[7U];
dfsiFrame[3U] = mi[8U]; dfsiFrame[3U] = mi[8U];
::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE ::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE
dfsiFrame[16U] = P25_DFSI_STATUS_ERASE; // Status
} }
break; break;
case P25_DFSI_LDU2_VOICE15: case P25_DFSI_LDU2_VOICE15:
@ -730,7 +563,6 @@ void LC::encodeLDU2(uint8_t* data, const uint8_t* imbe)
dfsiFrame[2U] = (kid >> 8) & 0xFFU; // Key ID dfsiFrame[2U] = (kid >> 8) & 0xFFU; // Key ID
dfsiFrame[3U] = (kid >> 0) & 0xFFU; dfsiFrame[3U] = (kid >> 0) & 0xFFU;
::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE ::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE
dfsiFrame[16U] = P25_DFSI_STATUS_ERASE; // Status
} }
break; break;
case P25_DFSI_LDU2_VOICE16: case P25_DFSI_LDU2_VOICE16:
@ -739,7 +571,6 @@ void LC::encodeLDU2(uint8_t* data, const uint8_t* imbe)
// part of the RS(24, 16, 9) of the VOICE12, 13, 14, 15 // part of the RS(24, 16, 9) of the VOICE12, 13, 14, 15
// control bytes // control bytes
::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE ::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE
dfsiFrame[16U] = P25_DFSI_STATUS_ERASE; // Status
} }
break; break;
case P25_DFSI_LDU2_VOICE17: case P25_DFSI_LDU2_VOICE17:
@ -748,7 +579,6 @@ void LC::encodeLDU2(uint8_t* data, const uint8_t* imbe)
// part of the RS(24, 16, 9) of the VOICE12, 13, 14, 15 // part of the RS(24, 16, 9) of the VOICE12, 13, 14, 15
// control bytes // control bytes
::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE ::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE
dfsiFrame[16U] = P25_DFSI_STATUS_ERASE; // Status
} }
break; break;
case P25_DFSI_LDU2_VOICE18: case P25_DFSI_LDU2_VOICE18:
@ -762,11 +592,8 @@ void LC::encodeLDU2(uint8_t* data, const uint8_t* imbe)
case P25_DFSI_LDU2_VOICE10: case P25_DFSI_LDU2_VOICE10:
default: default:
{ {
encodeStart(dfsiFrame + 1U); // Start Record
dfsiFrame[5U] = m_icwFlag; // ICW Flag
dfsiFrame[6U] = m_rssi; // RSSI dfsiFrame[6U] = m_rssi; // RSSI
::memcpy(dfsiFrame + 10U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE ::memcpy(dfsiFrame + 10U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE
dfsiFrame[21U] = m_source; // Source
} }
break; break;
} }
@ -779,65 +606,6 @@ void LC::encodeLDU2(uint8_t* data, const uint8_t* imbe)
::memcpy(data, dfsiFrame, frameLength); ::memcpy(data, dfsiFrame, frameLength);
} }
/// <summary>
/// Decode a TSBK.
/// </summary>
/// <param name="data"></param>
/// <returns>True, if decoded, otherwise false.</returns>
bool LC::decodeTSBK(const uint8_t* data)
{
assert(data != nullptr);
if (m_tsbk != nullptr) {
delete m_tsbk;
m_tsbk = nullptr;
}
m_frameType = data[0U]; // Frame Type
if (m_frameType != P25_DFSI_TSBK) {
LogError(LOG_P25, "LC::decodeTSBK(), invalid frametype, frameType = $%02X", m_frameType);
return false;
}
decodeStart(data + 1U); // Start Record
uint8_t buffer[P25_TSBK_LENGTH_BYTES];
::memcpy(buffer, data + 9U, P25_TSBK_LENGTH_BYTES); // Raw TSBK + CRC
std::unique_ptr<lc::TSBK> tsbk = lc::tsbk::TSBKFactory::createTSBK(buffer, true);
m_tsbk = tsbk.release();
if (m_tsbk != nullptr) {
return true;
} else {
return false;
}
}
/// <summary>
/// Encode a TSBK.
/// </summary>
/// <param name="data"></param>
void LC::encodeTSBK(uint8_t* data)
{
assert(data != nullptr);
assert(m_tsbk != nullptr);
uint8_t tsbk[P25_TSBK_LENGTH_BYTES];
m_tsbk->encode(tsbk, true, true);
uint8_t dfsiFrame[P25_DFSI_TSBK_FRAME_LENGTH_BYTES];
::memset(dfsiFrame, 0x00U, P25_DFSI_TSBK_FRAME_LENGTH_BYTES);
dfsiFrame[0U] = P25_DFSI_TSBK; // Frame Type
encodeStart(dfsiFrame + 1U); // Start Record
::memcpy(dfsiFrame + 9U, tsbk, P25_TSBK_LENGTH_BYTES); // Raw TSBK + CRC
#if DEBUG_P25_DFSI
Utils::dump(2U, "LC::encodeTSBK(), DFSI TSBK Frame", dfsiFrame, P25_TSBK_LENGTH_BYTES);
#endif
::memcpy(data, dfsiFrame, P25_DFSI_TSBK_FRAME_LENGTH_BYTES);
}
// --------------------------------------------------------------------------- // ---------------------------------------------------------------------------
// Private Class Members // Private Class Members
// --------------------------------------------------------------------------- // ---------------------------------------------------------------------------
@ -849,13 +617,8 @@ void LC::encodeTSBK(uint8_t* data)
void LC::copy(const LC& data) void LC::copy(const LC& data)
{ {
m_frameType = data.m_frameType; m_frameType = data.m_frameType;
m_rtModeFlag = data.m_rtModeFlag;
m_startStopFlag = data.m_startStopFlag;
m_typeFlag = data.m_typeFlag;
m_icwFlag = data.m_icwFlag;
m_rssi = data.m_rssi; m_rssi = data.m_rssi;
m_source = data.m_source;
m_control = new lc::LC(*data.m_control); m_control = new lc::LC(*data.m_control);
m_lsd = new data::LowSpeedData(*data.m_lsd); m_lsd = new data::LowSpeedData(*data.m_lsd);
@ -867,38 +630,3 @@ void LC::copy(const LC& data)
m_mi = mi; m_mi = mi;
} }
/// <summary>
/// Decode start record data.
/// </summary>
/// <param name="data"></param>
/// <returns>True, if decoded, otherwise false.</returns>
bool LC::decodeStart(const uint8_t* data)
{
assert(data != nullptr);
m_rtModeFlag = data[0U]; // RT Mode Flag
m_startStopFlag = data[1U]; // Start/Stop Flag
m_typeFlag = data[2U]; // Type Flag
return true;
}
/// <summary>
/// Encode start record data.
/// </summary>
/// <param name="data"></param>
void LC::encodeStart(uint8_t* data)
{
assert(data != nullptr);
uint8_t rawFrame[P25_DFSI_START_LENGTH_BYTES];
::memset(rawFrame, 0x00U, P25_DFSI_START_LENGTH_BYTES);
rawFrame[0U] = 0x02U; //
rawFrame[1U] = m_rtModeFlag; // RT/RT Mode Flag
rawFrame[2U] = m_startStopFlag; // Start/Stop Flag
rawFrame[3U] = m_typeFlag; // Type flag
::memcpy(data, rawFrame, P25_DFSI_START_LENGTH_BYTES);
}

38
src/p25/dfsi/LC.h
Unescape View File

@ -60,21 +60,6 @@ namespace p25
/// <summary>Helper to set the LC data.</summary> /// <summary>Helper to set the LC data.</summary>
void setControl(const lc::LC& data); void setControl(const lc::LC& data);
/// <summary>Decode a NID start/stop.</summary>
bool decodeNID(const uint8_t* data);
/// <summary>Encode a NID start/stop.</summary>
void encodeNID(uint8_t* data);
/// <summary>Decode a voice header 1.</summary>
bool decodeVHDR1(const uint8_t* data);
/// <summary>Encode a voice header 1.</summary>
void encodeVHDR1(uint8_t* data);
/// <summary>Decode a voice header 2.</summary>
bool decodeVHDR2(const uint8_t* data);
/// <summary>Encode a voice header 2.</summary>
void encodeVHDR2(uint8_t* data);
/// <summary>Decode a logical link data unit 1.</summary> /// <summary>Decode a logical link data unit 1.</summary>
bool decodeLDU1(const uint8_t* data, uint8_t* imbe); bool decodeLDU1(const uint8_t* data, uint8_t* imbe);
/// <summary>Encode a logical link data unit 1.</summary> /// <summary>Encode a logical link data unit 1.</summary>
@ -85,36 +70,18 @@ namespace p25
/// <summary>Encode a logical link data unit 2.</summary> /// <summary>Encode a logical link data unit 2.</summary>
void encodeLDU2(uint8_t* data, const uint8_t* imbe); void encodeLDU2(uint8_t* data, const uint8_t* imbe);
/// <summary>Decode a TSBK.</summary>
bool decodeTSBK(const uint8_t* data);
/// <summary>Encode a TSBK.</summary>
void encodeTSBK(uint8_t* data);
public: public:
/** Common Data */ /** Common Data */
/// <summary>Frame Type.</summary> /// <summary>Frame Type.</summary>
__PROPERTY(uint8_t, frameType, FrameType); __PROPERTY(uint8_t, frameType, FrameType);
/// <summary>RT Mode Flag.</summary>
__PROPERTY(uint8_t, rtModeFlag, RTMode);
/// <summary>Start/Stop Flag.</summary>
__PROPERTY(uint8_t, startStopFlag, StartStop);
/// <summary>Type Flag.</summary>
__PROPERTY(uint8_t, typeFlag, Type);
/// <summary>ICW Flag.</summary>
__PROPERTY(uint8_t, icwFlag, ICW);
/// <summary>RSSI.</summary> /// <summary>RSSI.</summary>
__PROPERTY(uint8_t, rssi, RSSI); __PROPERTY(uint8_t, rssi, RSSI);
/// <summary>Source.</summary>
__PROPERTY(uint8_t, source, Source);
/// <summary>Link control data.</summary> /// <summary>Link control data.</summary>
__READONLY_PROPERTY_PLAIN(p25::lc::LC*, control, control); __READONLY_PROPERTY_PLAIN(p25::lc::LC*, control, control);
/// <summary>Low speed data.</summary> /// <summary>Low speed data.</summary>
__READONLY_PROPERTY_PLAIN(p25::data::LowSpeedData*, lsd, lsd); __READONLY_PROPERTY_PLAIN(p25::data::LowSpeedData*, lsd, lsd);
/// <summary>TSBK.</summary>
__PROPERTY_PLAIN(p25::lc::TSBK*, tsbk, tsbk);
private: private:
edac::RS634717 m_rs; edac::RS634717 m_rs;
@ -124,11 +91,6 @@ namespace p25
/// <summary>Internal helper to copy the class.</summary> /// <summary>Internal helper to copy the class.</summary>
void copy(const LC& data); void copy(const LC& data);
/// <summary>Decode start record data.</summary>
bool decodeStart(const uint8_t* data);
/// <summary>Encode start record data.</summary>
void encodeStart(uint8_t* data);
}; };
} // namespace dfsi } // namespace dfsi
} // namespace p25 } // namespace p25

Write Preview
Loading…
Cancel
Save

Powered by TurnKey Linux.