mirror of
https://github.com/lwvmobile/dsd-fme.git
synced 2026-11-12 16:57:23 -05:00
57d4c7afbe
Minor Tweaks --ncurses will truncate manually entered P2 parameters set if they are larger than expected. --muting/key tweak
393 lines
11 KiB
C
393 lines
11 KiB
C
/*
|
|
* Copyright (C) 2010 DSD Author
|
|
* GPG Key ID: 0x3F1D7FD0 (74EF 430D F7F2 0A48 FCE6 F630 FAA2 635D 3F1D 7FD0)
|
|
*
|
|
* Permission to use, copy, modify, and/or distribute this software for any
|
|
* purpose with or without fee is hereby granted, provided that the above
|
|
* copyright notice and this permission notice appear in all copies.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS" AND ISC DISCLAIMS ALL WARRANTIES WITH
|
|
* REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY
|
|
* AND FITNESS. IN NO EVENT SHALL ISC BE LIABLE FOR ANY SPECIAL, DIRECT,
|
|
* INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM
|
|
* LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE
|
|
* OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
|
|
* PERFORMANCE OF THIS SOFTWARE.
|
|
*/
|
|
|
|
#include "dsd.h"
|
|
#include "dmr_const.h"
|
|
#include "p25p1_check_hdu.h"
|
|
|
|
void ProcessDMR (dsd_opts * opts, dsd_state * state)
|
|
{
|
|
uint32_t i, j;
|
|
uint32_t Frame;
|
|
TimeSlotVoiceSuperFrame_t * TSVoiceSupFrameL = NULL;
|
|
TimeSlotVoiceSuperFrame_t * TSVoiceSupFrameR = NULL;
|
|
TimeSlotVoiceSuperFrame_t * TSVoiceSupFrameRC = NULL; //Reverse Test for MS Backwards
|
|
|
|
int *errs;
|
|
int *errs2;
|
|
unsigned long long int k;
|
|
int x;
|
|
k = 0;
|
|
|
|
TSVoiceSupFrameL = &state->TS1SuperFrame;
|
|
TSVoiceSupFrameR = &state->TS2SuperFrame;
|
|
|
|
int Pr[256] = {
|
|
0x0000, 0x1F00, 0xE300, 0xFC00, 0x2503, 0x3A03, 0xC603, 0xD903,
|
|
0x4A05, 0x5505, 0xA905, 0xB605, 0x6F06, 0x7006, 0x8C06, 0x9306,
|
|
0x2618, 0x3918, 0xC518, 0xDA18, 0x031B, 0x1C1B, 0xE01B, 0xFF1B,
|
|
0x6C1D, 0x731D, 0x8F1D, 0x901D, 0x491E, 0x561E, 0xAA1E, 0xB51E, //31
|
|
0x4B28, 0x5428, 0xA828, 0xB728, 0x6E2B, 0x712B, 0x8D2B, 0x922B,
|
|
0x012D, 0x1E2D, 0xE22D, 0xFD2D, 0x242E, 0x3B2E, 0xC72E, 0xD82E,
|
|
0x6D30, 0x7230, 0x8E30, 0x9130, 0x4833, 0x5733, 0xAB33, 0xB433,
|
|
0x2735, 0x3835, 0xC435, 0xDB35, 0x0236, 0x1D36, 0xE136, 0xFE36, //63
|
|
0x2B49, 0x3449, 0xC849, 0xD749, 0x0E4A, 0x114A, 0xED4A, 0xF24A,
|
|
0x614C, 0xAE4C, 0x824C, 0x9D4C, 0x444F, 0x5B4F, 0xA74F, 0xB84F,
|
|
0x0D51, 0x1251, 0xEE51, 0xF151, 0x2852, 0x3752, 0xCB52, 0xD452,
|
|
0x4754, 0x5854, 0xA454, 0xBB54, 0x6257, 0x7D57, 0x8157, 0x9E57, //95
|
|
0x6061, 0x7F61, 0x8361, 0x9C61, 0x4562, 0x5A62, 0xA662, 0xB962,
|
|
0x2A64, 0x3564, 0xC964, 0xD664, 0x0F67, 0x1067, 0xEC67, 0xF367,
|
|
0x4679, 0x5979, 0xA579, 0xBA79, 0x637A, 0x7C7A, 0x807A, 0x9F7A,
|
|
0x0C7C, 0x137C, 0xEF7C, 0xF07C, 0x297F, 0x367F, 0xCA7F, 0xD57F, //127
|
|
0x4D89, 0x5289, 0xAE89, 0xB189, 0x688A, 0x778A, 0x8B8A, 0x948A,
|
|
0x078C, 0x188C, 0xE48C, 0xFB8C, 0x228F, 0x3D8F, 0xC18F, 0xDE8F,
|
|
0x6B91, 0x7491, 0x8891, 0x9791, 0x4E92, 0x5192, 0xAD92, 0xB292,
|
|
0x2194, 0x3E94, 0xC294, 0xDD94, 0x0497, 0x1B97, 0xE797, 0xF897, //159
|
|
0x06A1, 0x19A1, 0xE5A1, 0xFAA1, 0x23A2, 0x3CA2, 0xC0A2, 0xDFA2,
|
|
0x4CA4, 0x53A4, 0xAFA4, 0xB0A4, 0x69A7, 0x76A7, 0x8AA7, 0x95A7,
|
|
0x20B9, 0x3FB9, 0xC3B9, 0xDCB9, 0x05BA, 0x1ABA, 0xE6BA, 0xF9BA,
|
|
0x6ABC, 0x75BC, 0x89BC, 0x96BC, 0x4FBF, 0x50BF, 0xACBF, 0xB3BF, //191
|
|
0x66C0, 0x79C0, 0x85C0, 0x9AC0, 0x43C3, 0x5CC3, 0xA0C3, 0xBFC3,
|
|
0x2CC5, 0x33C5, 0xCFC5, 0xD0C5, 0x09C6, 0x16C6, 0xEAC6, 0xF5C6,
|
|
0x84D0, 0x85DF, 0x8AD3, 0x8BDC, 0xB6D5, 0xB7DA, 0xB8D6, 0xB9D9,
|
|
0xD0DA, 0xD1D5, 0xDED9, 0xDFD6, 0xE2DF, 0xE3D0, 0xECDC, 0xEDD3, //223
|
|
0x2DE8, 0x32E8, 0xCEE8, 0xD1E8, 0x08EB, 0x17EB, 0xEBEB, 0xF4EB,
|
|
0x67ED, 0x78ED, 0x84ED, 0x9BED, 0x42EE, 0x5DEE, 0xA1EE, 0xBEEE,
|
|
0x0BF0, 0x14F0, 0xE8F0, 0xF7F0, 0x2EF3, 0x31F3, 0xCDF3, 0xD2F3,
|
|
0x41F5, 0x5EF5, 0xA2F5, 0xBDF5, 0x64F6, 0x7BF6, 0x87F6, 0x98F6 //255
|
|
};
|
|
|
|
|
|
if ( (state->currentslot == 0 && state->K > 0 && state->dmr_so & 0x40 && state->payload_keyid == 0 && state->dmr_fid == 0x10) ||
|
|
(state->currentslot == 0 && state->K > 0 && state->M == 1) )
|
|
{
|
|
fprintf (stderr, "%s", KYEL);
|
|
fprintf(stderr, " PrK %lld", state->K);
|
|
fprintf (stderr, "%s", KNRM);
|
|
k = Pr[state->K];
|
|
k = ( ((k & 0xFF0F) << 32 ) + (k << 16) + k );
|
|
|
|
for(Frame = 0; Frame < 6; Frame++)
|
|
{
|
|
for(i = 0; i < 3; i++)
|
|
{
|
|
for(j = 0; j < 48; j++)
|
|
{
|
|
x = ( ((k << j) & 0x800000000000) >> 47 );
|
|
TSVoiceSupFrameL->TimeSlotAmbeVoiceFrame[Frame].AmbeBit[i][j] ^= x;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
if ( (state->currentslot == 1 && state->K > 0 && state->dmr_soR & 0x40 && state->payload_keyidR == 0 && state->dmr_fidR == 0x10) ||
|
|
(state->currentslot == 1 && state->K > 0 && state->M == 1) )
|
|
{
|
|
fprintf (stderr, "%s", KYEL);
|
|
fprintf(stderr, " PrK %lld", state->K);
|
|
fprintf (stderr, "%s", KNRM);
|
|
k = Pr[state->K];
|
|
k = ( ((k & 0xFF0F) << 32 ) + (k << 16) + k );
|
|
|
|
for(Frame = 0; Frame < 6; Frame++)
|
|
{
|
|
for(i = 0; i < 3; i++)
|
|
{
|
|
for(j = 0; j < 48; j++)
|
|
{
|
|
x = ( ((k << j) & 0x800000000000) >> 47 );
|
|
TSVoiceSupFrameR->TimeSlotAmbeVoiceFrame[Frame].AmbeBit[i][j] ^= x;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
if ( (state->currentslot == 0 && state->K1 > 0 && state->dmr_so & 0x40 && state->payload_keyid == 0 && state->dmr_fid == 0x68) ||
|
|
(state->currentslot == 0 && state->K1 > 0 && state->M == 1) )
|
|
{
|
|
|
|
int pos = 0;
|
|
|
|
unsigned long long int k1 = state->K1;
|
|
unsigned long long int k2 = state->K2;
|
|
unsigned long long int k3 = state->K3;
|
|
unsigned long long int k4 = state->K4;
|
|
|
|
fprintf (stderr, "\n");
|
|
fprintf (stderr, "%s", KYEL);
|
|
fprintf(stderr, " SPT %010llX", k1);
|
|
|
|
int T_Key[256] = {0};
|
|
int pN[882] = {0};
|
|
|
|
int len = 0;
|
|
|
|
if (k2 == 0)
|
|
{
|
|
len = 39;
|
|
k1 = k1 << 24;
|
|
}
|
|
if (k2 != 0)
|
|
{
|
|
len = 127;
|
|
fprintf(stderr, " %016llX", k2);
|
|
}
|
|
if (k4 != 0)
|
|
{
|
|
len = 255;
|
|
fprintf(stderr, " %016llX", k3);
|
|
fprintf(stderr, " %016llX", k4);
|
|
}
|
|
|
|
fprintf (stderr, "%s", KNRM);
|
|
|
|
for (i = 0; i < 64; i++)
|
|
{
|
|
T_Key[i] = ( ((k1 << i) & 0x8000000000000000) >> 63 );
|
|
T_Key[i+64] = ( ((k2 << i) & 0x8000000000000000) >> 63 );
|
|
T_Key[i+128] = ( ((k3 << i) & 0x8000000000000000) >> 63 );
|
|
T_Key[i+192] = ( ((k4 << i) & 0x8000000000000000) >> 63 );
|
|
}
|
|
|
|
for (i = 0; i < 882; i++)
|
|
{
|
|
pN[i] = T_Key[pos];
|
|
pos++;
|
|
if (pos > len)
|
|
{
|
|
pos = 0;
|
|
}
|
|
}
|
|
|
|
pos = 0;
|
|
for(Frame = 0; Frame < 6; Frame++)
|
|
{
|
|
for(i = 0; i < 3; i++)
|
|
{
|
|
for(j = 0; j < 49; j++)
|
|
{
|
|
TSVoiceSupFrameL->TimeSlotAmbeVoiceFrame[Frame].AmbeBit[i][j] ^= pN[pos];
|
|
pos++;
|
|
}
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
if ( (state->currentslot == 1 && state->K1 > 0 && state->dmr_soR & 0x40 && state->payload_keyidR == 0 && state->dmr_fidR == 0x68) ||
|
|
(state->currentslot == 1 && state->K1 > 0 && state->M == 1) )
|
|
{
|
|
|
|
int pos = 0;
|
|
|
|
unsigned long long int k1 = state->K1;
|
|
unsigned long long int k2 = state->K2;
|
|
unsigned long long int k3 = state->K3;
|
|
unsigned long long int k4 = state->K4;
|
|
|
|
fprintf (stderr, "\n");
|
|
fprintf (stderr, "%s", KYEL);
|
|
fprintf(stderr, " SPT %010llX", k1);
|
|
|
|
int T_Key[256] = {0};
|
|
int pN[882] = {0};
|
|
|
|
int len = 0;
|
|
|
|
if (k2 == 0)
|
|
{
|
|
len = 39;
|
|
k1 = k1 << 24;
|
|
}
|
|
if (k2 != 0)
|
|
{
|
|
len = 127;
|
|
fprintf(stderr, " %016llX", k2);
|
|
}
|
|
if (k4 != 0)
|
|
{
|
|
len = 255;
|
|
fprintf(stderr, " %016llX", k3);
|
|
fprintf(stderr, " %016llX", k4);
|
|
}
|
|
|
|
fprintf (stderr, "%s", KNRM);
|
|
|
|
for (i = 0; i < 64; i++)
|
|
{
|
|
T_Key[i] = ( ((k1 << i) & 0x8000000000000000) >> 63 );
|
|
T_Key[i+64] = ( ((k2 << i) & 0x8000000000000000) >> 63 );
|
|
T_Key[i+128] = ( ((k3 << i) & 0x8000000000000000) >> 63 );
|
|
T_Key[i+192] = ( ((k4 << i) & 0x8000000000000000) >> 63 );
|
|
}
|
|
|
|
for (i = 0; i < 882; i++)
|
|
{
|
|
pN[i] = T_Key[pos];
|
|
pos++;
|
|
if (pos > len)
|
|
{
|
|
pos = 0;
|
|
}
|
|
}
|
|
|
|
pos = 0;
|
|
for(Frame = 0; Frame < 6; Frame++)
|
|
{
|
|
for(i = 0; i < 3; i++)
|
|
{
|
|
for(j = 0; j < 49; j++)
|
|
{
|
|
TSVoiceSupFrameR->TimeSlotAmbeVoiceFrame[Frame].AmbeBit[i][j] ^= pN[pos];
|
|
pos++;
|
|
}
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
if (state->currentslot == 0)
|
|
{
|
|
|
|
for(Frame = 0; Frame < 6; Frame++) //6
|
|
{
|
|
/* 1 DMR frame contains 3 AMBE voice samples */
|
|
for(i = 0; i < 3; i++)
|
|
{
|
|
errs = (int*)&(TSVoiceSupFrameL->TimeSlotAmbeVoiceFrame[Frame].errs1[i]);
|
|
errs2 = (int*)&(TSVoiceSupFrameL->TimeSlotAmbeVoiceFrame[Frame].errs2[i]);
|
|
state->errs = TSVoiceSupFrameL->TimeSlotAmbeVoiceFrame[Frame].errs1[i]; //correct placement
|
|
state->errs2 = TSVoiceSupFrameL->TimeSlotAmbeVoiceFrame[Frame].errs2[i]; //correct placement
|
|
|
|
mbe_processAmbe2450Dataf (state->audio_out_temp_buf, errs, errs2, state->err_str,
|
|
TSVoiceSupFrameL->TimeSlotAmbeVoiceFrame[Frame].AmbeBit[i],
|
|
state->cur_mp, state->prev_mp, state->prev_mp_enhanced, opts->uvquality);
|
|
|
|
if (opts->payload == 1)
|
|
{
|
|
PrintAMBEData(opts, state, TSVoiceSupFrameL->TimeSlotAmbeVoiceFrame[Frame].AmbeBit[i]);
|
|
}
|
|
|
|
//quick enc toggle to determine whether or not to play enc traffic
|
|
int enc_bit = 0;
|
|
enc_bit = (state->dmr_so >> 6) & 0x1;
|
|
if (enc_bit == 1)
|
|
{
|
|
state->dmr_encL = 1;
|
|
}
|
|
else state->dmr_encL = 0;
|
|
|
|
if (state->K != 0 || state->K1 != 0)
|
|
{
|
|
state->dmr_encL = 0;
|
|
}
|
|
|
|
//quick test to determine whether or not to run the next few steps below
|
|
if (state->dmr_encL == 0 || opts->dmr_mute_encL == 0)
|
|
{
|
|
if (opts->mbe_out_f != NULL)
|
|
{
|
|
saveAmbe2450Data (opts, state, TSVoiceSupFrameL->TimeSlotAmbeVoiceFrame[Frame].AmbeBit[i]);
|
|
}
|
|
|
|
state->debug_audio_errors += *errs2;
|
|
|
|
processAudio(opts, state);
|
|
|
|
if (opts->wav_out_f != NULL)
|
|
{
|
|
writeSynthesizedVoice (opts, state);
|
|
}
|
|
|
|
if (opts->audio_out == 1) //opts->audio_out == 1
|
|
{
|
|
playSynthesizedVoice (opts, state);
|
|
}
|
|
} //second bracket for the test enc condition
|
|
} /* End for(i = 0; i < 3; i++) */
|
|
} /* End for(Frame = 0; Frame < 6; Frame++) */
|
|
} //End if Current Slot == 0
|
|
|
|
if (state->currentslot == 1)
|
|
{
|
|
|
|
for(Frame = 0; Frame < 6; Frame++)
|
|
{
|
|
/* 1 DMR frame contains 3 AMBE voice samples */
|
|
for(i = 0; i < 3; i++)
|
|
{
|
|
errs = (int*)&(TSVoiceSupFrameR->TimeSlotAmbeVoiceFrame[Frame].errs1[i]);
|
|
errs2 = (int*)&(TSVoiceSupFrameR->TimeSlotAmbeVoiceFrame[Frame].errs2[i]);
|
|
state->errs = TSVoiceSupFrameR->TimeSlotAmbeVoiceFrame[Frame].errs1[i]; //correct placement
|
|
state->errs2 = TSVoiceSupFrameR->TimeSlotAmbeVoiceFrame[Frame].errs2[i]; //correct placement
|
|
|
|
mbe_processAmbe2450Dataf (state->audio_out_temp_buf, errs, errs2, state->err_str,
|
|
TSVoiceSupFrameR->TimeSlotAmbeVoiceFrame[Frame].AmbeBit[i],
|
|
state->cur_mp, state->prev_mp, state->prev_mp_enhanced, opts->uvquality);
|
|
|
|
|
|
if (opts->payload == 1)
|
|
{
|
|
PrintAMBEData(opts, state, TSVoiceSupFrameR->TimeSlotAmbeVoiceFrame[Frame].AmbeBit[i]);
|
|
}
|
|
|
|
//quick enc toggle to determine whether or not to play enc traffic
|
|
int enc_bit = 0;
|
|
enc_bit = (state->dmr_soR >> 6) & 0x1;
|
|
if (enc_bit == 1)
|
|
{
|
|
state->dmr_encR = 1;
|
|
}
|
|
else state->dmr_encR = 0;
|
|
|
|
if (state->K != 0 || state->K1 != 0)
|
|
{
|
|
state->dmr_encR = 0;
|
|
}
|
|
|
|
//quick test to determine whether or not to run the next few steps below
|
|
if (state->dmr_encR == 0 || opts->dmr_mute_encR == 0)
|
|
{
|
|
if (opts->mbe_out_f != NULL)
|
|
{
|
|
saveAmbe2450Data (opts, state, TSVoiceSupFrameR->TimeSlotAmbeVoiceFrame[Frame].AmbeBit[i]);
|
|
}
|
|
|
|
state->debug_audio_errors += *errs2;
|
|
|
|
processAudio(opts, state);
|
|
|
|
if (opts->wav_out_f != NULL)
|
|
{
|
|
writeSynthesizedVoice (opts, state);
|
|
}
|
|
|
|
if (opts->audio_out == 1)
|
|
{
|
|
playSynthesizedVoice (opts, state);
|
|
}
|
|
}
|
|
} /* End for(i = 0; i < 3; i++) */
|
|
} /* End for(Frame = 0; Frame < 6; Frame++) */
|
|
} //End if Current Slot == 1
|
|
|
|
|
|
} /* End ProcessDMR */
|
|
/* End of file */
|