mirror of
https://github.com/RfidResearchGroup/proxmark3.git
synced 2024-11-15 14:20:51 +08:00
71 lines
2.3 KiB
C
71 lines
2.3 KiB
C
//-----------------------------------------------------------------------------
|
|
// Copyright (C) Proxmark3 contributors. See AUTHORS.md for details.
|
|
//
|
|
// This program is free software: you can redistribute it and/or modify
|
|
// it under the terms of the GNU General Public License as published by
|
|
// the Free Software Foundation, either version 3 of the License, or
|
|
// (at your option) any later version.
|
|
//
|
|
// This program is distributed in the hope that it will be useful,
|
|
// but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
// GNU General Public License for more details.
|
|
//
|
|
// See LICENSE.txt for the text of the license.
|
|
//-----------------------------------------------------------------------------
|
|
// LEGIC's obfuscation function
|
|
//-----------------------------------------------------------------------------
|
|
|
|
#include "legic_prng.h"
|
|
// the prng is a muxed value from two lsfr a, b
|
|
// a is 7bit lsfr
|
|
// b is 8bit lsfr
|
|
// c keeps track on which step the prng is.
|
|
// legic_prng_get_bit() = gets a bit muxed from a and b.
|
|
static struct lfsr {
|
|
uint8_t a;
|
|
uint8_t b;
|
|
uint32_t c;
|
|
} lfsr;
|
|
|
|
// Normal init is set following variables with a random value IV
|
|
// a == iv
|
|
// b == iv << 1 | 1
|
|
// * someone mentioned iv must be ODD.
|
|
// Hack:
|
|
// Now we have a special case with iv == 0
|
|
// it sets b to 0 as well to make sure we get a all zero keystream out
|
|
// which is used in the initialisation phase sending the IV
|
|
//
|
|
void legic_prng_init(uint8_t iv) {
|
|
lfsr.a = iv;
|
|
lfsr.b = 0; // hack to get a always 0 keystream
|
|
lfsr.c = 0;
|
|
if (iv)
|
|
lfsr.b = (iv << 1) | 1;
|
|
}
|
|
|
|
void legic_prng_forward(int count) {
|
|
if (count == 0) return;
|
|
|
|
lfsr.c += count;
|
|
while (count--) {
|
|
// According: http://www.proxmark.org/forum/viewtopic.php?pid=5437#p5437
|
|
lfsr.a = (lfsr.a >> 1 | (lfsr.a ^ lfsr.a >> 6) << 6) & 0x7F;
|
|
lfsr.b = lfsr.b >> 1 | (lfsr.b ^ lfsr.b >> 2 ^ lfsr.b >> 3 ^ lfsr.b >> 7) << 7;
|
|
}
|
|
}
|
|
|
|
uint8_t legic_prng_get_bit(void) {
|
|
uint8_t idx = 7 - ((lfsr.a & 4) | (lfsr.a >> 2 & 2) | (lfsr.a >> 4 & 1));
|
|
return lfsr.b >> idx & 1;
|
|
}
|
|
|
|
uint32_t legic_prng_get_bits(uint8_t len) {
|
|
uint32_t a = 0;
|
|
for (uint8_t i = 0; i < len; ++i) {
|
|
a |= legic_prng_get_bit() << i;
|
|
legic_prng_forward(1);
|
|
}
|
|
return a;
|
|
}
|