/*------------------------------------------------------------------------------- * p25p1_tsbk.c * P25p1 Trunking Signal Block Handler * * LWVMOBILE * 2022-10 DSD-FME Florida Man Edition *-----------------------------------------------------------------------------*/ #include "dsd.h" void processTSBK(dsd_opts * opts, dsd_state * state) { int tsbkbit[196] = {0}; //tsbk bit array, 196 trellis encoded bits int tsbk_dibit[98] = {0}; int dibit = 0; uint8_t tsbk_byte[12] = {0}; //12 byte return from bd_bridge (block_deinterleave) unsigned long long int PDU[24] = {0}; //24 byte PDU to send to the tsbk_byte vPDU handler, should be same formats (mostly) int tsbk_decoded_bits[190] = {0}; //decoded bits from tsbk_bytes for sending to crc16_lb_bridge int i, j, k, b, x, y; int ec = -2; //error value returned from (block_deinterleave) int err = -2; //error value returned from crc16_lb_bridge int skipdibit = 14; //initial status dibit will occur at 14, then add 36 each time it occurs int protectbit = 0; int MFID = 0xFF; //Manufacturer ID - Might be beneficial to NOT send anything but standard 0x00 or 0x01 messages //Update: Identified Bug in skipdibit incrememnt causing many block deinterleave/crc failures //with correct values set, now we are decoding many more TSBKs //TODO: Don't Print TSBKs/vPDUs unless verbosity levels set higher //TSBKs are always single block, but up to three can be transmitted in a row, //Multi-Block PDUs are sent on a different DUID - 0xC (not handled currently) //collect three reps of 101 dibits (98 valid dibits with status dibits interlaced) for (j = 0; j < 3; j++) { k = 0; for (i = 0; i < 101; i++) { dibit = getDibit(opts, state); if (i+(j*101) != skipdibit) // { tsbk_dibit[k] = dibit; tsbkbit[k*2] = (dibit >> 1) & 1; tsbkbit[k*2+1] = (dibit & 1); k++; } if (i+(j*101) == skipdibit) { skipdibit += 36; //was set to 35, this was the bug } } //send tsbkbit to block_deinterleave and return tsbk_byte ec = bd_bridge(tsbkbit, tsbk_byte); //too many bit manipulations! k = 0; for (i = 0; i < 12; i++) { for (x = 0; x < 8; x++) { tsbk_decoded_bits[k] = ((tsbk_byte[i] << x) & 0x80) >> 7; k++; } } err = crc16_lb_bridge(tsbk_decoded_bits, 80); //shuffle corrected bits back into tsbk_byte k = 0; for (i = 0; i < 12; i++) { int byte = 0; for (x = 0; x < 8; x++) { byte = byte << 1; byte = byte | tsbk_decoded_bits[k]; k++; } tsbk_byte[i] = byte; } //convert tsbk_byte to PDU and send to vPDU handler //...may or may not be entirely compatible, MFID = tsbk_byte[1]; PDU[0] = 0x07; //P25p1 TSBK Duid 0x07 PDU[1] = tsbk_byte[0] & 0x3F; PDU[2] = tsbk_byte[2]; PDU[3] = tsbk_byte[3]; PDU[4] = tsbk_byte[4]; PDU[5] = tsbk_byte[5]; PDU[6] = tsbk_byte[6]; PDU[7] = tsbk_byte[7]; PDU[8] = tsbk_byte[8]; PDU[9] = tsbk_byte[9]; //remove CRC to prevent false positive when vPDU goes to look for additional message in block PDU[10] = 0; //tsbk_byte[10]; PDU[11] = 0; //tsbk_byte[11]; PDU[1] = PDU[1] ^ 0x40; //flip bit to make it compatible with MAC_PDUs, i.e. 3D to 7D //check the protect bit, don't run if protected protectbit = (tsbk_byte[0] >> 6) & 0x1; //Don't run NET_STS out of this, or will set wrong NAC/CC //&& PDU[1] != 0x49 && PDU[1] != 0x45 //0x49 is telephone grant, 0x46 Unit to Unit Channel Answer Request (seems bogus) if (MFID < 0x2 && protectbit == 0 && err == 0 && ec == 0 && PDU[1] != 0x7B ) { fprintf (stderr, "%s",KYEL); process_MAC_VPDU(opts, state, 0, PDU); fprintf (stderr, "%s",KNRM); } //set our WACN and SYSID here now that we have valid ec and crc/checksum if (protectbit == 0 && err == 0 && ec == 0 && (tsbk_byte[0] & 0x3F) == 0x3B) { long int wacn = (tsbk_byte[3] << 12) | (tsbk_byte[4] << 4) | (tsbk_byte[5] >> 4);; int sysid = ((tsbk_byte[5] & 0xF) << 8) | tsbk_byte[6]; int channel = (tsbk_byte[7] << 8) | tsbk_byte[8]; fprintf (stderr, "%s",KYEL); fprintf (stderr, "\n Network Status Broadcast TSBK - Abbreviated \n"); fprintf (stderr, " WACN [%05lX] SYSID [%03X] NAC [%03llX]", wacn, sysid, state->p2_cc); state->p25_cc_freq = process_channel_to_freq(opts, state, channel); state->p25_cc_is_tdma = 0; //flag off for CC tuning purposes when system is qpsk //place the cc freq into the list at index 0 if 0 is empty, or not the same, //so we can hunt for rotating CCs without user LCN list if (state->trunk_lcn_freq[0] == 0 || state->trunk_lcn_freq[0] != state->p25_cc_freq) { state->trunk_lcn_freq[0] = state->p25_cc_freq; } //only set IF these values aren't already hard set by the user if (state->p2_hardset == 0) { state->p2_wacn = wacn; state->p2_sysid = sysid; } if (opts->payload == 1) { fprintf (stderr, "%s",KCYN); fprintf (stderr, "\n P25 PDU Payload "); for (i = 0; i < 12; i++) { fprintf (stderr, "[%02X]", tsbk_byte[i]); } } fprintf (stderr, "%s ", KNRM); } //reset for next rep ec = -2; err = -2; protectbit = 0; MFID = 0xFF; //check for last block bit if ( (tsbk_byte[0] >> 7) == 1 ) { j = 4; //set j to break the loop early } } fprintf (stderr, "\n"); }