mirror of
https://github.com/lwvmobile/dsd-fme.git
synced 2026-11-17 03:07:24 -05:00
Add Generic Static AMBE Keystream Support; #303
Adding a new method to allow a user to enter a generic keystream len and static keystream via a string that is loaded into a bit array to xor against ambe frames; This method is intended to be used to allow
This commit is contained in:
@@ -70,4 +70,57 @@ void anytone_bp_keystream_creation(dsd_state * state, char * input)
|
||||
fprintf (stderr,"DMR Anytone Basic 16-bit Key 0x%04X with Forced Application\n", key);
|
||||
state->any_bp = 1;
|
||||
|
||||
}
|
||||
|
||||
void straight_mod_xor_keystream_creation(dsd_state * state, char * input)
|
||||
{
|
||||
uint16_t len = 0;
|
||||
char * curr;
|
||||
curr = strtok(input, ":"); //should be len (mod) of key (decimal)
|
||||
if (curr != NULL)
|
||||
sscanf (curr, "%hd", &len);
|
||||
else goto END_KS;
|
||||
|
||||
//len sanity check, can't be greater than 882
|
||||
if (len > 882)
|
||||
len = 882;
|
||||
|
||||
curr = strtok(NULL, ":"); //should be key in hex
|
||||
if (curr != NULL)
|
||||
{
|
||||
//continue
|
||||
}
|
||||
else goto END_KS;
|
||||
|
||||
uint8_t ks_bytes[112];
|
||||
memset (ks_bytes, 0, sizeof(ks_bytes));
|
||||
parse_raw_user_string(curr, ks_bytes);
|
||||
|
||||
uint8_t ks_bits[896];
|
||||
memset(ks_bits, 0, sizeof(ks_bits));
|
||||
|
||||
uint16_t unpack_len = len / 8;
|
||||
if (len % 8)
|
||||
unpack_len++;
|
||||
unpack_byte_array_into_bit_array(ks_bytes, ks_bits, unpack_len);
|
||||
|
||||
for (uint16_t i = 0; i < len; i++)
|
||||
{
|
||||
state->static_ks_bits[0][i] = ks_bits[i];
|
||||
state->static_ks_bits[1][i] = ks_bits[i];
|
||||
}
|
||||
|
||||
fprintf (stderr,"AMBE Straight XOR %d-bit Keystream: ", len);
|
||||
for (uint16_t i = 0; i < unpack_len; i++)
|
||||
fprintf (stderr, "%02X", ks_bytes[i]);
|
||||
fprintf (stderr, " with Forced Application \n");
|
||||
|
||||
state->straight_ks = 1;
|
||||
state->straight_mod = (int)len;
|
||||
|
||||
END_KS:
|
||||
|
||||
if (curr == NULL)
|
||||
fprintf (stderr, "Straight KS String Malformed! No KS Created!\n");
|
||||
|
||||
}
|
||||
Reference in New Issue
Block a user