mirror of
https://github.com/lwvmobile/dsd-fme.git
synced 2026-11-21 05:05:38 -05:00
Added support for error correction in P25 HDU data.
Both Golay(24,12,8) and Reed-Solomon(63,47,17) are now implemented.
This commit is contained in:
455
p25p1_hdu.c
455
p25p1_hdu.c
@@ -17,6 +17,97 @@
|
||||
|
||||
#include "dsd.h"
|
||||
|
||||
|
||||
#include "p25p1_check_hdu.h"
|
||||
|
||||
/**
|
||||
* Read two bits from the stream of data. Takes into account the periodic occurrence of status bits.
|
||||
* Those are discarded.
|
||||
*/
|
||||
static void
|
||||
read_dibit (dsd_opts* opts, dsd_state* state, char* output, int* status_count)
|
||||
{
|
||||
int dibit;
|
||||
int status;
|
||||
|
||||
if (*status_count == 35) {
|
||||
// Status bits now
|
||||
status = getDibit (opts, state);
|
||||
// TODO: do something useful with the status bits...
|
||||
*status_count = 1;
|
||||
} else {
|
||||
(*status_count)++;
|
||||
}
|
||||
|
||||
dibit = getDibit (opts, state);
|
||||
output[0] = (1 & (dibit >> 1)); // bit 1
|
||||
output[1] = (1 & dibit); // bit 0
|
||||
}
|
||||
|
||||
/**
|
||||
* Read an hex word from the stream of data.
|
||||
*/
|
||||
static void
|
||||
read_hex (dsd_opts* opts, dsd_state* state, char* hex, int* status_count)
|
||||
{
|
||||
unsigned int i;
|
||||
|
||||
// Read 3 times a dibit = read 6 bits.
|
||||
for (i=0; i<=4; i+=2)
|
||||
{
|
||||
// We read two bits on each call
|
||||
read_dibit(opts, state, hex + i, status_count);
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* Read 12 bits from the stream of data. Those are the parity bits that follow each hex word.
|
||||
*/
|
||||
static void
|
||||
read_golay24_parity (dsd_opts* opts, dsd_state* state, char* parity, int* status_count)
|
||||
{
|
||||
unsigned int i;
|
||||
|
||||
// Read 6 times a dibit = read 12 bits.
|
||||
for (i=0; i<=10; i+=2)
|
||||
{
|
||||
// We read two bits on each call
|
||||
read_dibit(opts, state, parity + i, status_count);
|
||||
}
|
||||
}
|
||||
|
||||
static void
|
||||
correct_hex_word (dsd_state* state, char* hex, char* parity)
|
||||
{
|
||||
int fixed_errors;
|
||||
int unrecoverable_errors;
|
||||
|
||||
unrecoverable_errors = check_and_fix_golay24(hex, parity, &fixed_errors);
|
||||
|
||||
state->debug_header_errors += fixed_errors;
|
||||
if (unrecoverable_errors != 0)
|
||||
{
|
||||
state->debug_header_critical_errors++;
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* Read an hex word, its parity bits and attempts to error correct it using the Golay24 algorithm.
|
||||
*/
|
||||
static void
|
||||
read_and_correct_hex_word (dsd_opts* opts, dsd_state* state, char* hex, int* status_count)
|
||||
{
|
||||
char parity[12];
|
||||
unsigned int i;
|
||||
|
||||
// Read the hex word
|
||||
read_hex (opts, state, hex, status_count);
|
||||
// Read the parity
|
||||
read_golay24_parity (opts, state, parity, status_count);
|
||||
// Use the Golay24 FEC to correct it. This call modifies the content of hex to fix it, hopefully
|
||||
correct_hex_word (state, hex, parity);
|
||||
}
|
||||
|
||||
void
|
||||
processHDU (dsd_opts * opts, dsd_state * state)
|
||||
{
|
||||
@@ -25,6 +116,41 @@ processHDU (dsd_opts * opts, dsd_state * state)
|
||||
int dibit, i, j;
|
||||
long talkgroup;
|
||||
int algidhex, kidhex;
|
||||
char hex[6];
|
||||
char parity[12];
|
||||
int status_count;
|
||||
int status;
|
||||
|
||||
char hex_data[20][6]; // Data in hex-words (6 bit words). A total of 20 hex words.
|
||||
char hex_parity[16][6]; // Parity of the data, again in hex-word format. A total of 16 parity hex words.
|
||||
|
||||
status_count = 35 - 14;
|
||||
|
||||
// Read 20 hex words, correct them using their Golay24 parity data.
|
||||
for (i=19; i>=0; i--)
|
||||
{
|
||||
read_and_correct_hex_word (opts, state, hex, &status_count);
|
||||
// Store the corrected hex word into the hex_data store:
|
||||
for (j=0; j<6; j++)
|
||||
{
|
||||
hex_data[i][j] = hex[j];
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
// Read the 16 parity hex word. These are used to FEC the 20 hex words using Reed-Solomon.
|
||||
for (i=15; i>=0; i--)
|
||||
{
|
||||
read_and_correct_hex_word (opts, state, hex, &status_count);
|
||||
// Store the corrected hex word into the hex_parity store:
|
||||
for (j=0; j<6; j++)
|
||||
{
|
||||
hex_parity[i][j] = hex[j];
|
||||
}
|
||||
}
|
||||
|
||||
// Use the Reed-Solomon algorithm to correct the data. hex_data is modified in place
|
||||
check_and_fix_redsolomon63((char*)hex_data, (char*)hex_parity);
|
||||
|
||||
mi[72] = 0;
|
||||
mfid[8] = 0;
|
||||
@@ -32,233 +158,154 @@ processHDU (dsd_opts * opts, dsd_state * state)
|
||||
kid[16] = 0;
|
||||
tgid[16] = 0;
|
||||
|
||||
// Now processing NID
|
||||
// Now put the corrected data on the DSD structures
|
||||
|
||||
dibit = getDibit (opts, state);
|
||||
mi[0] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[1] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[2] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[3] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[4] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[5] = (1 & dibit) + 48; // bit 0
|
||||
skipDibit (opts, state, 6);
|
||||
mi[ 0] = hex_data[19][0] + '0';
|
||||
mi[ 1] = hex_data[19][1] + '0';
|
||||
mi[ 2] = hex_data[19][2] + '0';
|
||||
mi[ 3] = hex_data[19][3] + '0';
|
||||
mi[ 4] = hex_data[19][4] + '0';
|
||||
mi[ 5] = hex_data[19][5] + '0';
|
||||
|
||||
dibit = getDibit (opts, state);
|
||||
mi[6] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[7] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[8] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[9] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[10] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[11] = (1 & dibit) + 48; // bit 0
|
||||
skipDibit (opts, state, 7);
|
||||
mi[ 6] = hex_data[18][0] + '0';
|
||||
mi[ 7] = hex_data[18][1] + '0';
|
||||
mi[ 8] = hex_data[18][2] + '0';
|
||||
mi[ 9] = hex_data[18][3] + '0';
|
||||
mi[10] = hex_data[18][4] + '0';
|
||||
mi[11] = hex_data[18][5] + '0';
|
||||
|
||||
dibit = getDibit (opts, state);
|
||||
mi[12] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[13] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[14] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[15] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[16] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[17] = (1 & dibit) + 48; // bit 0
|
||||
skipDibit (opts, state, 6);
|
||||
mi[12] = hex_data[17][0] + '0';
|
||||
mi[13] = hex_data[17][1] + '0';
|
||||
mi[14] = hex_data[17][2] + '0';
|
||||
mi[15] = hex_data[17][3] + '0';
|
||||
mi[16] = hex_data[17][4] + '0';
|
||||
mi[17] = hex_data[17][5] + '0';
|
||||
|
||||
dibit = getDibit (opts, state);
|
||||
mi[18] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[19] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[20] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[21] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[22] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[23] = (1 & dibit) + 48; // bit 0
|
||||
skipDibit (opts, state, 6);
|
||||
mi[18] = hex_data[16][0] + '0';
|
||||
mi[19] = hex_data[16][1] + '0';
|
||||
mi[20] = hex_data[16][2] + '0';
|
||||
mi[21] = hex_data[16][3] + '0';
|
||||
mi[22] = hex_data[16][4] + '0';
|
||||
mi[23] = hex_data[16][5] + '0';
|
||||
|
||||
dibit = getDibit (opts, state);
|
||||
mi[24] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[25] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[26] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[27] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[28] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[29] = (1 & dibit) + 48; // bit 0
|
||||
skipDibit (opts, state, 6);
|
||||
mi[24] = hex_data[15][0] + '0';
|
||||
mi[25] = hex_data[15][1] + '0';
|
||||
mi[26] = hex_data[15][2] + '0';
|
||||
mi[27] = hex_data[15][3] + '0';
|
||||
mi[28] = hex_data[15][4] + '0';
|
||||
mi[29] = hex_data[15][5] + '0';
|
||||
|
||||
dibit = getDibit (opts, state);
|
||||
mi[30] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[31] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[32] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[33] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[34] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[35] = (1 & dibit) + 48; // bit 0
|
||||
skipDibit (opts, state, 7);
|
||||
mi[30] = hex_data[14][0] + '0';
|
||||
mi[31] = hex_data[14][1] + '0';
|
||||
mi[32] = hex_data[14][2] + '0';
|
||||
mi[33] = hex_data[14][3] + '0';
|
||||
mi[34] = hex_data[14][4] + '0';
|
||||
mi[35] = hex_data[14][5] + '0';
|
||||
|
||||
dibit = getDibit (opts, state);
|
||||
mi[36] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[37] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[38] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[39] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[40] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[41] = (1 & dibit) + 48; // bit 0
|
||||
skipDibit (opts, state, 6);
|
||||
mi[36] = hex_data[13][0] + '0';
|
||||
mi[37] = hex_data[13][1] + '0';
|
||||
mi[38] = hex_data[13][2] + '0';
|
||||
mi[39] = hex_data[13][3] + '0';
|
||||
mi[40] = hex_data[13][4] + '0';
|
||||
mi[41] = hex_data[13][5] + '0';
|
||||
|
||||
dibit = getDibit (opts, state);
|
||||
mi[42] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[43] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[44] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[45] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[46] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[47] = (1 & dibit) + 48; // bit 0
|
||||
skipDibit (opts, state, 6);
|
||||
mi[42] = hex_data[12][0] + '0';
|
||||
mi[43] = hex_data[12][1] + '0';
|
||||
mi[44] = hex_data[12][2] + '0';
|
||||
mi[45] = hex_data[12][3] + '0';
|
||||
mi[46] = hex_data[12][4] + '0';
|
||||
mi[47] = hex_data[12][5] + '0';
|
||||
|
||||
dibit = getDibit (opts, state);
|
||||
mi[48] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[49] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[50] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[51] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[52] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[53] = (1 & dibit) + 48; // bit 0
|
||||
skipDibit (opts, state, 6);
|
||||
mi[48] = hex_data[11][0] + '0';
|
||||
mi[49] = hex_data[11][1] + '0';
|
||||
mi[50] = hex_data[11][2] + '0';
|
||||
mi[51] = hex_data[11][3] + '0';
|
||||
mi[52] = hex_data[11][4] + '0';
|
||||
mi[53] = hex_data[11][5] + '0';
|
||||
|
||||
dibit = getDibit (opts, state);
|
||||
mi[54] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[55] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[56] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[57] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[58] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[59] = (1 & dibit) + 48; // bit 0
|
||||
skipDibit (opts, state, 7);
|
||||
mi[54] = hex_data[10][0] + '0';
|
||||
mi[55] = hex_data[10][1] + '0';
|
||||
mi[56] = hex_data[10][2] + '0';
|
||||
mi[57] = hex_data[10][3] + '0';
|
||||
mi[58] = hex_data[10][4] + '0';
|
||||
mi[59] = hex_data[10][5] + '0';
|
||||
|
||||
dibit = getDibit (opts, state);
|
||||
mi[60] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[61] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[62] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[63] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[64] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[65] = (1 & dibit) + 48; // bit 0
|
||||
skipDibit (opts, state, 6);
|
||||
mi[60] = hex_data[9][0] + '0';
|
||||
mi[61] = hex_data[9][1] + '0';
|
||||
mi[62] = hex_data[9][2] + '0';
|
||||
mi[63] = hex_data[9][3] + '0';
|
||||
mi[64] = hex_data[9][4] + '0';
|
||||
mi[65] = hex_data[9][5] + '0';
|
||||
|
||||
dibit = getDibit (opts, state);
|
||||
mi[66] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[67] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[68] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[69] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mi[70] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mi[71] = (1 & dibit) + 48; // bit 0
|
||||
skipDibit (opts, state, 6);
|
||||
mi[66] = hex_data[8][0] + '0';
|
||||
mi[67] = hex_data[8][1] + '0';
|
||||
mi[68] = hex_data[8][2] + '0';
|
||||
mi[69] = hex_data[8][3] + '0';
|
||||
mi[70] = hex_data[8][4] + '0';
|
||||
mi[71] = hex_data[8][5] + '0';
|
||||
|
||||
dibit = getDibit (opts, state);
|
||||
mfid[0] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mfid[1] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mfid[2] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mfid[3] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
mfid[4] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mfid[5] = (1 & dibit) + 48; // bit 0
|
||||
skipDibit (opts, state, 6);
|
||||
mfid[0] = hex_data[7][0] + '0';
|
||||
mfid[1] = hex_data[7][1] + '0';
|
||||
mfid[2] = hex_data[7][2] + '0';
|
||||
mfid[3] = hex_data[7][3] + '0';
|
||||
mfid[4] = hex_data[7][4] + '0';
|
||||
mfid[5] = hex_data[7][5] + '0';
|
||||
|
||||
dibit = getDibit (opts, state);
|
||||
mfid[6] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
mfid[7] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
algid[0] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
algid[1] = (1 & dibit) + 48; // bit 0
|
||||
skipDibit (opts, state, 1);
|
||||
dibit = getDibit (opts, state);
|
||||
algid[2] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
algid[3] = (1 & dibit) + 48; // bit 0
|
||||
skipDibit (opts, state, 6);
|
||||
mfid[6] = hex_data[6][0] + '0';
|
||||
mfid[7] = hex_data[6][1] + '0';
|
||||
algid[0] = hex_data[6][2] + '0'; // The important algorithm ID. This indicates whether the data is
|
||||
algid[1] = hex_data[6][3] + '0'; // encrypted and if so what is the encryption algorithm used.
|
||||
algid[2] = hex_data[6][4] + '0'; // A code 0x80 here means that the data is unencrypted.
|
||||
algid[3] = hex_data[6][5] + '0';
|
||||
|
||||
dibit = getDibit (opts, state);
|
||||
algid[4] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
algid[5] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
algid[6] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
algid[7] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
kid[0] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
kid[1] = (1 & dibit) + 48; // bit 0
|
||||
skipDibit (opts, state, 6);
|
||||
algid[4] = hex_data[5][0] + '0';
|
||||
algid[5] = hex_data[5][1] + '0';
|
||||
algid[6] = hex_data[5][2] + '0';
|
||||
algid[7] = hex_data[5][3] + '0';
|
||||
kid[ 0] = hex_data[5][4] + '0';
|
||||
kid[ 1] = hex_data[5][5] + '0';
|
||||
|
||||
dibit = getDibit (opts, state);
|
||||
kid[2] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
kid[3] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
kid[4] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
kid[5] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
kid[6] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
kid[7] = (1 & dibit) + 48; // bit 0
|
||||
skipDibit (opts, state, 6);
|
||||
kid[ 2] = hex_data[4][0] + '0'; // The encryption key ID
|
||||
kid[ 3] = hex_data[4][1] + '0';
|
||||
kid[ 4] = hex_data[4][2] + '0';
|
||||
kid[ 5] = hex_data[4][3] + '0';
|
||||
kid[ 6] = hex_data[4][4] + '0';
|
||||
kid[ 7] = hex_data[4][5] + '0';
|
||||
|
||||
dibit = getDibit (opts, state);
|
||||
kid[8] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
kid[9] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
kid[10] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
kid[11] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
kid[12] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
kid[13] = (1 & dibit) + 48; // bit 0
|
||||
skipDibit (opts, state, 6);
|
||||
kid[ 8] = hex_data[3][0] + '0';
|
||||
kid[ 9] = hex_data[3][1] + '0';
|
||||
kid[10] = hex_data[3][2] + '0';
|
||||
kid[11] = hex_data[3][3] + '0';
|
||||
kid[12] = hex_data[3][4] + '0';
|
||||
kid[13] = hex_data[3][5] + '0';
|
||||
|
||||
dibit = getDibit (opts, state);
|
||||
kid[14] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
kid[15] = (1 & dibit) + 48; // bit 0
|
||||
skipDibit (opts, state, 1);
|
||||
dibit = getDibit (opts, state);
|
||||
tgid[0] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
tgid[1] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
tgid[2] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
tgid[3] = (1 & dibit) + 48; // bit 0
|
||||
skipDibit (opts, state, 6);
|
||||
kid[14] = hex_data[2][0] + '0';
|
||||
kid[15] = hex_data[2][1] + '0';
|
||||
tgid[ 0] = hex_data[2][2] + '0'; // Talk group ID
|
||||
tgid[ 1] = hex_data[2][3] + '0';
|
||||
tgid[ 2] = hex_data[2][4] + '0';
|
||||
tgid[ 3] = hex_data[2][5] + '0';
|
||||
|
||||
dibit = getDibit (opts, state);
|
||||
tgid[4] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
tgid[5] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
tgid[6] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
tgid[7] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
tgid[8] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
tgid[9] = (1 & dibit) + 48; // bit 0
|
||||
skipDibit (opts, state, 6);
|
||||
tgid[ 4] = hex_data[1][0] + '0';
|
||||
tgid[ 5] = hex_data[1][1] + '0';
|
||||
tgid[ 6] = hex_data[1][2] + '0';
|
||||
tgid[ 7] = hex_data[1][3] + '0';
|
||||
tgid[ 8] = hex_data[1][4] + '0';
|
||||
tgid[ 9] = hex_data[1][5] + '0';
|
||||
|
||||
dibit = getDibit (opts, state);
|
||||
tgid[10] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
tgid[11] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
tgid[12] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
tgid[13] = (1 & dibit) + 48; // bit 0
|
||||
dibit = getDibit (opts, state);
|
||||
tgid[14] = (1 & (dibit >> 1)) + 48; // bit 1
|
||||
tgid[15] = (1 & dibit) + 48; // bit 0
|
||||
|
||||
skipDibit (opts, state, 160);
|
||||
tgid[10] = hex_data[0][0] + '0';
|
||||
tgid[11] = hex_data[0][1] + '0';
|
||||
tgid[12] = hex_data[0][2] + '0';
|
||||
tgid[13] = hex_data[0][3] + '0';
|
||||
tgid[14] = hex_data[0][4] + '0';
|
||||
tgid[15] = hex_data[0][5] + '0';
|
||||
|
||||
state->p25kid = strtol(kid, NULL, 2);
|
||||
|
||||
skipDibit (opts, state, 5);
|
||||
status = getDibit (opts, state);
|
||||
//TODO: Do something useful with the status bits...
|
||||
|
||||
if (opts->p25enc == 1)
|
||||
{
|
||||
algidhex = strtol (algid, NULL, 2);
|
||||
|
||||
Reference in New Issue
Block a user