mirror of
https://github.com/lwvmobile/dsd-fme.git
synced 2026-11-19 20:27:26 -05:00
YOLO:
Congratulations for clicking this link, you are now reading this description; Add DES-OFB Decryption Support for P25, NXDN, DMR (Tested); Add DES-XL Decryption Support for P25p1 (Tested); Add AES-OFB Decryption Support for P25, DMR (Tested); NXDN(untested); Add P25p1 PDU Decryption Support; (Untested)(Known Modes); Add Remaining (AES, DES) DMR PDU Decryption Support (Known DMRA Modes)(Untested); Decrypt Tytera 16-bit BP (works depending on model); Add AES Keys example csv file for import; Probably a few bugs that'll need to be massaged out now with all the code additions for several years of stashed code;
This commit is contained in:
147
src/dmr_pi.c
147
src/dmr_pi.c
@@ -38,15 +38,38 @@ void dmr_pi (dsd_opts * opts, dsd_state * state, uint8_t PI_BYTE[], uint32_t CRC
|
||||
//Anytone RC4 Shim
|
||||
if (state->payload_algid == 0x01)
|
||||
{
|
||||
fprintf (stderr, " Anytone (0x01)");
|
||||
fprintf (stderr, " Anytone RC4 (0x01)");
|
||||
state->payload_algid = 0x21;
|
||||
}
|
||||
|
||||
//Anytone/Hytera AES-128 Shim
|
||||
if (state->payload_algid == 0x04)
|
||||
{
|
||||
fprintf (stderr, " Anytone/Hytera AES-128 (0x04)");
|
||||
state->payload_algid = 0x24;
|
||||
}
|
||||
|
||||
//Anytone/Hytera AES-256 Shim
|
||||
if (state->payload_algid == 0x05)
|
||||
{
|
||||
fprintf (stderr, " Anytone/Hytera AES-256 (0x05)");
|
||||
state->payload_algid = 0x25;
|
||||
}
|
||||
|
||||
fprintf (stderr, "%s ", KNRM);
|
||||
if (state->payload_algid != 0x21)
|
||||
|
||||
//expand the 32-bit MI to a 64-bit DES1 IV
|
||||
if (state->payload_algid == 0x22)
|
||||
{
|
||||
fprintf (stderr, "\n");
|
||||
LFSR64 (state);
|
||||
}
|
||||
|
||||
//expand the 32-bit MI to a 128-bit AES IV
|
||||
if (state->payload_algid == 0x24 || state->payload_algid == 0x25)
|
||||
{
|
||||
fprintf (stderr, "\n");
|
||||
LFSR128d (state);
|
||||
}
|
||||
}
|
||||
|
||||
@@ -77,11 +100,34 @@ void dmr_pi (dsd_opts * opts, dsd_state * state, uint8_t PI_BYTE[], uint32_t CRC
|
||||
state->payload_algidR = 0x21;
|
||||
}
|
||||
|
||||
//Anytone/Hytera AES-128 Shim
|
||||
if (state->payload_algidR == 0x04)
|
||||
{
|
||||
fprintf (stderr, " Anytone/Hytera AES-128 (0x04)");
|
||||
state->payload_algidR = 0x24;
|
||||
}
|
||||
|
||||
//Anytone/Hytera AES-256 Shim
|
||||
if (state->payload_algidR == 0x05)
|
||||
{
|
||||
fprintf (stderr, " Anytone/Hytera AES-256 (0x05)");
|
||||
state->payload_algidR = 0x25;
|
||||
}
|
||||
|
||||
fprintf (stderr, "%s ", KNRM);
|
||||
if (state->payload_algidR != 0x21)
|
||||
|
||||
//expand the 32-bit MI to a 64-bit DES1 IV
|
||||
if (state->payload_algidR == 0x22)
|
||||
{
|
||||
fprintf (stderr, "\n");
|
||||
LFSR64 (state);
|
||||
}
|
||||
|
||||
//expand the 32-bit MI to a 128-bit AES IV
|
||||
if (state->payload_algidR == 0x24 || state->payload_algidR == 0x25)
|
||||
{
|
||||
fprintf (stderr, "\n");
|
||||
LFSR128d (state);
|
||||
}
|
||||
}
|
||||
|
||||
@@ -120,7 +166,7 @@ void LFSR(dsd_state * state)
|
||||
fprintf (stderr, "%s", KYEL);
|
||||
fprintf (stderr, " Slot 1");
|
||||
fprintf (stderr, " DMR PI C- ALG ID: 0x%02X KEY ID: 0x%02X", state->payload_algid, state->payload_keyid);
|
||||
fprintf(stderr, " MI: 0x%08X", lfsr);
|
||||
fprintf(stderr, " MI(32): 0x%08X", lfsr);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
state->payload_mi = lfsr;
|
||||
}
|
||||
@@ -131,12 +177,13 @@ void LFSR(dsd_state * state)
|
||||
fprintf (stderr, "%s", KYEL);
|
||||
fprintf (stderr, " Slot 2");
|
||||
fprintf (stderr, " DMR PI C- ALG ID: 0x%02X KEY ID: 0x%02X", state->payload_algidR, state->payload_keyidR);
|
||||
fprintf(stderr, " MI: 0x%08X", lfsr);
|
||||
fprintf(stderr, " MI(32): 0x%08X", lfsr);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
state->payload_miR = lfsr;
|
||||
}
|
||||
}
|
||||
|
||||
//Expand a 32-bit MI into a 64-bit IV for DES
|
||||
void LFSR64(dsd_state * state)
|
||||
{
|
||||
{
|
||||
@@ -161,9 +208,11 @@ void LFSR64(dsd_state * state)
|
||||
fprintf (stderr, "%s", KYEL);
|
||||
fprintf (stderr, " Slot 1");
|
||||
fprintf (stderr, " DMR PI C- ALG ID: 0x%02X KEY ID: 0x%02X", state->payload_algid, state->payload_keyid);
|
||||
fprintf (stderr, " MI: 0x%016llX", lfsr);
|
||||
fprintf (stderr, " MI(64): 0x%016llX", lfsr);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
state->payload_mi = lfsr & 0xFFFFFFFF; //truncate for next repitition and le verification
|
||||
state->payload_miP = lfsr;
|
||||
state->DMRvcL = 0;
|
||||
}
|
||||
|
||||
if (state->currentslot == 1)
|
||||
@@ -171,10 +220,94 @@ void LFSR64(dsd_state * state)
|
||||
fprintf (stderr, "%s", KYEL);
|
||||
fprintf (stderr, " Slot 2");
|
||||
fprintf (stderr, " DMR PI C- ALG ID: 0x%02X KEY ID: 0x%02X", state->payload_algidR, state->payload_keyidR);
|
||||
fprintf (stderr, " MI: 0x%016llX", lfsr);
|
||||
fprintf (stderr, " MI(64): 0x%016llX", lfsr);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
state->payload_miR = lfsr & 0xFFFFFFFF; //truncate for next repitition and le verification
|
||||
state->payload_miN = lfsr;
|
||||
state->DMRvcR = 0;
|
||||
}
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
//Expand a 32-bit MI into a 128-bit IV for AES
|
||||
void LFSR128d(dsd_state * state)
|
||||
{
|
||||
unsigned long long int lfsr = 0;
|
||||
|
||||
if (state->currentslot == 0)
|
||||
lfsr = state->payload_mi;
|
||||
else lfsr = state->payload_miR;
|
||||
|
||||
unsigned long long int next_mi;
|
||||
|
||||
//start packing aes_iv
|
||||
if (state->currentslot == 0)
|
||||
{
|
||||
state->aes_iv[0] = (lfsr >> 24) & 0xFF;
|
||||
state->aes_iv[1] = (lfsr >> 16) & 0xFF;
|
||||
state->aes_iv[2] = (lfsr >> 8 ) & 0xFF;
|
||||
state->aes_iv[3] = (lfsr >> 0 ) & 0xFF;
|
||||
}
|
||||
else if (state->currentslot == 1)
|
||||
{
|
||||
state->aes_ivR[0] = (lfsr >> 24) & 0xFF;
|
||||
state->aes_ivR[1] = (lfsr >> 16) & 0xFF;
|
||||
state->aes_ivR[2] = (lfsr >> 8 ) & 0xFF;
|
||||
state->aes_ivR[3] = (lfsr >> 0 ) & 0xFF;
|
||||
}
|
||||
|
||||
int cnt = 0; int x = 32;
|
||||
unsigned long long int bit;
|
||||
for(cnt=0;cnt<96;cnt++)
|
||||
{
|
||||
//32,22,2,1
|
||||
bit = ( (lfsr >> 31) ^ (lfsr >> 21) ^ (lfsr >> 1) ^ (lfsr >> 0) ) & 0x1;
|
||||
lfsr = (lfsr << 1) | bit;
|
||||
|
||||
//continue packing aes_iv
|
||||
if (state->currentslot == 0)
|
||||
state->aes_iv[x/8] = (state->aes_iv[x/8] << 1) + bit;
|
||||
else if (state->currentslot == 1)
|
||||
state->aes_ivR[x/8] = (state->aes_ivR[x/8] << 1) + bit;
|
||||
x++;
|
||||
}
|
||||
|
||||
//assign the next 32-bit short MI from 4,5,6,7 so it'll match up with OTA late entry
|
||||
if (state->currentslot == 0)
|
||||
next_mi = (state->aes_iv[4] << 24) + (state->aes_iv[5] << 16) + (state->aes_iv[6] << 8) + (state->aes_iv[7] << 0);
|
||||
if (state->currentslot == 1)
|
||||
next_mi = (state->aes_ivR[4] << 24) + (state->aes_ivR[5] << 16) + (state->aes_ivR[6] << 8) + (state->aes_ivR[7] << 0);
|
||||
|
||||
if (state->currentslot == 0)
|
||||
{
|
||||
fprintf (stderr, "%s", KYEL);
|
||||
fprintf (stderr, " Slot 1");
|
||||
fprintf (stderr, " DMR PI C- ALG ID: 0x%02X KEY ID: 0x%02X MI(128): ", state->payload_algid, state->payload_keyid);
|
||||
for (x = 0; x < 16; x++)
|
||||
fprintf (stderr, "%02X", state->aes_iv[x]);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
// fprintf (stderr, "\n");
|
||||
|
||||
state->payload_mi = next_mi;
|
||||
state->DMRvcL = 0;
|
||||
|
||||
}
|
||||
|
||||
if (state->currentslot == 1)
|
||||
{
|
||||
fprintf (stderr, "%s", KYEL);
|
||||
fprintf (stderr, " Slot 2");
|
||||
fprintf (stderr, " DMR PI C- ALG ID: 0x%02X KEY ID: 0x%02X MI(128): ", state->payload_algidR, state->payload_keyidR);
|
||||
for (x = 0; x < 16; x++)
|
||||
fprintf (stderr, "%02X", state->aes_ivR[x]);
|
||||
fprintf (stderr, "%s", KNRM);
|
||||
// fprintf (stderr, "\n");
|
||||
|
||||
state->payload_miR = next_mi;
|
||||
state->DMRvcR = 0;
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
Reference in New Issue
Block a user