mirror of
https://github.com/lwvmobile/dsd-fme.git
synced 2026-11-20 12:45:40 -05:00
P25 Restructuring
This commit is contained in:
500
src/p25p2_vpdu.c
Normal file
500
src/p25p2_vpdu.c
Normal file
@@ -0,0 +1,500 @@
|
||||
/*-------------------------------------------------------------------------------
|
||||
* p25p2_vpdu.c
|
||||
* Phase 2 Variable PDU Handling
|
||||
*
|
||||
* LWVMOBILE
|
||||
* 2022-09 DSD-FME Florida Man Edition
|
||||
*-----------------------------------------------------------------------------*/
|
||||
|
||||
#include "dsd.h"
|
||||
|
||||
//MAC message lengths
|
||||
static const uint8_t mac_msg_len[256] = {
|
||||
0, 7, 8, 7, 0, 16, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, //0F
|
||||
0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, //1F
|
||||
0, 14, 15, 0, 0, 15, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, //2F
|
||||
5, 7, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, //3F
|
||||
9, 7, 9, 0, 9, 8, 9, 0, 10, 10, 9, 0, 10, 0, 0, 0, //4F
|
||||
0, 0, 0, 0, 9, 7, 0, 0, 10, 0, 7, 0, 10, 8, 14, 7, //5F
|
||||
9, 9, 0, 0, 9, 0, 0, 9, 10, 0, 7, 10, 10, 7, 0, 9, //6F
|
||||
9, 29, 9, 9, 9, 9, 10, 13, 9, 9, 9, 11, 9, 9, 0, 0, //7F
|
||||
8, 0, 0, 7, 11, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, //8F
|
||||
0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, //9F
|
||||
16, 0, 0, 11, 13, 11, 11, 11, 10, 0, 0, 0, 0, 0, 0, 0, //AF
|
||||
0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, //BF
|
||||
11, 0, 0, 8, 15, 12, 15, 32, 12, 12, 0, 27, 14, 29, 29, 32, //CF
|
||||
0, 0, 0, 0, 0, 0, 9, 0, 14, 29, 11, 27, 14, 0, 40, 11, //DF
|
||||
28, 0, 0, 14, 17, 14, 0, 0, 16, 8, 11, 0, 13, 19, 0, 0, //EF
|
||||
0, 0, 16, 14, 0, 0, 12, 0, 22, 0, 11, 13, 11, 0, 15, 0 }; //FF
|
||||
|
||||
|
||||
//MAC PDU 3-bit Opcodes BBAC (8.4.1) p 123:
|
||||
//0 - reserved //1 - Mac PTT //2 - Mac End PTT //3 - Mac Idle //4 - Mac Active
|
||||
//5 - reserved //6 - Mac Hangtime //7 - reserved //Mac PTT BBAC p80
|
||||
|
||||
void process_MAC_VPDU(dsd_opts * opts, dsd_state * state, int type, unsigned long long int MAC[24])
|
||||
{
|
||||
//handle variable content MAC PDUs (Active, Idle, Hangtime, or Signal)
|
||||
//use type to specify SACCH or FACCH, so we know if we should invert the currentslot when assigning ids etc
|
||||
|
||||
//b values - 0 = Unique TDMA Message, 1 Phase 1 OSP/ISP abbreviated
|
||||
// 2 = Manufacturer Message, 3 Phase 1 OSP/ISP extended/explicit
|
||||
|
||||
int len_a = 0;
|
||||
int len_b = mac_msg_len[MAC[1]];
|
||||
int len_c = 0;
|
||||
|
||||
//sanity check
|
||||
if (len_b < 19 && type == 1)
|
||||
{
|
||||
len_c = mac_msg_len[MAC[1+len_b]];
|
||||
}
|
||||
if (len_b < 16 && type == 0)
|
||||
{
|
||||
len_c = mac_msg_len[MAC[1+len_b]];
|
||||
}
|
||||
|
||||
int slot = 9;
|
||||
if (type == 1) //0 for F, 1 for S
|
||||
{
|
||||
slot = (state->currentslot ^ 1) & 1; //flip slot internally for SACCH
|
||||
}
|
||||
else slot = state->currentslot;
|
||||
|
||||
//assigning here if OECI MAC SIGNAL, after passing RS and CRC
|
||||
if (state->p2_is_lcch)
|
||||
{
|
||||
if (slot == 0) state->dmrburstL = 30;
|
||||
else state->dmrburstR = 30;
|
||||
}
|
||||
|
||||
|
||||
if (len_b == 0 || len_b > 18)
|
||||
{
|
||||
goto END_PDU;
|
||||
}
|
||||
|
||||
for (int i = 0; i < 2; i++)
|
||||
{
|
||||
|
||||
//Group Voice Channel Grant (GRP_V_CH_GRANT)
|
||||
if (MAC[1+len_a] == 0x40)
|
||||
{
|
||||
int svc = MAC[2+len_a];
|
||||
int channel = (MAC[3+len_a] << 8) | MAC[4+len_a];
|
||||
int group = (MAC[5+len_a] << 8) | MAC[6+len_a];
|
||||
int source = (MAC[7+len_a] << 16) | (MAC[8+len_a] << 8) | MAC[9+len_a];
|
||||
|
||||
fprintf (stderr, "\n Group Voice Channel Grant Update");
|
||||
fprintf (stderr, "\n SVC [%02X] CHAN [%04X] Group [%d] Source [%d]", svc, channel, group, source);
|
||||
process_channel_to_freq (opts, state, channel);
|
||||
|
||||
}
|
||||
|
||||
//Unit-to-Unit Voice Service Channel Grant (UU_V_CH_GRANT)
|
||||
if (MAC[1+len_a] == 0x44)
|
||||
{
|
||||
int channel = (MAC[2+len_a] << 8) | MAC[3+len_a];
|
||||
int target = (MAC[4+len_a] << 16) | (MAC[5+len_a] << 8) | MAC[6+len_a];
|
||||
int source = (MAC[7+len_a] << 16) | (MAC[8+len_a] << 8) | MAC[9+len_a];
|
||||
|
||||
fprintf (stderr, "\n Unit to Unit Channel Grant");
|
||||
fprintf (stderr, "\n CHAN [%04X] Source [%d] Target [%d]", channel, source, target);
|
||||
process_channel_to_freq (opts, state, channel);
|
||||
|
||||
}
|
||||
|
||||
//Unit-to-Unit Answer Request (UU_ANS_REQ)
|
||||
if (MAC[1+len_a] == 0x45)
|
||||
{
|
||||
int svc = MAC[2+len_a];
|
||||
int answer = MAC[3+len_a];
|
||||
int target = (MAC[4+len_a] << 16) | (MAC[5+len_a] << 8) | MAC[6+len_a];
|
||||
int source = (MAC[7+len_a] << 16) | (MAC[8+len_a] << 8) | MAC[9+len_a];
|
||||
|
||||
fprintf (stderr, "\n Unit to Unit Channel Answer Request");
|
||||
fprintf (stderr, "\n SVC [%02X] Answer [%02X] Source [%d] Target [%d]", svc, answer, source, target);
|
||||
|
||||
}
|
||||
|
||||
//Telephone Interconnect Voice Channel Grant (TELE_INT_CH_GRANT)
|
||||
if (MAC[1+len_a] == 0x48)
|
||||
{
|
||||
fprintf (stderr, "\n Telephone Interconnect Voice Channel Grant (TELE_INT_CH_GRANT)");
|
||||
}
|
||||
|
||||
//Telephone Interconnect Voice Channel Grant Update (TELE_INT_CH_GRANT_UPDT)
|
||||
if (MAC[1+len_a] == 0x49)
|
||||
{
|
||||
fprintf (stderr, "\n Telephone Interconnect Voice Channel Grant Update (TELE_INT_CH_GRANT_UPDT)");
|
||||
}
|
||||
|
||||
//Synchronization Broadcast (SYNC_BCST)
|
||||
if (MAC[1+len_a] == 0x70)
|
||||
{
|
||||
fprintf (stderr, "\n Synchronization Broadcast (SYNC_BCST)");
|
||||
}
|
||||
|
||||
//identifier update VHF/UHF
|
||||
if (MAC[1+len_a] == 0x74)
|
||||
{
|
||||
state->p25_chan_iden = MAC[2+len_a] >> 4;
|
||||
int iden = state->p25_chan_iden;
|
||||
|
||||
state->p25_chan_type[iden] = 1;
|
||||
int bw_vu = (MAC[2+len_a] & 0xF);
|
||||
state->p25_trans_off[iden] = (MAC[3+len_a] << 6) | (MAC[4+len_a] >> 2);
|
||||
state->p25_chan_spac[iden] = ((MAC[4+len_a] & 0x3) << 8) | MAC[5+len_a];
|
||||
state->p25_base_freq[iden] = (MAC[6+len_a] << 24) | (MAC[7+len_a] << 16) | (MAC[8+len_a] << 8) | (MAC[9+len_a] << 0);
|
||||
|
||||
fprintf (stderr, "\n Identifier Update UHF/VHF\n");
|
||||
fprintf (stderr, " Channel Identifier [%01X] BW [%01X] Transmit Offset [%04X]\n Channel Spacing [%03X] Base Frequency [%08lX] [%09ld]",
|
||||
state->p25_chan_iden, bw_vu, state->p25_trans_off[iden], state->p25_chan_spac[iden], state->p25_base_freq[iden], state->p25_base_freq[iden] * 5);
|
||||
}
|
||||
|
||||
//identifier update (Non-TDMA 6.2.22) (Non-VHF-UHF) //with signed offset, bit trans_off >> 8; bit number 9
|
||||
if (MAC[1+len_a] == 0x7D)
|
||||
{
|
||||
state->p25_chan_iden = MAC[2+len_a] >> 4;
|
||||
int iden = state->p25_chan_iden;
|
||||
|
||||
state->p25_chan_type[iden] = 1;
|
||||
int bw = ((MAC[2+len_a] & 0xF) << 5) | ((MAC[3+len_a] & 0xF8) >> 2);
|
||||
state->p25_trans_off[iden] = (MAC[3+len_a] << 6) | (MAC[4+len_a] >> 2);
|
||||
state->p25_chan_spac[iden] = ((MAC[4+len_a] & 0x3) << 8) | MAC[5+len_a];
|
||||
state->p25_base_freq[iden] = (MAC[6+len_a] << 24) | (MAC[7+len_a] << 16) | (MAC[8+len_a] << 8) | (MAC[9+len_a] << 0);
|
||||
|
||||
fprintf (stderr, "\n Identifier Update (8.3.1.23)\n");
|
||||
fprintf (stderr, " Channel Identifier [%01X] BW [%01X] Transmit Offset [%04X]\n Channel Spacing [%03X] Base Frequency [%08lX] [%09ld]",
|
||||
state->p25_chan_iden, bw, state->p25_trans_off[iden], state->p25_chan_spac[iden], state->p25_base_freq[iden], state->p25_base_freq[iden] * 5);
|
||||
}
|
||||
|
||||
//identifier update for TDMA, Abbreviated
|
||||
if (MAC[1+len_a] == 0x73)
|
||||
{
|
||||
state->p25_chan_iden = MAC[2+len_a] >> 4;
|
||||
int iden = state->p25_chan_iden;
|
||||
state->p25_chan_type[iden] = MAC[2+len_a] & 0xF;
|
||||
state->p25_trans_off[iden] = (MAC[3+len_a] << 6) | (MAC[4+len_a] >> 2);
|
||||
state->p25_chan_spac[iden] = ((MAC[4+len_a] & 0x3) << 8) | MAC[5+len_a];
|
||||
state->p25_base_freq[iden] = (MAC[6+len_a] << 24) | (MAC[7+len_a] << 16) | (MAC[8+len_a] << 8) | (MAC[9+len_a] << 0);
|
||||
|
||||
fprintf (stderr, "\n Identifier Update for TDMA - Abbreviated\n");
|
||||
fprintf (stderr, " Channel Identifier [%01X] Channel Type [%01X] Transmit Offset [%04X]\n Channel Spacing [%03X] Base Frequency [%08lX] [%09ld]",
|
||||
state->p25_chan_iden, state->p25_chan_type[iden], state->p25_trans_off[iden], state->p25_chan_spac[iden], state->p25_base_freq[iden], state->p25_base_freq[iden] * 5);
|
||||
}
|
||||
|
||||
//identifier update for TDMA, Extended
|
||||
if (MAC[1+len_a] == 0xF3)
|
||||
{
|
||||
state->p25_chan_iden = MAC[3+len_a] >> 4;
|
||||
int iden = state->p25_chan_iden;
|
||||
state->p25_chan_type[iden] = MAC[3+len_a] & 0xF;
|
||||
state->p25_trans_off[iden] = (MAC[4+len_a] << 6) | (MAC[5+len_a] >> 2);
|
||||
state->p25_chan_spac[iden] = ((MAC[5+len_a] & 0x3) << 8) | MAC[6+len_a];
|
||||
state->p25_base_freq[iden] = (MAC[7+len_a] << 24) | (MAC[8+len_a] << 16) | (MAC[9+len_a] << 8) | (MAC[10+len_a] << 0);
|
||||
int lwacn = (MAC[11+len_a] << 12) | (MAC[12+len_a] << 4) | ((MAC[13+len_a] & 0xF0) >> 4);
|
||||
int lsysid = ((MAC[13+len_a] & 0xF) << 8) | MAC[14+len_a];
|
||||
|
||||
fprintf (stderr, "\n Identifier Update for TDMA - Extended\n");
|
||||
fprintf (stderr, " Channel Identifier [%01X] Channel Type [%01X] Transmit Offset [%04X]\n Channel Spacing [%03X] Base Frequency [%08lX] [%09ld]",
|
||||
state->p25_chan_iden, state->p25_chan_type[iden], state->p25_trans_off[iden], state->p25_chan_spac[iden], state->p25_base_freq[iden], state->p25_base_freq[iden] * 5);
|
||||
fprintf (stderr, "\n WACN [%04X] SYSID [%04X]", lwacn, lsysid);
|
||||
}
|
||||
|
||||
//Secondary Control Channel Broadcast, Explicit
|
||||
if (MAC[1+len_a] == 0xE9)
|
||||
{
|
||||
int rfssid = MAC[2+len_a];
|
||||
int siteid = MAC[3+len_a];
|
||||
int channelt = (MAC[4+len_a] << 8) | MAC[5+len_a];
|
||||
int channelr = (MAC[6+len_a] << 8) | MAC[7+len_a];
|
||||
int sysclass = MAC[8+len_a];
|
||||
|
||||
if (1 == 1) //state->p2_is_lcch == 1
|
||||
{
|
||||
|
||||
fprintf (stderr, "\n Secondary Control Channel Broadcast - Explicit\n");
|
||||
fprintf (stderr, " RFSS[%03d] SITE ID [%03X] CHAN-T [%04X] CHAN-R [%04X] SSC [%02X]", rfssid, siteid, channelt, channelr, sysclass);
|
||||
|
||||
process_channel_to_freq (opts, state, channelt);
|
||||
process_channel_to_freq (opts, state, channelr);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//Secondary Control Channel Broadcast, Implicit
|
||||
if (MAC[1+len_a] == 0x79)
|
||||
{
|
||||
int rfssid = MAC[2+len_a];
|
||||
int siteid = MAC[3+len_a];
|
||||
int channel1 = (MAC[4+len_a] << 8) | MAC[5+len_a];
|
||||
int sysclass1 = MAC[6+len_a];
|
||||
int channel2 = (MAC[7+len_a] << 8) | MAC[8+len_a];
|
||||
int sysclass2 = MAC[9+len_a];
|
||||
if (1 == 1) //state->p2_is_lcch == 1
|
||||
{
|
||||
|
||||
fprintf (stderr, "\n Secondary Control Channel Broadcast - Implicit\n");
|
||||
fprintf (stderr, " RFSS[%03d] SITE ID [%03X] CHAN1 [%04X] SSC [%02X] CHAN2 [%04X] SSC [%02X]", rfssid, siteid, channel1, sysclass1, channel2, sysclass2);
|
||||
|
||||
process_channel_to_freq (opts, state, channel1);
|
||||
process_channel_to_freq (opts, state, channel2);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//Group Voice Channel Grant Update - Implicit
|
||||
if (MAC[1+len_a] == 0x42)
|
||||
{
|
||||
int channel1 = (MAC[2+len_a] << 8) | MAC[3+len_a];
|
||||
int group1 = (MAC[4+len_a] << 8) | MAC[5+len_a];
|
||||
int channel2 = (MAC[6+len_a] << 8) | MAC[7+len_a];
|
||||
int group2 = (MAC[8+len_a] << 8) | MAC[9+len_a];
|
||||
|
||||
fprintf (stderr, "\n Group Voice Channel Grant Update - Implicit");
|
||||
fprintf (stderr, "\n Channel 1 [%04X] Group 1 [%d][%04X]", channel1, group1, group1);
|
||||
|
||||
if (state->lasttg == group1)
|
||||
{
|
||||
state->p25_vc_freq[0] = process_channel_to_freq (opts, state, channel1);
|
||||
}
|
||||
else if (state->lasttgR == group1)
|
||||
{
|
||||
state->p25_vc_freq[1] = process_channel_to_freq (opts, state, channel1);
|
||||
}
|
||||
else process_channel_to_freq (opts, state, channel1);
|
||||
//only run next channel if not identical to first channel
|
||||
if (group1 != group2)
|
||||
{
|
||||
fprintf (stderr, "\n Channel 2 [%04X] Group 2 [%d][%04X]", channel2, group2, group2);
|
||||
if (state->lasttg == group2)
|
||||
{
|
||||
state->p25_vc_freq[0] = process_channel_to_freq (opts, state, channel2);
|
||||
}
|
||||
else if (state->lasttgR == group2)
|
||||
{
|
||||
state->p25_vc_freq[1] = process_channel_to_freq (opts, state, channel2);
|
||||
}
|
||||
else process_channel_to_freq (opts, state, channel2);
|
||||
|
||||
}
|
||||
|
||||
|
||||
|
||||
}
|
||||
|
||||
//Group Voice Channel Grant Update - Explicit
|
||||
if (MAC[1+len_a] == 0xC3)
|
||||
{
|
||||
int svc = MAC[2+len_a];
|
||||
int channelt = (MAC[3+len_a] << 8) | MAC[4+len_a];
|
||||
int channelr = (MAC[5+len_a] << 8) | MAC[6+len_a];
|
||||
int group = (MAC[7+len_a] << 8) | MAC[8+len_a];
|
||||
|
||||
fprintf (stderr, "\n Group Voice Channel Grant Update - Explicit");
|
||||
fprintf (stderr, "\n SVC [%02X] CHAN-T [%04X] CHAN-R [%04X] Group [%d][%04X]", svc, channelt, channelr, group, group);
|
||||
process_channel_to_freq (opts, state, channelt);
|
||||
process_channel_to_freq (opts, state, channelr);
|
||||
if (slot == 0)
|
||||
{
|
||||
state->lasttg = group;
|
||||
}
|
||||
else state->lasttgR = group;
|
||||
|
||||
}
|
||||
|
||||
//MFID90 Group Regroup Voice Channel User - Abbreviated
|
||||
if (MAC[1+len_a] == 0x80 && MAC[2+len_a] == 0x90)
|
||||
{
|
||||
|
||||
int gr = (MAC[4+len_a] << 8) | MAC[5+len_a];
|
||||
int src = (MAC[6+len_a] << 16) | (MAC[7+len_a] << 8) | MAC[8+len_a];
|
||||
fprintf (stderr, "\n VCH %d - Super Group %d SRC %d ", slot, gr, src);
|
||||
fprintf (stderr, "MFID90 Group Regroup Voice");
|
||||
|
||||
if (slot == 0)
|
||||
{
|
||||
state->lasttg = gr;
|
||||
if (src != 0) state->lastsrc = src;
|
||||
}
|
||||
else
|
||||
{
|
||||
state->lasttgR = gr;
|
||||
if (src != 0) state->lastsrcR = src;
|
||||
}
|
||||
}
|
||||
//MFID90 Group Regroup Voice Channel User - Extended
|
||||
if (MAC[1+len_a] == 0xA0 && MAC[2+len_a] == 0x90)
|
||||
{
|
||||
|
||||
int gr = (MAC[5+len_a] << 8) | MAC[6+len_a];
|
||||
int src = (MAC[7+len_a] << 16) | (MAC[8+len_a] << 8) | MAC[9+len_a];
|
||||
fprintf (stderr, "\n VCH %d - Super Group %d SRC %d ", slot, gr, src);
|
||||
fprintf (stderr, "MFID90 Group Regroup Voice");
|
||||
|
||||
if (slot == 0)
|
||||
{
|
||||
state->lasttg = gr;
|
||||
if (src != 0) state->lastsrc = src;
|
||||
}
|
||||
else
|
||||
{
|
||||
state->lasttgR = gr;
|
||||
if (src != 0) state->lastsrcR = src;
|
||||
}
|
||||
}
|
||||
|
||||
//1 or 21, group voice channel message, abb and ext
|
||||
if (MAC[1+len_a] == 0x1 || MAC[1+len_a] == 0x21)
|
||||
{
|
||||
int svc = MAC[2+len_a];
|
||||
int gr = (MAC[3+len_a] << 8) | MAC[4+len_a];
|
||||
int src = (MAC[5+len_a] << 16) | (MAC[6+len_a] << 8) | MAC[7+len_a];
|
||||
|
||||
fprintf (stderr, "\n VCH %d - TG %d SRC %d ", slot, gr, src);
|
||||
fprintf (stderr, "Group Voice");
|
||||
|
||||
if (slot == 0)
|
||||
{
|
||||
state->lasttg = gr;
|
||||
if (src != 0) state->lastsrc = src;
|
||||
}
|
||||
else
|
||||
{
|
||||
state->lasttgR = gr;
|
||||
if (src != 0) state->lastsrcR = src;
|
||||
}
|
||||
}
|
||||
//1 or 21, group voice channel message, abb and ext
|
||||
if (MAC[1+len_a] == 0x2 || MAC[1+len_a] == 0x22)
|
||||
{
|
||||
int svc = MAC[2+len_a];
|
||||
int gr = (MAC[3+len_a] << 16) | (MAC[4+len_a] << 8) | MAC[5+len_a];
|
||||
int src = (MAC[6+len_a] << 16) | (MAC[7+len_a] << 8) | MAC[8+len_a];
|
||||
|
||||
fprintf (stderr, "\n VCH %d - TG %d SRC %d ", slot, gr, src);
|
||||
fprintf (stderr, "Unit to Unit Voice");
|
||||
|
||||
if (slot == 0)
|
||||
{
|
||||
state->lasttg = gr;
|
||||
if (src != 0) state->lastsrc = src;
|
||||
}
|
||||
else
|
||||
{
|
||||
state->lasttgR = gr;
|
||||
if (src != 0) state->lastsrcR = src;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
|
||||
//network status broadcast, abbreviated
|
||||
if (MAC[1+len_a] == 0x7B)
|
||||
{
|
||||
int lra = MAC[2+len_a];
|
||||
int lwacn = (MAC[3+len_a] << 12) | (MAC[4+len_a] << 4) | ((MAC[5+len_a] & 0xF0) >> 4);
|
||||
int lsysid = ((MAC[5+len_a] & 0xF) << 8) | MAC[6+len_a];
|
||||
int channel = (MAC[7+len_a] << 8) | MAC[8+len_a];
|
||||
int sysclass = MAC[9+len_a];
|
||||
int lcolorcode = ((MAC[10+len_a] & 0xF) << 8) | MAC[11+len_a];
|
||||
fprintf (stderr, "\n Network Status Broadcast - Abbreviated \n");
|
||||
fprintf (stderr, " LRA [%02X] WACN [%05X] SYSID [%03X] NAC [%03X] CHAN-T [%04X]", lra, lwacn, lsysid, lcolorcode, channel);
|
||||
state->p25_cc_freq = process_channel_to_freq (opts, state, channel);
|
||||
if (state->p2_hardset == 0 ) //state->p2_is_lcch == 1 shim until CRC is working, prevent bogus data
|
||||
{
|
||||
state->p2_wacn = lwacn;
|
||||
state->p2_sysid = lsysid;
|
||||
state->p2_cc = lcolorcode;
|
||||
}
|
||||
|
||||
}
|
||||
//network status broadcast, extended
|
||||
if (MAC[1+len_a] == 0xFB)
|
||||
{
|
||||
int lra = MAC[2+len_a];
|
||||
int lwacn = (MAC[3+len_a] << 12) | (MAC[4+len_a] << 4) | ((MAC[5+len_a] & 0xF0) >> 4);
|
||||
int lsysid = ((MAC[5+len_a] & 0xF) << 8) | MAC[6+len_a];
|
||||
int channelt = (MAC[7+len_a] << 8) | MAC[8+len_a];
|
||||
int channelr = (MAC[9+len_a] << 8) | MAC[10+len_a];
|
||||
int sysclass = MAC[9+len_a];
|
||||
int lcolorcode = ((MAC[12+len_a] & 0xF) << 8) | MAC[13+len_a];
|
||||
fprintf (stderr, "\n Network Status Broadcast - Extended \n");
|
||||
fprintf (stderr, " LRA [%02X] WACN [%05X] SYSID [%03X] NAC [%03X] CHAN-T [%04X] CHAN-R [%04X]", lra, lwacn, lsysid, lcolorcode, channelt, channelr);
|
||||
process_channel_to_freq (opts, state, channelt);
|
||||
process_channel_to_freq (opts, state, channelr);
|
||||
if (state->p2_hardset == 0 ) //state->p2_is_lcch == 1 shim until CRC is working, prevent bogus data
|
||||
{
|
||||
state->p2_wacn = lwacn;
|
||||
state->p2_sysid = lsysid;
|
||||
state->p2_cc = lcolorcode;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//Adjacent Status Broadcast, abbreviated
|
||||
if (MAC[1+len_a] == 0x7C)
|
||||
{
|
||||
int lra = MAC[2+len_a];
|
||||
int lsysid = ((MAC[3+len_a] & 0xF) << 8) | MAC[4+len_a];
|
||||
int rfssid = MAC[5+len_a];
|
||||
int siteid = MAC[6+len_a];
|
||||
int channelt = (MAC[7+len_a] << 8) | MAC[8+len_a];
|
||||
int sysclass = MAC[9+len_a];
|
||||
if (1 == 1) //state->p2_is_lcch == 1
|
||||
{
|
||||
fprintf (stderr, "\n Adjacent Status Broadcast - Abbreviated\n");
|
||||
fprintf (stderr, " LRA [%02X] RFSS[%03d] SYSID [%03X] CHAN-T [%04X] SSC [%02X]", lra, rfssid, lsysid, channelt, sysclass);
|
||||
process_channel_to_freq (opts, state, channelt);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
//Adjacent Status Broadcast, extended
|
||||
if (MAC[1+len_a] == 0xFC)
|
||||
{
|
||||
int lra = MAC[2+len_a];
|
||||
int lsysid = ((MAC[3+len_a] & 0xF) << 8) | MAC[4+len_a];
|
||||
int rfssid = MAC[5+len_a];
|
||||
int siteid = MAC[6+len_a];
|
||||
int channelt = (MAC[7+len_a] << 8) | MAC[8+len_a];
|
||||
int channelr = (MAC[9+len_a] << 8) | MAC[10+len_a];
|
||||
int sysclass = MAC[9+len_a];
|
||||
if (1 == 1) //state->p2_is_lcch == 1
|
||||
{
|
||||
fprintf (stderr, "\n Adjacent Status Broadcast - Extended\n");
|
||||
fprintf (stderr, " LRA [%02X] RFSS[%03d] SYSID [%03X] CHAN-T [%04X] CHAN-R [%04X] SSC [%02X]", lra, rfssid, lsysid, channelt, channelr, sysclass);
|
||||
process_channel_to_freq (opts, state, channelt);
|
||||
process_channel_to_freq (opts, state, channelr);
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
if ( (len_b + len_c) < 24 && len_c != 0)
|
||||
{
|
||||
len_a = len_b;
|
||||
}
|
||||
else
|
||||
{
|
||||
goto END_PDU;
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
END_PDU:
|
||||
state->p2_is_lcch = 0;
|
||||
//debug printing
|
||||
if (opts->payload == 1) //print only if not a null type //&& MAC[1] != 0 //&& MAC[2] != 0
|
||||
{
|
||||
fprintf (stderr, "%s", KCYN);
|
||||
fprintf (stderr, "\n P25 PDU Payload\n ");
|
||||
for (int i = 0; i < 24; i++)
|
||||
{
|
||||
fprintf (stderr, "[%02llX]", MAC[i]);
|
||||
if (i == 11) fprintf (stderr, "\n ");
|
||||
}
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
}
|
||||
|
||||
}
|
||||
Reference in New Issue
Block a user