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

fill out LDU2 DFSI data;

Browse Source
pull/39/head
Bryan Biedenkapp 3 years ago
parent 3e25951d9d
commit 69bb8ec5ea
1 changed files with 31 additions and 19 deletions
Show Stats Download Patch File Download Diff File

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

@ -520,6 +520,19 @@ void LC::encodeLDU2(uint8_t* data, const uint8_t* imbe)
break; break;
} }
uint8_t rs[P25_LDU_LC_LENGTH_BYTES];
::memset(rs, 0x00U, P25_LDU_LC_LENGTH_BYTES);
for (uint32_t i = 0; i < P25_MI_LENGTH_BYTES; i++)
rs[i] = m_mi[i]; // Message Indicator
rs[9U] = m_control->getAlgId(); // Algorithm ID
rs[10U] = (m_control->getKId() >> 8) & 0xFFU; // Key ID
rs[11U] = (m_control->getKId() >> 0) & 0xFFU; // ...
// encode RS (24,16,9) FEC
m_rs.encode24169(rs);
uint8_t dfsiFrame[frameLength]; uint8_t dfsiFrame[frameLength];
dfsiFrame[0U] = m_frameType; // Frame Type dfsiFrame[0U] = m_frameType; // Frame Type
@ -534,50 +547,49 @@ void LC::encodeLDU2(uint8_t* data, const uint8_t* imbe)
break; break;
case P25_DFSI_LDU2_VOICE12: case P25_DFSI_LDU2_VOICE12:
{ {
dfsiFrame[1U] = mi[0U]; // Message Indicator dfsiFrame[1U] = rs[0U]; // Message Indicator
dfsiFrame[2U] = mi[1U]; dfsiFrame[2U] = rs[1U];
dfsiFrame[3U] = mi[2U]; dfsiFrame[3U] = rs[2U];
::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE ::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE
} }
break; break;
case P25_DFSI_LDU2_VOICE13: case P25_DFSI_LDU2_VOICE13:
{ {
dfsiFrame[1U] = mi[3U]; // Message Indicator dfsiFrame[1U] = rs[3U]; // Message Indicator
dfsiFrame[2U] = mi[4U]; dfsiFrame[2U] = rs[4U];
dfsiFrame[3U] = mi[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
} }
break; break;
case P25_DFSI_LDU2_VOICE14: case P25_DFSI_LDU2_VOICE14:
{ {
dfsiFrame[1U] = mi[6U]; // Message Indicator dfsiFrame[1U] = rs[6U]; // Message Indicator
dfsiFrame[2U] = mi[7U]; dfsiFrame[2U] = rs[7U];
dfsiFrame[3U] = mi[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
} }
break; break;
case P25_DFSI_LDU2_VOICE15: case P25_DFSI_LDU2_VOICE15:
{ {
dfsiFrame[1U] = m_control->getAlgId(); // Algorithm ID dfsiFrame[1U] = rs[9U]; // Algorithm ID
uint32_t kid = m_control->getKId(); dfsiFrame[2U] = rs[10U]; // Key ID
dfsiFrame[2U] = (kid >> 8) & 0xFFU; // Key ID dfsiFrame[3U] = rs[11U];
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
} }
break; break;
case P25_DFSI_LDU2_VOICE16: case P25_DFSI_LDU2_VOICE16:
{ {
// first 3 bytes of frame are supposed to be dfsiFrame[1U] = rs[12U]; // RS (24,16,9)
// part of the RS(24, 16, 9) of the VOICE12, 13, 14, 15 dfsiFrame[2U] = rs[13U]; // RS (24,16,9)
// control bytes dfsiFrame[3U] = rs[14U]; // RS (24,16,9)
::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE ::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE
} }
break; break;
case P25_DFSI_LDU2_VOICE17: case P25_DFSI_LDU2_VOICE17:
{ {
// first 3 bytes of frame are supposed to be dfsiFrame[1U] = rs[15U]; // RS (24,16,9)
// part of the RS(24, 16, 9) of the VOICE12, 13, 14, 15 dfsiFrame[2U] = rs[16U]; // RS (24,16,9)
// control bytes dfsiFrame[3U] = rs[17U]; // RS (24,16,9)
::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE ::memcpy(dfsiFrame + 5U, imbe, P25_RAW_IMBE_LENGTH_BYTES); // IMBE
} }
break; break;

Write Preview
Loading…
Cancel
Save

Powered by TurnKey Linux.