mirror of
https://github.com/lwvmobile/dsd-fme.git
synced 2026-11-19 20:27:26 -05:00
NXDN CAC/CCH Messages; Initial Trunking Support;
This commit is contained in:
@@ -12,53 +12,6 @@
|
||||
|
||||
#include "dsd.h"
|
||||
|
||||
#define NXDN_VCALL 0b000001 /* VCALL = VCALL_REQ = VCALL_RESP */
|
||||
#define NXDN_VCALL_IV 0b000011
|
||||
#define NXDN_DCALL_HDR 0b001001 /* Header Format - NXDN_DCALL_HDR = NXDN_DCALL_REQ = NXDN_DCALL_RESP */
|
||||
#define NXDN_DCALL_USR 0b001011 /* User Data Format */
|
||||
#define NXDN_DCALL_ACK 0b001100
|
||||
#define NXDN_REL_EX 0b000111
|
||||
#define NXDN_HEAD_DLY 0b001111
|
||||
#define NXDN_SDCALL_REQ_HDR 0b111000 /* Header Format */
|
||||
#define NXDN_SDCALL_REQ_USR 0b111001 /* User Data Format */
|
||||
#define NXDN_SDCALL_RESP 0b111011
|
||||
#define NXDN_SDCALL_IV 0b111010
|
||||
#define NXDN_STAT_INQ_REQ 0b110000
|
||||
#define NXDN_STAT_INQ_RESP 0b110001
|
||||
#define NXDN_STAT_REQ 0b110010
|
||||
#define NXDN_STAT_RESP 0b110011
|
||||
#define NXDN_REM_CON_REQ 0b110100
|
||||
#define NXDN_REM_CON_RESP 0b110101
|
||||
#define NXDN_REM_CON_E_REQ 0b110110
|
||||
#define NXDN_REM_CON_E_RESP 0b110111
|
||||
//NXDN_VCALL_REQ = 0b000001, /* VCALL = VCALL_REQ = VCALL_RESP */
|
||||
//NXDN_VCALL_RESP = 0b000001, /* VCALL = VCALL_REQ = VCALL_RESP */
|
||||
#define NXDN_VCALL_REC_REQ = 0b000010 /* NXDN_VCALL_REC_REQ = NXDN_VCALL_REC_RESP */
|
||||
//NXDN_VCALL_REC_RESP = 0b000010,
|
||||
#define NXDN_VCALL_CONN_REQ = 0b000011 /* NXDN_VCALL_CONN_REQ = NXDN_VCALL_CONN_RESP */
|
||||
//NXDN_VCALL_CONN_RESP = 0b000011, /* NXDN_VCALL_CONN_REQ = NXDN_VCALL_CONN_RESP */
|
||||
#define NXDN_VCALL_ASSGN_DUP = 0b000101
|
||||
//NXDN_DCALL_REQ = 0b001001, /* NXDN_DCALL_HDR = NXDN_DCALL_REQ = NXDN_DCALL_RESP */
|
||||
//NXDN_DCALL_RESP = 0b001001, /* NXDN_DCALL_HDR = NXDN_DCALL_REQ = NXDN_DCALL_RESP */
|
||||
#define NXDN_DCALL_REC_REQ = 0b001010 /* NXDN_DCALL_REC_REQ = NXDN_DCALL_REC_RESP */
|
||||
//NXDN_DCALL_REC_RESP = 0b001010, /* NXDN_DCALL_REC_REQ = NXDN_DCALL_REC_RESP */
|
||||
#define NXDN_DCALL_ASSGN = 0b001110
|
||||
#define NXDN_DCALL_ASSGN_DUP = 0b001101
|
||||
#define NXDN_IDLE 0b010000
|
||||
#define NXDN_DISC_REQ = 0b010001 /* NXDN_DISC_REQ = NXDN_DISC */
|
||||
#define NXDN_DISC = 0b010001 /* NXDN_DISC_REQ = NXDN_DISC */
|
||||
|
||||
/*
|
||||
* @brief : This function decodes the full SACCH (when 4 voice frame parts
|
||||
* have been successfully received)
|
||||
*
|
||||
* @param opts : Option structure parameters pointer
|
||||
*
|
||||
* @param state : State structure parameters pointer
|
||||
*
|
||||
* @return None
|
||||
*
|
||||
*/
|
||||
void NXDN_SACCH_Full_decode(dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
uint8_t SACCH[72];
|
||||
@@ -78,8 +31,8 @@ void NXDN_SACCH_Full_decode(dsd_opts * opts, dsd_state * state)
|
||||
}
|
||||
|
||||
/* Decodes the element content */
|
||||
//run it under crccorrect, or under payload (if incorrect, hide bad data unless payload enabled)
|
||||
if (CrcCorrect == 1 || opts->payload == 1) NXDN_Elements_Content_decode(opts, state, CrcCorrect, SACCH);
|
||||
// currently only going to run this if all four CRCs are good
|
||||
if (CrcCorrect == 1) NXDN_Elements_Content_decode(opts, state, CrcCorrect, SACCH);
|
||||
|
||||
} /* End NXDN_SACCH_Full_decode() */
|
||||
|
||||
@@ -112,23 +65,49 @@ void NXDN_Elements_Content_decode(dsd_opts * opts, dsd_state * state,
|
||||
/* Decode the right "Message Type" */
|
||||
switch(MessageType)
|
||||
{
|
||||
//VCALL_ASSGN
|
||||
case 0x04:
|
||||
//continue flow to DUP, both use same message format
|
||||
|
||||
//VCALL_ASSGN_DUP
|
||||
case 0x05:
|
||||
NXDN_decode_VCALL_ASSGN(opts, state, ElementsContent);
|
||||
break;
|
||||
|
||||
//Alias 0x3F
|
||||
case 0x3F:
|
||||
{
|
||||
state->NxdnElementsContent.VCallCrcIsGood = CrcCorrect;
|
||||
NXDN_decode_Alias(opts, state, ElementsContent);
|
||||
}
|
||||
break;
|
||||
break;
|
||||
|
||||
//SRV_INFO
|
||||
case 0x19:
|
||||
NXDN_decode_srv_info(opts, state, ElementsContent);
|
||||
break;
|
||||
|
||||
//CCH_INFO
|
||||
case 0x1A:
|
||||
NXDN_decode_cch_info(opts, state, ElementsContent);
|
||||
break;
|
||||
|
||||
//SITE_INFO
|
||||
case 0x18:
|
||||
NXDN_decode_site_info(opts, state, ElementsContent);
|
||||
break;
|
||||
|
||||
//DISC
|
||||
case 0x11:
|
||||
//NXDN_decode_VCALL(opts, state, ElementsContent);
|
||||
break;
|
||||
|
||||
//Idle
|
||||
case NXDN_IDLE:
|
||||
case 0x10:
|
||||
{
|
||||
//sprintf (state->nxdn_call_type, "NXDN IDLE ");
|
||||
break;
|
||||
}
|
||||
|
||||
|
||||
/* VCALL */
|
||||
case NXDN_VCALL:
|
||||
case 0x01:
|
||||
{
|
||||
|
||||
/* Set the CRC state */
|
||||
@@ -147,7 +126,7 @@ void NXDN_Elements_Content_decode(dsd_opts * opts, dsd_state * state,
|
||||
} /* End case NXDN_VCALL: */
|
||||
|
||||
/* VCALL_IV */
|
||||
case NXDN_VCALL_IV:
|
||||
case 0x03:
|
||||
{
|
||||
|
||||
/* Set the CRC state */
|
||||
@@ -181,13 +160,131 @@ void NXDN_Elements_Content_decode(dsd_opts * opts, dsd_state * state,
|
||||
/* Unknown Message Type */
|
||||
default:
|
||||
{
|
||||
//fprintf(stderr, "Unknown Message type ");
|
||||
break;
|
||||
}
|
||||
} /* End switch(MessageType) */
|
||||
|
||||
} /* End NXDN_Elements_Content_decode() */
|
||||
|
||||
void NXDN_decode_VCALL_ASSGN(dsd_opts * opts, dsd_state * state, uint8_t * Message)
|
||||
{
|
||||
//just using 'short form' M only data, not the optional data
|
||||
uint8_t CCOption = 0;
|
||||
uint8_t CallType = 0;
|
||||
uint8_t VoiceCallOption = 0;
|
||||
uint16_t SourceUnitID = 0;
|
||||
uint16_t DestinationID = 0;
|
||||
uint8_t CallTimer = 0;
|
||||
uint16_t Channel = 0;
|
||||
uint8_t LocationIDOption = 0;
|
||||
|
||||
uint8_t DuplexMode[32] = {0};
|
||||
uint8_t TransmissionMode[32] = {0};
|
||||
|
||||
/* Decode "CC Option" */
|
||||
CCOption = (uint8_t)ConvertBitIntoBytes(&Message[8], 8);
|
||||
state->NxdnElementsContent.CCOption = CCOption;
|
||||
|
||||
/* Decode "Call Type" */
|
||||
CallType = (uint8_t)ConvertBitIntoBytes(&Message[16], 3);
|
||||
state->NxdnElementsContent.CallType = CallType;
|
||||
|
||||
/* Decode "Voice Call Option" */
|
||||
VoiceCallOption = (uint8_t)ConvertBitIntoBytes(&Message[19], 5);
|
||||
state->NxdnElementsContent.VoiceCallOption = VoiceCallOption;
|
||||
|
||||
/* Decode "Source Unit ID" */
|
||||
SourceUnitID = (uint16_t)ConvertBitIntoBytes(&Message[24], 16);
|
||||
state->NxdnElementsContent.SourceUnitID = SourceUnitID;
|
||||
|
||||
/* Decode "Destination ID" */
|
||||
DestinationID = (uint16_t)ConvertBitIntoBytes(&Message[40], 16);
|
||||
state->NxdnElementsContent.DestinationID = DestinationID;
|
||||
|
||||
/* Decode "Call Timer" */ //unsure of format of call timer, not required info for trunking
|
||||
CallTimer = (uint8_t)ConvertBitIntoBytes(&Message[56], 6);
|
||||
|
||||
/* Decode "Channel" */
|
||||
Channel = (uint16_t)ConvertBitIntoBytes(&Message[62], 10);
|
||||
|
||||
/* Decode "Location ID Option" */ //is in the optional field, probably best not to run this one
|
||||
//LocationIDOption = (uint8_t)ConvertBitIntoBytes(&Message[72], 5);
|
||||
|
||||
/* Print the "CC Option" */
|
||||
if(CCOption & 0x80) fprintf(stderr, "Emergency ");
|
||||
if(CCOption & 0x40) fprintf(stderr, "Visitor ");
|
||||
if(CCOption & 0x20) fprintf(stderr, "Priority Paging ");
|
||||
|
||||
/* Print the "Call Type" */
|
||||
fprintf (stderr, "%s", KGRN);
|
||||
fprintf(stderr, "\n %s - ", NXDN_Call_Type_To_Str(CallType));
|
||||
|
||||
/* Print the "Voice Call Option" */
|
||||
NXDN_Voice_Call_Option_To_Str(VoiceCallOption, DuplexMode, TransmissionMode);
|
||||
fprintf(stderr, "%s %s - ", DuplexMode, TransmissionMode);
|
||||
|
||||
/* Print Source ID and Destination ID (Talk Group or Unit ID) */
|
||||
fprintf(stderr, "Src=%u - Dst/TG=%u ", SourceUnitID & 0xFFFF, DestinationID & 0xFFFF);
|
||||
|
||||
/* Print Channel (Skipping Call Timer)*/
|
||||
fprintf(stderr, "- Channel [%03X][%04d] ", Channel & 0x3FF, Channel & 0x3FF);
|
||||
|
||||
//run process to figure out frequency value from the channel, or from lcn import array
|
||||
long int freq = 0;
|
||||
freq = nxdn_channel_to_frequency(opts, Channel);
|
||||
|
||||
//run group/source analysis and tune if available/desired
|
||||
//group list mode so we can look and see if we need to block tuning any groups, etc
|
||||
char mode[8]; //allow, block, digital, enc, etc
|
||||
|
||||
for (int i = 0; i < state->group_tally; i++)
|
||||
{
|
||||
if (state->group_array[i].groupNumber == DestinationID) //source, or destination?
|
||||
{
|
||||
fprintf (stderr, " [%s]", state->group_array[i].groupName);
|
||||
strcpy (mode, state->group_array[i].groupMode);
|
||||
}
|
||||
//might not be ideal if both source and group/target are both in the array
|
||||
else if (state->group_array[i].groupNumber == SourceUnitID) //source, or destination?
|
||||
{
|
||||
fprintf (stderr, " [%s]", state->group_array[i].groupName);
|
||||
strcpy (mode, state->group_array[i].groupMode);
|
||||
}
|
||||
}
|
||||
|
||||
//check to see if the source/target candidate is blocked first
|
||||
if (opts->p25_trunk == 1 && (strcmp(mode, "DE") != 0) && (strcmp(mode, "B") != 0)) //DE is digital encrypted, B is block
|
||||
{
|
||||
if (opts->p25_is_tuned == 0 && freq != 0) //if we aren't already on a VC and have a valid frequency already
|
||||
{
|
||||
//rigctl
|
||||
if (opts->use_rigctl == 1)
|
||||
{
|
||||
//may or may not use setmod here, let user control it instead?
|
||||
if (opts->frame_nxdn48 == 1) SetModulation(opts->rigctl_sockfd, 6250);
|
||||
else SetModulation(opts->rigctl_sockfd, 12500);
|
||||
SetFreq(opts->rigctl_sockfd, freq);
|
||||
state->p25_vc_freq[0] = state->p25_vc_freq[1] = freq;
|
||||
opts->p25_is_tuned = 1; //set to 1 to set as currently tuned so we don't keep tuning nonstop
|
||||
}
|
||||
//rtl_udp
|
||||
else if (opts->audio_in_type == 3)
|
||||
{
|
||||
rtl_udp_tune (opts, state, freq);
|
||||
state->p25_vc_freq[0] = state->p25_vc_freq[1] = freq;
|
||||
opts->p25_is_tuned = 1;
|
||||
}
|
||||
//set rid and tg when we actually tune to it
|
||||
state->nxdn_last_rid = SourceUnitID & 0xFFFF;
|
||||
state->nxdn_last_tg = (DestinationID & 0xFFFF);
|
||||
sprintf (state->nxdn_call_type, "%s", NXDN_Call_Type_To_Str(CallType));
|
||||
}
|
||||
}
|
||||
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
|
||||
} /* End NXDN_decode_VCALL_ASSGN() */
|
||||
|
||||
void NXDN_decode_Alias(dsd_opts * opts, dsd_state * state, uint8_t * Message)
|
||||
{
|
||||
uint8_t Alias1 = 0x0; //value of an ascii 'NULL' character
|
||||
@@ -195,8 +292,15 @@ void NXDN_decode_Alias(dsd_opts * opts, dsd_state * state, uint8_t * Message)
|
||||
uint8_t Alias3 = 0x0;
|
||||
uint8_t Alias4 = 0x0;
|
||||
uint8_t blocknumber = 0;
|
||||
uint8_t CrcCorrect = 1;
|
||||
state->NxdnElementsContent.VCallCrcIsGood = CrcCorrect;
|
||||
uint8_t CrcCorrect = 0;
|
||||
|
||||
//alias can also hit on a facch1 so that would be with a non_sf_sacch attached
|
||||
if (state->nxdn_sacch_non_superframe == FALSE)
|
||||
{
|
||||
CrcCorrect = state->NxdnElementsContent.VCallCrcIsGood;
|
||||
}
|
||||
else CrcCorrect = 1; //FACCH1 with bad CRC won't make it this far anyways, so set as 1
|
||||
|
||||
|
||||
//FACCH Payload [3F][68][82][04][2 <- block number4] "[69][6F][6E][20]" <- 4 alias octets [00][7F][1C]
|
||||
blocknumber = (uint8_t)ConvertBitIntoBytes(&Message[32], 4) & 0x7; // & 0x7, might just be three bits, unsure
|
||||
@@ -226,9 +330,11 @@ void NXDN_decode_Alias(dsd_opts * opts, dsd_state * state, uint8_t * Message)
|
||||
else ; //sprintf (state->nxdn_alias_block_segment[blocknumber-1][3], "%c", 0);
|
||||
}
|
||||
|
||||
if (CrcCorrect) //was by blocknumber being 4, but wasn't as frequent as I would like in the console
|
||||
//crc errs in one repitition may occlude an otherwise good alias, so test and change if needed
|
||||
//completed alias should still appear in ncurses terminal regardless, so this may be okay
|
||||
if (CrcCorrect)
|
||||
{
|
||||
fprintf (stderr, " "); //probably just want a space instead
|
||||
fprintf (stderr, " "); //spacer
|
||||
for (int i = 0; i < 4; i++)
|
||||
{
|
||||
for (int j = 0; j < 4; j++)
|
||||
@@ -243,25 +349,197 @@ void NXDN_decode_Alias(dsd_opts * opts, dsd_state * state, uint8_t * Message)
|
||||
|
||||
void NXDN_decode_cch_info(dsd_opts * opts, dsd_state * state, uint8_t * Message)
|
||||
{
|
||||
uint8_t location_id = 0;
|
||||
uint8_t channel_ifno = 0;
|
||||
uint32_t location_id = 0;
|
||||
uint8_t channel1sts = 0;
|
||||
uint16_t channel1 = 0;
|
||||
uint8_t channel2sts = 0;
|
||||
uint16_t channel2 = 0;
|
||||
long int freq1 = 0;
|
||||
long int freq2 = 0;
|
||||
|
||||
location_id = (uint32_t)ConvertBitIntoBytes(&Message[8], 24);
|
||||
channel1sts = (uint8_t)ConvertBitIntoBytes(&Message[32], 6);
|
||||
channel1 = (uint16_t)ConvertBitIntoBytes(&Message[38], 10);
|
||||
channel2sts = (uint8_t)ConvertBitIntoBytes(&Message[48], 6);
|
||||
channel2 = (uint16_t)ConvertBitIntoBytes(&Message[54], 10);
|
||||
|
||||
fprintf (stderr, "%s", KYEL);
|
||||
nxdn_location_id_handler (state, location_id);
|
||||
fprintf (stderr, "\n Control Channel Information \n");
|
||||
fprintf (stderr, " Location ID [%06X] CC1 [%03X][%04d] CC2 [%03X][%04d] Status: ", location_id, channel1, channel1, channel2, channel2);
|
||||
|
||||
//check the sts bits to determine if current, new, add, or delete
|
||||
if (channel1sts & 0x20) fprintf (stderr, "Current ");
|
||||
else if (channel1sts & 0x10) fprintf (stderr, "New ");
|
||||
else if (channel1sts & 0x8) fprintf (stderr, "Candidate Added ");
|
||||
else if (channel1sts & 0x4) fprintf (stderr, "Candidate Deleted ");
|
||||
freq1 = nxdn_channel_to_frequency (opts, channel1);
|
||||
freq2 = nxdn_channel_to_frequency (opts, channel2);
|
||||
|
||||
//add handling for adding (or deleting?) frequencies to CC list
|
||||
if (channel1sts & 0x20 || channel1sts & 0x8) //current or new only
|
||||
{
|
||||
if (freq1 != 0) state->p25_cc_freq = freq1;
|
||||
}
|
||||
else if (channel1sts & 0x8) //Candidate Added
|
||||
{
|
||||
if (freq1 != 0)
|
||||
{
|
||||
//add to trunk_lcn_freq list?
|
||||
for (int i = 0; i <= state->lcn_freq_count; i++) //<= pretty sure is correct here since we need to go through atleast one rep
|
||||
{
|
||||
if (freq1 == state->trunk_lcn_freq[i]) goto SKIP;
|
||||
}
|
||||
//assign if freq1 not found in array
|
||||
state->trunk_lcn_freq[state->lcn_freq_count] = freq1;
|
||||
state->lcn_freq_count++;
|
||||
}
|
||||
}
|
||||
|
||||
//if a delete, let's not bother trying to remove it from the list for now
|
||||
SKIP: ; //do nothing
|
||||
//channel 2 should only be valid on 'current' status, but not sure what value it would contain vs channel 1
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
}
|
||||
|
||||
void NXDN_decode_srv_info(dsd_opts * opts, dsd_state * state, uint8_t * Message)
|
||||
{
|
||||
uint32_t location_id = 0;
|
||||
uint16_t svc_info = 0; //service information
|
||||
uint32_t rst_info = 0; //restriction information
|
||||
|
||||
location_id = (uint32_t)ConvertBitIntoBytes(&Message[8], 24);
|
||||
svc_info = (uint16_t)ConvertBitIntoBytes(&Message[32], 16);
|
||||
rst_info = (uint32_t)ConvertBitIntoBytes(&Message[48], 24);
|
||||
|
||||
fprintf (stderr, "%s", KYEL);
|
||||
fprintf (stderr, "\n Service Information - ");
|
||||
fprintf (stderr, "Location ID [%06X] SVC [%04X] RST [%06X] ", location_id, svc_info, rst_info);
|
||||
nxdn_location_id_handler (state, location_id);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
|
||||
}
|
||||
|
||||
//externalize the location handler to its own function
|
||||
void nxdn_location_id_handler (dsd_state * state, uint32_t location_id)
|
||||
{
|
||||
//6.5.2 Location ID
|
||||
uint8_t category_bit = location_id >> 22;
|
||||
uint32_t sys_code = 0;
|
||||
uint16_t site_code = 0;
|
||||
|
||||
char category[14]; //G, R, or L
|
||||
|
||||
if (category_bit == 0)
|
||||
{
|
||||
sys_code = ( (location_id & 0x3FFFFF) >> 12); //10 bits
|
||||
site_code = location_id & 0x3FF; //12 bits
|
||||
sprintf (category, "%s", "Global");
|
||||
}
|
||||
else if (category_bit == 2)
|
||||
{
|
||||
sys_code = ( (location_id & 0x3FFFFF) >> 8); //14 bits
|
||||
site_code = location_id & 0xFF; //8 bits
|
||||
sprintf (category, "%s", "Regional");
|
||||
}
|
||||
else if (category_bit == 1)
|
||||
{
|
||||
sys_code = ( (location_id & 0x3FFFFF) >> 5); //17 bits
|
||||
site_code = location_id & 0x1F; //5 bits
|
||||
sprintf (category, "%s", "Local");
|
||||
}
|
||||
else
|
||||
{
|
||||
//err, or we shouldn't ever get here
|
||||
sprintf (category, "%s", "Reserved/Err");
|
||||
}
|
||||
|
||||
//not entirely convinced that site code and ran are the exact same thing due to bit len differences
|
||||
//site code is meant to be a color code (but this could also be like the P25 p1 nac and p2 cc being the same)
|
||||
state->nxdn_last_ran = site_code; //this one may drop on nocarrier
|
||||
if (site_code != 0) state->nxdn_location_site_code = site_code; //this one won't
|
||||
if (sys_code != 0) state->nxdn_location_sys_code = sys_code;
|
||||
sprintf (state->nxdn_location_category, "%s", category);
|
||||
|
||||
fprintf (stderr, "\n Location Information - Cat: %s - Sys Code: %d - Site Code %d ", category, sys_code, site_code);
|
||||
|
||||
}
|
||||
|
||||
void NXDN_decode_site_info(dsd_opts * opts, dsd_state * state, uint8_t * Message)
|
||||
{
|
||||
uint32_t location_id = 0;
|
||||
uint16_t cs_info = 0; //channel structure information
|
||||
uint16_t svc_info = 0; //service information
|
||||
uint32_t rst_info = 0; //restriction information
|
||||
uint32_t ca_info = 0; //channel access information
|
||||
uint8_t version_num = 0;
|
||||
uint8_t adj_alloc = 0; //number of adjacent sites (on same system?)
|
||||
|
||||
uint16_t channel1 = 0;
|
||||
uint16_t channel2 = 0;
|
||||
long int freq1 = 0;
|
||||
long int freq2 = 0;
|
||||
|
||||
location_id = (uint32_t)ConvertBitIntoBytes(&Message[8], 24);
|
||||
cs_info = (uint16_t)ConvertBitIntoBytes(&Message[32], 16);
|
||||
svc_info = (uint16_t)ConvertBitIntoBytes(&Message[48], 16);
|
||||
rst_info = (uint32_t)ConvertBitIntoBytes(&Message[64], 24);
|
||||
ca_info = (uint32_t)ConvertBitIntoBytes(&Message[88], 24);
|
||||
version_num = (uint8_t)ConvertBitIntoBytes(&Message[112], 8);
|
||||
adj_alloc = (uint8_t)ConvertBitIntoBytes(&Message[120], 4);
|
||||
channel1 = (uint16_t)ConvertBitIntoBytes(&Message[124], 10);
|
||||
channel2 = (uint16_t)ConvertBitIntoBytes(&Message[134], 10);
|
||||
|
||||
fprintf (stderr, "%s", KYEL);
|
||||
fprintf (stderr, "\n Location ID [%06X] CSC [%04X] SVC [%04X] RST [%06X] \n CA [%06X] V[%X] ADJ [%01X] ",
|
||||
location_id, cs_info, svc_info, rst_info, ca_info, version_num, adj_alloc);
|
||||
nxdn_location_id_handler(state, location_id);
|
||||
if (channel1 != 0)
|
||||
{
|
||||
fprintf (stderr, "\n Control Channel 1 [%03X][%04d] ", channel1, channel1 );
|
||||
freq1 = nxdn_channel_to_frequency (opts, channel1);
|
||||
}
|
||||
if (channel2 != 0)
|
||||
{
|
||||
fprintf (stderr, "\n Control Channel 2 [%03X][%04d] ", channel2, channel2 );
|
||||
freq2 = nxdn_channel_to_frequency (opts, channel2);
|
||||
}
|
||||
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
|
||||
//place the freqs into the array for hunting CC or
|
||||
//rotating CCs without user LCN list
|
||||
if (freq1 != 0)
|
||||
{
|
||||
for (int i = 0; i <= state->lcn_freq_count; i++) //<= pretty sure is correct here since we need to go through atleast one rep
|
||||
{
|
||||
if (freq1 == state->trunk_lcn_freq[i]) goto SKIP;
|
||||
}
|
||||
//assign if freq1 not found in array
|
||||
state->trunk_lcn_freq[state->lcn_freq_count] = freq1;
|
||||
state->lcn_freq_count++;
|
||||
//shim here for main CC freq?
|
||||
state->p25_cc_freq = freq1;
|
||||
}
|
||||
|
||||
if (freq2 != 0)
|
||||
{
|
||||
for (int i = 0; i <= state->lcn_freq_count; i++) //<= pretty sure is correct here since we need to go through atleast one rep
|
||||
{
|
||||
if (freq2 == state->trunk_lcn_freq[i]) goto SKIP;
|
||||
}
|
||||
//assign if freq2 not found in array
|
||||
state->trunk_lcn_freq[state->lcn_freq_count] = freq2;
|
||||
state->lcn_freq_count++;
|
||||
}
|
||||
|
||||
SKIP: ; //do nothing
|
||||
|
||||
}
|
||||
|
||||
/*
|
||||
* @brief : This function decodes the VCALL message
|
||||
*
|
||||
* @param opts : Option structure parameters pointer
|
||||
*
|
||||
* @param state : State structure parameters pointer
|
||||
*
|
||||
* @param Message : A 64 bit buffer containing the VCALL message to decode
|
||||
*
|
||||
* @return None
|
||||
*
|
||||
*/
|
||||
void NXDN_decode_VCALL(dsd_opts * opts, dsd_state * state, uint8_t * Message)
|
||||
{
|
||||
//uint32_t i;
|
||||
|
||||
uint8_t CCOption = 0;
|
||||
uint8_t CallType = 0;
|
||||
uint8_t VoiceCallOption = 0;
|
||||
@@ -273,13 +551,6 @@ void NXDN_decode_VCALL(dsd_opts * opts, dsd_state * state, uint8_t * Message)
|
||||
uint8_t TransmissionMode[32] = {0};
|
||||
unsigned long long int FullMessage = 0;
|
||||
|
||||
/* Message[0..7] contains :
|
||||
* - The "F1" and "F2" flags
|
||||
* - The "Message Type" (already decoded before calling this function)
|
||||
*
|
||||
* So no need to decode it a second time
|
||||
*/
|
||||
|
||||
/* Decode "CC Option" */
|
||||
CCOption = (uint8_t)ConvertBitIntoBytes(&Message[8], 8);
|
||||
state->NxdnElementsContent.CCOption = CCOption;
|
||||
@@ -334,7 +605,6 @@ void NXDN_decode_VCALL(dsd_opts * opts, dsd_state * state, uint8_t * Message)
|
||||
fprintf(stderr, "%s %s - ", DuplexMode, TransmissionMode);
|
||||
|
||||
/* Print Source ID and Destination ID (Talk Group or Unit ID) */
|
||||
//fprintf (stderr, "%s", KGRN);
|
||||
fprintf(stderr, "Src=%u - Dst/TG=%u ", SourceUnitID & 0xFFFF, DestinationID & 0xFFFF);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
|
||||
@@ -343,16 +613,13 @@ void NXDN_decode_VCALL(dsd_opts * opts, dsd_state * state, uint8_t * Message)
|
||||
{
|
||||
fprintf (stderr, "\n %s", KYEL);
|
||||
fprintf(stderr, "%s - ", NXDN_Cipher_Type_To_Str(CipherType));
|
||||
//state->nxdn_cipher_type = CipherType;
|
||||
}
|
||||
|
||||
/* Print the Key ID */
|
||||
if(CipherType != 0)
|
||||
{
|
||||
|
||||
fprintf(stderr, "Key ID %u - ", KeyID & 0xFF);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
//state->nxdn_key = (KeyID & 0xFF);
|
||||
}
|
||||
|
||||
if (state->nxdn_cipher_type == 0x01 && state->R > 0) //scrambler key value
|
||||
@@ -362,14 +629,15 @@ void NXDN_decode_VCALL(dsd_opts * opts, dsd_state * state, uint8_t * Message)
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
}
|
||||
|
||||
//only grab if CRC is okay
|
||||
if(state->NxdnElementsContent.VCallCrcIsGood)
|
||||
{
|
||||
if ( (SourceUnitID & 0xFFFF) > 0 )
|
||||
{
|
||||
state->nxdn_last_rid = SourceUnitID & 0xFFFF; //only grab if CRC is okay
|
||||
state->nxdn_last_rid = SourceUnitID & 0xFFFF;
|
||||
state->nxdn_last_tg = (DestinationID & 0xFFFF);
|
||||
state->nxdn_key = (KeyID & 0xFF);
|
||||
state->nxdn_cipher_type = CipherType; //will this set to zero if no enc?
|
||||
state->nxdn_cipher_type = CipherType;
|
||||
}
|
||||
}
|
||||
else
|
||||
@@ -390,32 +658,11 @@ void NXDN_decode_VCALL(dsd_opts * opts, dsd_state * state, uint8_t * Message)
|
||||
}
|
||||
} /* End NXDN_decode_VCALL() */
|
||||
|
||||
|
||||
/*
|
||||
* @brief : This function decodes the VCALL_IV message
|
||||
*
|
||||
* @param opts : Option structure parameters pointer
|
||||
*
|
||||
* @param state : State structure parameters pointer
|
||||
*
|
||||
* @param Message : A 72 bit buffer containing the VCALL_IV message to decode
|
||||
*
|
||||
* @return None
|
||||
*
|
||||
*/
|
||||
void NXDN_decode_VCALL_IV(dsd_opts * opts, dsd_state * state, uint8_t * Message)
|
||||
{
|
||||
uint32_t i;
|
||||
|
||||
/* Message[0..7] contains :
|
||||
* - The "F1" and "F2" flags
|
||||
* - The "Message Type" (already decoded before calling this function)
|
||||
*
|
||||
* So no need to decode it a second time
|
||||
*
|
||||
* Message[8..71] contains : The 64 bits IV
|
||||
*/
|
||||
state->payload_miN = 0; //zero out
|
||||
state->payload_miN = 0; //zero out
|
||||
|
||||
/* Extract the IV from the VCALL_IV message */
|
||||
for(i = 0; i < 8; i++)
|
||||
{
|
||||
@@ -430,15 +677,6 @@ void NXDN_decode_VCALL_IV(dsd_opts * opts, dsd_state * state, uint8_t * Message)
|
||||
} /* End NXDN_decode_VCALL_IV() */
|
||||
|
||||
|
||||
/*
|
||||
* @brief : This function decodes the "Call Type" and return the
|
||||
* ASCII string corresponding to it.
|
||||
*
|
||||
* @param CallType : The call type parameter to decode
|
||||
*
|
||||
* @return An ASCII string of the "Call Type"
|
||||
*
|
||||
*/
|
||||
char * NXDN_Call_Type_To_Str(uint8_t CallType)
|
||||
{
|
||||
char * Ptr = NULL;
|
||||
@@ -459,22 +697,6 @@ char * NXDN_Call_Type_To_Str(uint8_t CallType)
|
||||
return Ptr;
|
||||
} /* End NXDN_Call_Type_To_Str() */
|
||||
|
||||
|
||||
/*
|
||||
* @brief : This function decodes the "Voice Call Option" and return the
|
||||
* ASCII string corresponding to it.
|
||||
*
|
||||
* @param VoiceCallOption : The call type parameter to decode
|
||||
*
|
||||
* @param Duplex : A 32 bytes ASCII buffer pointer where store
|
||||
* the Duplex/Half duplex mode
|
||||
*
|
||||
* @param TransmissionMode : A 32 bytes ASCII buffer pointer where store
|
||||
* the transmission mode (bit rate)
|
||||
*
|
||||
* @return An ASCII string of the "Voice Call Option"
|
||||
*
|
||||
*/
|
||||
void NXDN_Voice_Call_Option_To_Str(uint8_t VoiceCallOption, uint8_t * Duplex, uint8_t * TransmissionMode)
|
||||
{
|
||||
char * Ptr = NULL;
|
||||
@@ -496,15 +718,6 @@ void NXDN_Voice_Call_Option_To_Str(uint8_t VoiceCallOption, uint8_t * Duplex, ui
|
||||
strcpy((char *)TransmissionMode, Ptr);
|
||||
} /* End NXDN_Voice_Call_Option_To_Str() */
|
||||
|
||||
/*
|
||||
* @brief : This function decodes the "Cipher Type" and return the
|
||||
* ASCII string corresponding to it.
|
||||
*
|
||||
* @param CipherType : The cipher type parameter to decode
|
||||
*
|
||||
* @return An ASCII string of the "Cipher Type"
|
||||
*
|
||||
*/
|
||||
char * NXDN_Cipher_Type_To_Str(uint8_t CipherType)
|
||||
{
|
||||
char * Ptr = NULL;
|
||||
|
||||
Reference in New Issue
Block a user