mirror of
https://github.com/lwvmobile/dsd-fme.git
synced 2026-11-13 01:07:24 -05:00
f2254f413a
Special mode of 0:0 to apply the inversion to the interlevaed frame if present without application of a keystream for analysis; Misc Tweaks to VTX STD ENC Header and VTX TMS message; TG Value loading of VTX 10 char keys available only by #define VERTEX_KEY40_BY_TG which will override the Moto BP loadout;
727 lines
18 KiB
C
727 lines
18 KiB
C
/*-------------------------------------------------------------------------------
|
|
* dmr_ms.c
|
|
* DMR MS/Simplex/Direct Mode Voice Handling and Data Gathering Routines
|
|
*
|
|
* LWVMOBILE
|
|
* 2022-12 DSD-FME Florida Man Edition
|
|
*-----------------------------------------------------------------------------*/
|
|
|
|
#include "dsd.h"
|
|
#include "dmr_const.h"
|
|
|
|
// #define PRINT_AMBE72 //enable to view 72-bit AMBE codewords
|
|
|
|
//A subroutine for processing MS voice
|
|
void dmrMS (dsd_opts * opts, dsd_state * state)
|
|
{
|
|
|
|
char * timestr = getTimeC();
|
|
|
|
int i, j, dibit;
|
|
char ambe_fr[4][24];
|
|
char ambe_fr2[4][24];
|
|
char ambe_fr3[4][24];
|
|
char ambe_fr4[4][24];
|
|
|
|
//memcpy of ambe_fr for late entry
|
|
uint8_t m1[4][24];
|
|
uint8_t m2[4][24];
|
|
uint8_t m3[4][24];
|
|
|
|
const int *w, *x, *y, *z;
|
|
|
|
uint8_t syncdata[48];
|
|
memset (syncdata, 0, sizeof(syncdata));
|
|
|
|
uint8_t emb_pdu[16];
|
|
memset (emb_pdu, 0, sizeof(emb_pdu));
|
|
|
|
//cach
|
|
char cachdata[25];
|
|
|
|
//cach tact bits
|
|
uint8_t tact_bits[7];
|
|
|
|
uint8_t tact_okay = 0;
|
|
uint8_t emb_ok = 0;
|
|
UNUSED(emb_ok);
|
|
|
|
uint8_t internalslot;
|
|
uint8_t vc;
|
|
|
|
//assign as nonsensical numbers
|
|
uint8_t cc = 25;
|
|
uint8_t power = 9; //power and pre-emption indicator
|
|
uint8_t lcss = 9;
|
|
UNUSED2(cc, lcss);
|
|
|
|
//dummy bits to pass to dburst for link control
|
|
uint8_t dummy_bits[196];
|
|
memset (dummy_bits, 0, sizeof (dummy_bits));
|
|
|
|
vc = 2;
|
|
|
|
//Hardset variables for MS/Mono
|
|
state->currentslot = 0; //0
|
|
|
|
//Note: Manual dibit inversion required here since I didn't seperate inverted return from normal return in framesync,
|
|
//so getDibit doesn't know to invert it before it gets here
|
|
|
|
for (j = 0; j < 6; j++) {
|
|
state->dmrburstL = 16;
|
|
|
|
memset (ambe_fr, 0, sizeof(ambe_fr));
|
|
memset (ambe_fr2, 0, sizeof(ambe_fr2));
|
|
memset (ambe_fr3, 0, sizeof(ambe_fr3));
|
|
|
|
for(i = 0; i < 12; i++)
|
|
{
|
|
dibit = getDibit(opts, state);
|
|
if(opts->inverted_dmr == 1) dibit = (dibit ^ 2) & 3;
|
|
|
|
cachdata[i] = dibit;
|
|
state->dmr_stereo_payload[i] = dibit;
|
|
}
|
|
|
|
for (i = 0; i < 7; i++)
|
|
{
|
|
tact_bits[i] = cachdata[i];
|
|
}
|
|
|
|
tact_okay = 0;
|
|
if ( Hamming_7_4_decode (tact_bits) ) tact_okay = 1;
|
|
if (tact_okay != 1)
|
|
{
|
|
//do nothing since we aren't loop locked forever.
|
|
}
|
|
|
|
//internalslot = tact_bits[1];
|
|
internalslot = 0;
|
|
|
|
//Setup for first AMBE Frame
|
|
//Interleave Schedule
|
|
w = rW;
|
|
x = rX;
|
|
y = rY;
|
|
z = rZ;
|
|
|
|
//First AMBE Frame, Full 36
|
|
for(i = 0; i < 36; i++)
|
|
{
|
|
dibit = getDibit(opts, state);
|
|
if(opts->inverted_dmr == 1) dibit = (dibit ^ 2) & 3;
|
|
|
|
state->dmr_stereo_payload[i+12] = dibit;
|
|
|
|
ambe_fr[*w][*x] = (1 & (dibit >> 1)); // bit 1
|
|
ambe_fr[*y][*z] = (1 & dibit); // bit 0
|
|
|
|
w++;
|
|
x++;
|
|
y++;
|
|
z++;
|
|
|
|
}
|
|
|
|
//Setup for Second AMBE Frame
|
|
//Interleave Schedule
|
|
w = rW;
|
|
x = rX;
|
|
y = rY;
|
|
z = rZ;
|
|
|
|
//Second AMBE Frame, First Half 18 dibits just before Sync or EmbeddedSignalling
|
|
for(i = 0; i < 18; i++)
|
|
{
|
|
dibit = getDibit(opts, state);
|
|
if(opts->inverted_dmr == 1) dibit = (dibit ^ 2) & 3;
|
|
|
|
state->dmr_stereo_payload[i+48] = dibit;
|
|
ambe_fr2[*w][*x] = (1 & (dibit >> 1)); // bit 1
|
|
ambe_fr2[*y][*z] = (1 & dibit); // bit 0
|
|
|
|
w++;
|
|
x++;
|
|
y++;
|
|
z++;
|
|
|
|
}
|
|
|
|
// signaling data or sync
|
|
for(i = 0; i < 24; i++)
|
|
{
|
|
dibit = getDibit(opts, state);
|
|
if(opts->inverted_dmr == 1) dibit = (dibit ^ 2);
|
|
|
|
state->dmr_stereo_payload[i+66] = dibit;
|
|
|
|
syncdata[(2*i)] = (1 & (dibit >> 1)); // bit 1
|
|
syncdata[(2*i)+1] = (1 & dibit); // bit 0
|
|
|
|
// load the superframe to do embedded signal processing
|
|
if(vc > 1) //grab on vc2 values 2-5 B C D E, and F
|
|
{
|
|
state->dmr_embedded_signalling[internalslot][vc-1][i*2] = (1 & (dibit >> 1)); // bit 1
|
|
state->dmr_embedded_signalling[internalslot][vc-1][i*2+1] = (1 & dibit); // bit 0
|
|
}
|
|
|
|
}
|
|
|
|
//Kirisun Check VC-F for Enc Identifiers -- has bad fec, unless its loaded differently
|
|
//SEE: https://patents.google.com/patent/CN102307075A/en?q=(kirisun)&q=(dmr)&oq=kirisun
|
|
// if (opts->dmr_le == 3 && vc == 6)
|
|
// {
|
|
// bool kokay = 0;
|
|
// // kokay = Golay_24_12_decode(syncdata);
|
|
// unsigned long long int kirisun = (unsigned long long int)ConvertBitIntoBytes(&syncdata[0], 48);
|
|
// fprintf (stderr, "Kiri: %012llX; Golay Okay: %d; \n", kirisun, kokay);
|
|
// }
|
|
|
|
for(i = 0; i < 8; i++) emb_pdu[i + 0] = syncdata[i];
|
|
for(i = 0; i < 8; i++) emb_pdu[i + 8] = syncdata[i + 40];
|
|
|
|
emb_ok = -1;
|
|
if(QR_16_7_6_decode(emb_pdu))
|
|
{
|
|
emb_ok = 1;
|
|
cc = ((emb_pdu[0] << 3) + (emb_pdu[1] << 2) + (emb_pdu[2] << 1) + emb_pdu[3]);
|
|
power = emb_pdu[4];
|
|
lcss = ((emb_pdu[5] << 1) + emb_pdu[6]);
|
|
state->dmr_color_code = state->color_code = cc;
|
|
}
|
|
|
|
//Continue Second AMBE Frame, 18 after Sync or EmbeddedSignalling
|
|
for(i = 0; i < 18; i++)
|
|
{
|
|
dibit = getDibit(opts, state);
|
|
if(opts->inverted_dmr == 1) dibit = (dibit ^ 2) & 3;
|
|
|
|
state->dmr_stereo_payload[i+90] = dibit;
|
|
ambe_fr2[*w][*x] = (1 & (dibit >> 1)); // bit 1
|
|
ambe_fr2[*y][*z] = (1 & dibit); // bit 0
|
|
|
|
w++;
|
|
x++;
|
|
y++;
|
|
z++;
|
|
|
|
}
|
|
|
|
//Setup for Third AMBE Frame
|
|
//Interleave Schedule
|
|
w = rW;
|
|
x = rX;
|
|
y = rY;
|
|
z = rZ;
|
|
|
|
//Third AMBE Frame, Full 36
|
|
for(i = 0; i < 36; i++)
|
|
{
|
|
dibit = getDibit(opts, state);
|
|
if(opts->inverted_dmr == 1) dibit = (dibit ^ 2) & 3;
|
|
|
|
state->dmr_stereo_payload[i+108] = dibit;
|
|
ambe_fr3[*w][*x] = (1 & (dibit >> 1)); // bit 1
|
|
ambe_fr3[*y][*z] = (1 & dibit); // bit 0
|
|
|
|
w++;
|
|
x++;
|
|
y++;
|
|
z++;
|
|
|
|
}
|
|
|
|
//'DSP' output to file
|
|
if (opts->use_dsp_output == 1)
|
|
{
|
|
FILE * pFile; //file pointer
|
|
pFile = fopen (opts->dsp_out_file, "a");
|
|
fprintf (pFile, "\n%d 10 ", state->currentslot+1); //0x10 for "voice burst", forced to slot 1
|
|
for (i = 6; i < 72; i++) //33 bytes, no CACH
|
|
{
|
|
int dsp_byte = (state->dmr_stereo_payload[i*2] << 2) | state->dmr_stereo_payload[i*2 + 1];
|
|
fprintf (pFile, "%X", dsp_byte);
|
|
}
|
|
fclose (pFile);
|
|
}
|
|
|
|
state->dmr_ms_mode = 1;
|
|
|
|
memcpy (ambe_fr4, ambe_fr2, sizeof(ambe_fr2));
|
|
|
|
//copy ambe_fr frames first, running process mbe will correct them,
|
|
//but this also leads to issues extracting good le mi values when
|
|
//we go to do correction on them there too
|
|
memcpy (m1, ambe_fr, sizeof(m1));
|
|
memcpy (m2, ambe_fr2, sizeof(m2));
|
|
memcpy (m3, ambe_fr3, sizeof(m3));
|
|
|
|
if (state->tyt_bp == 1)
|
|
{
|
|
tyt16_ambe2_codeword_keystream(state, ambe_fr, 0);
|
|
tyt16_ambe2_codeword_keystream(state, ambe_fr2, 1);
|
|
tyt16_ambe2_codeword_keystream(state, ambe_fr3, 0);
|
|
}
|
|
|
|
if (state->csi_ee == 1)
|
|
{
|
|
csi72_ambe2_codeword_keystream(state, ambe_fr);
|
|
csi72_ambe2_codeword_keystream(state, ambe_fr2);
|
|
csi72_ambe2_codeword_keystream(state, ambe_fr3);
|
|
}
|
|
|
|
if (state->vtx256_ekey != 0)
|
|
{
|
|
vtx256_ambe2_interleave_inversion(ambe_fr);
|
|
vtx256_ambe2_interleave_inversion(ambe_fr2);
|
|
vtx256_ambe2_interleave_inversion(ambe_fr3);
|
|
}
|
|
|
|
#ifdef PRINT_AMBE72
|
|
ambe2_codeword_print_i(opts, ambe_fr);
|
|
ambe2_codeword_print_i(opts, ambe_fr2);
|
|
ambe2_codeword_print_i(opts, ambe_fr3);
|
|
#endif
|
|
|
|
processMbeFrame (opts, state, NULL, ambe_fr, NULL);
|
|
memcpy(state->f_l4[0], state->audio_out_temp_buf, sizeof(state->audio_out_temp_buf));
|
|
memcpy(state->s_l4[0], state->s_l, sizeof(state->s_l));
|
|
memcpy(state->s_l4u[0], state->s_lu, sizeof(state->s_lu));
|
|
processMbeFrame (opts, state, NULL, ambe_fr2, NULL);
|
|
memcpy(state->f_l4[1], state->audio_out_temp_buf, sizeof(state->audio_out_temp_buf));
|
|
memcpy(state->s_l4[1], state->s_l, sizeof(state->s_l));
|
|
memcpy(state->s_l4u[1], state->s_lu, sizeof(state->s_lu));
|
|
processMbeFrame (opts, state, NULL, ambe_fr3, NULL);
|
|
memcpy(state->f_l4[2], state->audio_out_temp_buf, sizeof(state->audio_out_temp_buf));
|
|
memcpy(state->s_l4[2], state->s_l, sizeof(state->s_l));
|
|
memcpy(state->s_l4u[2], state->s_lu, sizeof(state->s_lu));
|
|
|
|
//TODO: Consider copying f_l to f_r for left and right channel saturation on MS mode
|
|
if (opts->floating_point == 0)
|
|
{
|
|
// memcpy (state->s_r4, state->s_l4, sizeof(state->s_l4));
|
|
if(opts->pulse_digi_out_channels == 2)
|
|
playSynthesizedVoiceSS3(opts, state);
|
|
}
|
|
|
|
if (opts->floating_point == 1)
|
|
{
|
|
// memcpy (state->f_r4, state->f_l4, sizeof(state->f_l4));
|
|
if(opts->pulse_digi_out_channels == 2)
|
|
playSynthesizedVoiceFS3(opts, state);
|
|
}
|
|
|
|
if (vc == 6)
|
|
{
|
|
//this needs to run prior to embedded link control
|
|
if (state->payload_algid == 0x02)
|
|
hytera_enhanced_alg_refresh(state);
|
|
|
|
dmr_data_burst_handler(opts, state, (uint8_t *)dummy_bits, 0xEB);
|
|
//check the single burst/reverse channel opportunity
|
|
dmr_sbrc (opts, state, power);
|
|
|
|
fprintf (stderr, "\n");
|
|
dmr_alg_refresh (opts, state);
|
|
}
|
|
|
|
//collect the mi fragment
|
|
if (opts->dmr_le != 2) //if not Hytera Enhanced
|
|
dmr_late_entry_mi_fragment (opts, state, vc, m1, m2, m3);
|
|
|
|
//errors in ms/mono since we skip the other slot
|
|
// cach_err = dmr_cach (opts, state, cachdata);
|
|
|
|
//update voice sync time for trunking purposes (particularly Con+)
|
|
state->last_vc_sync_time = time(NULL);
|
|
|
|
vc++;
|
|
|
|
//reset emb components
|
|
cc = 25;
|
|
power = 9; //power and pre-emption indicator
|
|
lcss = 9;
|
|
|
|
//this is necessary because we need to skip and collect dibits, not just skip them
|
|
if (vc > 6) goto END;
|
|
|
|
skipDibit (opts, state, 144); //skip to next tdma channel
|
|
|
|
//since we are in a loop, run ncursesPrinter here
|
|
if (opts->use_ncurses_terminal == 1)
|
|
{
|
|
ncursesPrinter(opts, state);
|
|
}
|
|
|
|
//slot 1
|
|
watchdog_event_history(opts, state, 0);
|
|
watchdog_event_current(opts, state, 0);
|
|
|
|
} // end loop
|
|
|
|
END:
|
|
//get first half payload dibits and store them in the payload for the next repitition
|
|
skipDibit (opts, state, 144); //should we have two of these?
|
|
|
|
//CACH + First Half Payload = 12 + 54
|
|
for (i = 0; i < 66; i++) //66
|
|
{
|
|
dibit = getDibit(opts, state);
|
|
if (opts->inverted_dmr == 1)
|
|
{
|
|
dibit = (dibit ^ 2) & 3;
|
|
}
|
|
state->dmr_stereo_payload[i] = dibit;
|
|
|
|
}
|
|
|
|
state->dmr_stereo = 0;
|
|
state->dmr_ms_mode = 0;
|
|
state->directmode = 0; //flag off
|
|
|
|
if (timestr != NULL)
|
|
{
|
|
free (timestr);
|
|
timestr = NULL;
|
|
}
|
|
|
|
//reset static ks counter
|
|
state->static_ks_counter[0] = 0;
|
|
|
|
}
|
|
|
|
//collect buffered 1st half and get 2nd half voice payload and then jump to full MS Voice decoding.
|
|
void dmrMSBootstrap (dsd_opts * opts, dsd_state * state)
|
|
{
|
|
|
|
char * timestr = getTimeC();
|
|
|
|
//reset static ks counter
|
|
state->static_ks_counter[0] = 0;
|
|
|
|
int i, dibit;
|
|
int *dibit_p;
|
|
|
|
char ambe_fr[4][24];
|
|
char ambe_fr2[4][24];
|
|
char ambe_fr3[4][24];
|
|
char ambe_fr4[4][24];
|
|
|
|
memset (ambe_fr, 0, sizeof(ambe_fr));
|
|
memset (ambe_fr2, 0, sizeof(ambe_fr2));
|
|
memset (ambe_fr3, 0, sizeof(ambe_fr3));
|
|
|
|
//memcpy of ambe_fr for late entry
|
|
uint8_t m1[4][24];
|
|
uint8_t m2[4][24];
|
|
uint8_t m3[4][24];
|
|
|
|
const int *w, *x, *y, *z;
|
|
|
|
//cach
|
|
char cachdata[25];
|
|
UNUSED(cachdata);
|
|
|
|
state->dmrburstL = 16;
|
|
state->currentslot = 0; //force to slot 0
|
|
|
|
dibit_p = state->dmr_payload_p - 90;
|
|
|
|
//CACH + First Half Payload + Sync = 12 + 54 + 24
|
|
for (i = 0; i < 90; i++) //90
|
|
{
|
|
state->dmr_stereo_payload[i] = *dibit_p;
|
|
dibit_p++;
|
|
}
|
|
|
|
for(i = 0; i < 12; i++)
|
|
{
|
|
dibit = state->dmr_stereo_payload[i];
|
|
if(opts->inverted_dmr == 1)
|
|
{
|
|
dibit = (dibit ^ 2) & 3;
|
|
}
|
|
cachdata[i] = dibit;
|
|
}
|
|
|
|
//Setup for first AMBE Frame
|
|
|
|
//Interleave Schedule
|
|
w = rW;
|
|
x = rX;
|
|
y = rY;
|
|
z = rZ;
|
|
|
|
//First AMBE Frame, Full 36
|
|
for(i = 0; i < 36; i++)
|
|
{
|
|
dibit = state->dmr_stereo_payload[i+12];
|
|
if(opts->inverted_dmr == 1)
|
|
{
|
|
dibit = (dibit ^ 2) & 3;
|
|
}
|
|
state->dmr_stereo_payload[i+12] = dibit;
|
|
ambe_fr[*w][*x] = (1 & (dibit >> 1)); // bit 1
|
|
ambe_fr[*y][*z] = (1 & dibit); // bit 0
|
|
|
|
w++;
|
|
x++;
|
|
y++;
|
|
z++;
|
|
|
|
}
|
|
|
|
//Setup for Second AMBE Frame
|
|
|
|
//Interleave Schedule
|
|
w = rW;
|
|
x = rX;
|
|
y = rY;
|
|
z = rZ;
|
|
|
|
//Second AMBE Frame, First Half 18 dibits just before Sync or EmbeddedSignalling
|
|
for(i = 0; i < 18; i++)
|
|
{
|
|
dibit = state->dmr_stereo_payload[i+48];
|
|
if(opts->inverted_dmr == 1)
|
|
{
|
|
dibit = (dibit ^ 2) & 3;
|
|
}
|
|
ambe_fr2[*w][*x] = (1 & (dibit >> 1)); // bit 1
|
|
ambe_fr2[*y][*z] = (1 & dibit); // bit 0
|
|
|
|
w++;
|
|
x++;
|
|
y++;
|
|
z++;
|
|
|
|
}
|
|
|
|
//Continue Second AMBE Frame, 18 after Sync or EmbeddedSignalling
|
|
for(i = 0; i < 18; i++)
|
|
{
|
|
dibit = getDibit(opts, state);
|
|
if(opts->inverted_dmr == 1)
|
|
{
|
|
dibit = (dibit ^ 2) & 3;
|
|
}
|
|
state->dmr_stereo_payload[i+90] = dibit;
|
|
ambe_fr2[*w][*x] = (1 & (dibit >> 1)); // bit 1
|
|
ambe_fr2[*y][*z] = (1 & dibit); // bit 0
|
|
|
|
w++;
|
|
x++;
|
|
y++;
|
|
z++;
|
|
|
|
}
|
|
|
|
//Setup for Third AMBE Frame
|
|
|
|
//Interleave Schedule
|
|
w = rW;
|
|
x = rX;
|
|
y = rY;
|
|
z = rZ;
|
|
|
|
//Third AMBE Frame, Full 36
|
|
for(i = 0; i < 36; i++)
|
|
{
|
|
dibit = getDibit(opts, state);
|
|
if(opts->inverted_dmr == 1)
|
|
{
|
|
dibit = (dibit ^ 2) & 3;
|
|
}
|
|
state->dmr_stereo_payload[i+108] = dibit;
|
|
ambe_fr3[*w][*x] = (1 & (dibit >> 1)); // bit 1
|
|
ambe_fr3[*y][*z] = (1 & dibit); // bit 0
|
|
|
|
w++;
|
|
x++;
|
|
y++;
|
|
z++;
|
|
|
|
}
|
|
|
|
//'DSP' output to file
|
|
if (opts->use_dsp_output == 1)
|
|
{
|
|
FILE * pFile; //file pointer
|
|
pFile = fopen (opts->dsp_out_file, "a");
|
|
fprintf (pFile, "\n%d 10 ", state->currentslot+1); //0x10 for "voice burst", force to slot 1
|
|
for (i = 6; i < 72; i++) //33 bytes, no CACH
|
|
{
|
|
int dsp_byte = (state->dmr_stereo_payload[i*2] << 2) | state->dmr_stereo_payload[i*2 + 1];
|
|
fprintf (pFile, "%X", dsp_byte);
|
|
}
|
|
fclose (pFile);
|
|
}
|
|
|
|
fprintf (stderr, "%s ", timestr);
|
|
if (opts->inverted_dmr == 0)
|
|
{
|
|
fprintf (stderr,"Sync: +DMR MS/DM MODE/MONO ");
|
|
}
|
|
else fprintf (stderr,"Sync: -DMR MS/DM MODE/MONO ");
|
|
if (state->dmr_color_code != 16)
|
|
fprintf (stderr, "| Color Code=%02d ", state->dmr_color_code);
|
|
else fprintf (stderr, "| Color Code=XX ");
|
|
fprintf (stderr, "| VC* ");
|
|
fprintf (stderr, "\n");
|
|
|
|
//alg reset
|
|
//dmr_alg_reset (opts, state);
|
|
|
|
memcpy (ambe_fr4, ambe_fr2, sizeof(ambe_fr2));
|
|
|
|
//copy ambe_fr frames first, running process mbe will correct them,
|
|
//but this also leads to issues extracting good le mi values when
|
|
//we go to do correction on them there too
|
|
memcpy (m1, ambe_fr, sizeof(m1));
|
|
memcpy (m2, ambe_fr2, sizeof(m2));
|
|
memcpy (m3, ambe_fr3, sizeof(m3));
|
|
|
|
if (state->tyt_bp == 1)
|
|
{
|
|
tyt16_ambe2_codeword_keystream(state, ambe_fr, 0);
|
|
tyt16_ambe2_codeword_keystream(state, ambe_fr2, 1);
|
|
tyt16_ambe2_codeword_keystream(state, ambe_fr3, 0);
|
|
}
|
|
|
|
if (state->csi_ee == 1)
|
|
{
|
|
csi72_ambe2_codeword_keystream(state, ambe_fr);
|
|
csi72_ambe2_codeword_keystream(state, ambe_fr2);
|
|
csi72_ambe2_codeword_keystream(state, ambe_fr3);
|
|
}
|
|
|
|
if (state->vtx256_ekey != 0)
|
|
{
|
|
vtx256_ambe2_interleave_inversion(ambe_fr);
|
|
vtx256_ambe2_interleave_inversion(ambe_fr2);
|
|
vtx256_ambe2_interleave_inversion(ambe_fr3);
|
|
}
|
|
|
|
#ifdef PRINT_AMBE72
|
|
ambe2_codeword_print_i(opts, ambe_fr);
|
|
ambe2_codeword_print_i(opts, ambe_fr2);
|
|
ambe2_codeword_print_i(opts, ambe_fr3);
|
|
#endif
|
|
|
|
processMbeFrame (opts, state, NULL, ambe_fr, NULL);
|
|
memcpy(state->f_l4[0], state->audio_out_temp_buf, sizeof(state->audio_out_temp_buf));
|
|
memcpy(state->s_l4[0], state->s_l, sizeof(state->s_l));
|
|
memcpy(state->s_l4u[0], state->s_lu, sizeof(state->s_lu));
|
|
processMbeFrame (opts, state, NULL, ambe_fr2, NULL);
|
|
memcpy(state->f_l4[1], state->audio_out_temp_buf, sizeof(state->audio_out_temp_buf));
|
|
memcpy(state->s_l4[1], state->s_l, sizeof(state->s_l));
|
|
memcpy(state->s_l4u[1], state->s_lu, sizeof(state->s_lu));
|
|
processMbeFrame (opts, state, NULL, ambe_fr3, NULL);
|
|
memcpy(state->f_l4[2], state->audio_out_temp_buf, sizeof(state->audio_out_temp_buf));
|
|
memcpy(state->s_l4[2], state->s_l, sizeof(state->s_l));
|
|
memcpy(state->s_l4u[2], state->s_lu, sizeof(state->s_lu));
|
|
|
|
//TODO: Consider copying f_l to f_r for left and right channel saturation on MS mode
|
|
if (opts->floating_point == 0)
|
|
{
|
|
// memcpy (state->s_r4, state->s_l4, sizeof(state->s_l4));
|
|
if(opts->pulse_digi_out_channels == 2)
|
|
playSynthesizedVoiceSS3(opts, state);
|
|
}
|
|
|
|
if (opts->floating_point == 1)
|
|
{
|
|
// memcpy (state->f_r4, state->f_l4, sizeof(state->f_l4));
|
|
if(opts->pulse_digi_out_channels == 2)
|
|
playSynthesizedVoiceFS3(opts, state);
|
|
}
|
|
|
|
//collect the mi fragment
|
|
if (opts->dmr_le != 2) //if not Hytera Enhanced
|
|
dmr_late_entry_mi_fragment (opts, state, 1, m1, m2, m3);
|
|
|
|
//errors due to skipping other slot
|
|
// cach_err = dmr_cach (opts, state, cachdata);
|
|
if (timestr != NULL)
|
|
{
|
|
free (timestr);
|
|
timestr = NULL;
|
|
}
|
|
|
|
skipDibit (opts, state, 144); //skip to next TDMA slot
|
|
dmrMS (opts, state); //bootstrap into full TDMA frame
|
|
|
|
}
|
|
|
|
//simplied to a simple data collector, and then passed on to dmr_data_sync for the usual processing
|
|
void dmrMSData (dsd_opts * opts, dsd_state * state)
|
|
{
|
|
|
|
char * timestr = getTimeC();
|
|
|
|
int i;
|
|
int dibit;
|
|
int *dibit_p;
|
|
|
|
//CACH + First Half Payload + Sync = 12 + 54 + 24
|
|
dibit_p = state->dmr_payload_p - 90;
|
|
for (i = 0; i < 90; i++) //90
|
|
{
|
|
dibit = *dibit_p;
|
|
dibit_p++;
|
|
if(opts->inverted_dmr == 1) dibit = (dibit ^ 2) & 3;
|
|
state->dmr_stereo_payload[i] = dibit;
|
|
}
|
|
|
|
for (i = 0; i < 54; i++)
|
|
{
|
|
dibit = getDibit(opts, state);
|
|
if(opts->inverted_dmr == 1) dibit = (dibit ^ 2) & 3;
|
|
state->dmr_stereo_payload[i+90] = dibit;
|
|
}
|
|
|
|
fprintf (stderr, "%s ", timestr);
|
|
if (opts->inverted_dmr == 0)
|
|
{
|
|
fprintf (stderr,"Sync: +DMR MS/DM MODE/MONO ");
|
|
}
|
|
else fprintf (stderr,"Sync: -DMR MS/DM MODE/MONO ");
|
|
if (state->dmr_color_code != 16)
|
|
fprintf (stderr, "| Color Code=%02d ", state->dmr_color_code);
|
|
else fprintf (stderr, "| Color Code=XX ");
|
|
|
|
sprintf(state->slot1light, "%s", "");
|
|
sprintf(state->slot2light, "%s", "");
|
|
|
|
//process data
|
|
state->dmr_stereo = 1;
|
|
state->dmr_ms_mode = 1;
|
|
|
|
dmr_data_sync (opts, state);
|
|
|
|
state->dmr_stereo = 0;
|
|
state->dmr_ms_mode = 0;
|
|
state->directmode = 0; //flag off
|
|
|
|
//should just be loaded in the dmr_payload_buffer instead now
|
|
//but we want to run getDibit so the buffer has actual good values in it
|
|
for (i = 0; i < 144; i++) //66
|
|
{
|
|
dibit = getDibit(opts, state);
|
|
state->dmr_stereo_payload[i] = 1; //set to one so first frame will fail intentionally instead of zero fill
|
|
}
|
|
//CACH + First Half Payload = 12 + 54
|
|
for (i = 0; i < 66; i++) //66
|
|
{
|
|
dibit = getDibit(opts, state);
|
|
state->dmr_stereo_payload[i+66] = 1; ////set to one so first frame will fail intentionally instead of zero fill
|
|
}
|
|
|
|
if (timestr != NULL)
|
|
{
|
|
free (timestr);
|
|
timestr = NULL;
|
|
}
|
|
|
|
}
|