mirror of
https://github.com/RfidResearchGroup/proxmark3.git
synced 2025-08-14 18:48:13 -07:00
common: fix mix of spaces & tabs
This commit is contained in:
Philippe Teuwen
parent
9502b54aa0
commit
23f1a253a7
32 changed files with 4323 additions and 4323 deletions
244
common/wiegand.c
244
common/wiegand.c
|
|
@ -37,27 +37,27 @@ uint8_t checkParity(uint32_t bits, uint8_t len, uint8_t type);
|
|||
// takes a array of binary values, start position, length of bits per parity (includes parity bit),
|
||||
// Parity Type (1 for odd; 0 for even; 2 for Always 1's; 3 for Always 0's), and binary Length (length to run)
|
||||
size_t removeParity(uint8_t *bitstream, size_t startIdx, uint8_t pLen, uint8_t pType, size_t bLen) {
|
||||
uint32_t parityWd = 0;
|
||||
size_t j = 0, bitcount = 0;
|
||||
for (int word = 0; word < (bLen); word += pLen){
|
||||
for (int bit = 0; bit < pLen; ++bit){
|
||||
parityWd = (parityWd << 1) | bitstream[startIdx+word+bit];
|
||||
bitstream[j++] = (bitstream[startIdx + word + bit]);
|
||||
}
|
||||
j--; // overwrite parity with next data
|
||||
// if parity fails then return 0
|
||||
switch (pType) {
|
||||
case 3: if (bitstream[j] == 1) return 0; break; //should be 0 spacer bit
|
||||
case 2: if (bitstream[j] == 0) return 0; break; //should be 1 spacer bit
|
||||
default: //test parity
|
||||
if (parityTest(parityWd, pLen, pType) == 0) return 0; break;
|
||||
}
|
||||
bitcount += ( pLen - 1 );
|
||||
parityWd = 0;
|
||||
}
|
||||
// if we got here then all the parities passed
|
||||
//return ID start index and size
|
||||
return bitcount;
|
||||
uint32_t parityWd = 0;
|
||||
size_t j = 0, bitcount = 0;
|
||||
for (int word = 0; word < (bLen); word += pLen){
|
||||
for (int bit = 0; bit < pLen; ++bit){
|
||||
parityWd = (parityWd << 1) | bitstream[startIdx+word+bit];
|
||||
bitstream[j++] = (bitstream[startIdx + word + bit]);
|
||||
}
|
||||
j--; // overwrite parity with next data
|
||||
// if parity fails then return 0
|
||||
switch (pType) {
|
||||
case 3: if (bitstream[j] == 1) return 0; break; //should be 0 spacer bit
|
||||
case 2: if (bitstream[j] == 0) return 0; break; //should be 1 spacer bit
|
||||
default: //test parity
|
||||
if (parityTest(parityWd, pLen, pType) == 0) return 0; break;
|
||||
}
|
||||
bitcount += ( pLen - 1 );
|
||||
parityWd = 0;
|
||||
}
|
||||
// if we got here then all the parities passed
|
||||
//return ID start index and size
|
||||
return bitcount;
|
||||
}
|
||||
|
||||
|
||||
|
|
@ -76,28 +76,28 @@ size_t removeParity(uint8_t *bitstream, size_t startIdx, uint8_t pLen, uint8_t p
|
|||
*/
|
||||
size_t addParity(uint8_t *bits, uint8_t *dest, uint8_t sourceLen, uint8_t pLen, uint8_t pType)
|
||||
{
|
||||
uint32_t parityWd = 0;
|
||||
size_t j = 0, bitCnt = 0;
|
||||
for (int word = 0; word < sourceLen; word += pLen-1) {
|
||||
for (int bit = 0; bit < pLen-1; ++bit){
|
||||
parityWd = (parityWd << 1) | bits[word+bit];
|
||||
dest[j++] = (bits[word+bit]);
|
||||
}
|
||||
uint32_t parityWd = 0;
|
||||
size_t j = 0, bitCnt = 0;
|
||||
for (int word = 0; word < sourceLen; word += pLen-1) {
|
||||
for (int bit = 0; bit < pLen-1; ++bit){
|
||||
parityWd = (parityWd << 1) | bits[word+bit];
|
||||
dest[j++] = (bits[word+bit]);
|
||||
}
|
||||
|
||||
// if parity fails then return 0
|
||||
switch (pType) {
|
||||
case 3: dest[j++] = 0; break; // marker bit which should be a 0
|
||||
case 2: dest[j++] = 1; break; // marker bit which should be a 1
|
||||
default:
|
||||
dest[j++] = parityTest(parityWd, pLen-1, pType) ^ 1;
|
||||
break;
|
||||
}
|
||||
bitCnt += pLen;
|
||||
parityWd = 0;
|
||||
}
|
||||
// if we got here then all the parities passed
|
||||
//return ID start index and size
|
||||
return bitCnt;
|
||||
// if parity fails then return 0
|
||||
switch (pType) {
|
||||
case 3: dest[j++] = 0; break; // marker bit which should be a 0
|
||||
case 2: dest[j++] = 1; break; // marker bit which should be a 1
|
||||
default:
|
||||
dest[j++] = parityTest(parityWd, pLen-1, pType) ^ 1;
|
||||
break;
|
||||
}
|
||||
bitCnt += pLen;
|
||||
parityWd = 0;
|
||||
}
|
||||
// if we got here then all the parities passed
|
||||
//return ID start index and size
|
||||
return bitCnt;
|
||||
}
|
||||
|
||||
// by marshmellow
|
||||
|
|
@ -110,18 +110,18 @@ size_t addParity(uint8_t *bits, uint8_t *dest, uint8_t sourceLen, uint8_t pLen,
|
|||
*/
|
||||
void wiegand_add_parity(uint8_t *source, uint8_t *dest, uint8_t len) {
|
||||
|
||||
// Copy to destination, shifted one step to make room for EVEN parity
|
||||
// Copy to destination, shifted one step to make room for EVEN parity
|
||||
memcpy(dest+1, source, length);
|
||||
|
||||
// half length, Even and Odd is calculated to the middle.
|
||||
uint8_t len_h2 = length >> 1;
|
||||
// half length, Even and Odd is calculated to the middle.
|
||||
uint8_t len_h2 = length >> 1;
|
||||
|
||||
// add EVEN parity at the beginning
|
||||
// add EVEN parity at the beginning
|
||||
*(dest) = GetParity(source, EVEN, len_h2);
|
||||
|
||||
dest += length + 1;
|
||||
|
||||
// add ODD parity at the very end
|
||||
// add ODD parity at the very end
|
||||
*(dest) = GetParity(source + len_h2, ODD, len_h2);
|
||||
}
|
||||
|
||||
|
|
@ -138,18 +138,18 @@ void wiegand_add_parity(uint8_t *source, uint8_t *dest, uint8_t len) {
|
|||
*/
|
||||
void num_to_wiegand_bytes(uint64_t oem, uint64_t fc, uint64_t cn, uint8_t *dest, uint8_t formatlen){
|
||||
|
||||
uint8_t data[MAX_BITS_TXX55] = {0};
|
||||
memset(data, 0, sizeof(data));
|
||||
uint8_t data[MAX_BITS_TXX55] = {0};
|
||||
memset(data, 0, sizeof(data));
|
||||
|
||||
num_to_wiegand_bits(oem, fc, cn, data, formatlen);
|
||||
num_to_wiegand_bits(oem, fc, cn, data, formatlen);
|
||||
|
||||
// loop
|
||||
// (formatlen / 32 ) + 1
|
||||
// (formatlen >> 5) + 1
|
||||
for (int i = 0; i < formatlen ; ++i){
|
||||
uint32_t value = bytebits_to_byte( data + (i * 32), 32);
|
||||
num_to_bytes(value, 32, dest + (i*4) );
|
||||
}
|
||||
// loop
|
||||
// (formatlen / 32 ) + 1
|
||||
// (formatlen >> 5) + 1
|
||||
for (int i = 0; i < formatlen ; ++i){
|
||||
uint32_t value = bytebits_to_byte( data + (i * 32), 32);
|
||||
num_to_bytes(value, 32, dest + (i*4) );
|
||||
}
|
||||
|
||||
}
|
||||
/*
|
||||
|
|
@ -162,70 +162,70 @@ void num_to_wiegand_bytes(uint64_t oem, uint64_t fc, uint64_t cn, uint8_t *dest,
|
|||
*/
|
||||
void num_to_wiegand_bits(uint64_t oem, uint64_t fc, uint64_t cn, uint8_t *dest, uint8_t formatlen){
|
||||
|
||||
uint8_t bits[MAX_BITS_TXX55] = {0};
|
||||
memset(bits, 0, sizeof(bits));
|
||||
uint8_t *temp = bits;
|
||||
uint64_t value = 0;
|
||||
uint8_t bits[MAX_BITS_TXX55] = {0};
|
||||
memset(bits, 0, sizeof(bits));
|
||||
uint8_t *temp = bits;
|
||||
uint64_t value = 0;
|
||||
|
||||
switch ( formatlen ){
|
||||
case 26 : // 26bit HID H10301
|
||||
fc &= 0xFF; // 8bits
|
||||
cn &= 0xFFFF; // 16bits
|
||||
value = fc << 16 | cn;
|
||||
num_to_bytebits(value, 24, temp);
|
||||
wiegand_add_parity(temp, dest, 24);
|
||||
break;
|
||||
case 261: // 26bit Indala
|
||||
fc &= 0xFFF; // 12bits
|
||||
cn &= 0xFFF; // 12bits
|
||||
value = fc << 12 | cn;
|
||||
num_to_bytebits(value, 24, temp);
|
||||
wiegand_add_parity(temp, dest, 24);
|
||||
break;
|
||||
case 34 : // 34bits HID
|
||||
fc &= 0xFFFF; // 16bits
|
||||
cn &= 0xFFFF; // 16bits
|
||||
value = fc << 16 | cn;
|
||||
num_to_bytebits(value, 32, temp);
|
||||
wiegand_add_parity(temp, dest, 32);
|
||||
break;
|
||||
case 35 : // 35bits HID
|
||||
fc &= 0xFFF; // 12bits
|
||||
cn &= 0xFFFFFF; // 20bits
|
||||
value = fc << 20 | cn;
|
||||
num_to_bytebits(value, 32, temp);
|
||||
wiegand_add_parity(temp, dest, 32);
|
||||
break;
|
||||
case 37 : // H10304
|
||||
fc &= 0xFFFF; // 16bits
|
||||
cn &= 0x7FFFF; // 19bits
|
||||
value = fc << 19 | cn;
|
||||
num_to_bytebits(value, 35, temp);
|
||||
wiegand_add_parity(temp, dest, 35);
|
||||
break;
|
||||
case 39 : // 39bit KERI System Pyramid
|
||||
fc &= 0x1FFFF; // 17bits
|
||||
cn &= 0xFFFFFFFF; // 20bits
|
||||
value = fc << 20 | cn;
|
||||
num_to_bytebits(value, 37, temp);
|
||||
wiegand_add_parity(temp, dest, 37);
|
||||
break;
|
||||
case 44 : // 44bit KERI system Pyramid
|
||||
oem &= 0xFF; // 8bits
|
||||
fc &= 0xFFF; // 12bits
|
||||
cn &= 0xFFFFFFFF; // 21bits
|
||||
value = oem << 20 | fc << 12 | cn;
|
||||
num_to_bytebits(value, 42, temp);
|
||||
wiegand_add_parity(temp, dest, 42);
|
||||
break;
|
||||
case 50 : // AWID 50 RBH
|
||||
fc &= 0xFFFF; // 16bits
|
||||
cn &= 0xFFFFFFFF // 32bits
|
||||
value = fc << 32 | cn;
|
||||
num_to_bytebits(value, 48, temp);
|
||||
wiegand_add_parity(temp, dest, 48); // verify!
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
switch ( formatlen ){
|
||||
case 26 : // 26bit HID H10301
|
||||
fc &= 0xFF; // 8bits
|
||||
cn &= 0xFFFF; // 16bits
|
||||
value = fc << 16 | cn;
|
||||
num_to_bytebits(value, 24, temp);
|
||||
wiegand_add_parity(temp, dest, 24);
|
||||
break;
|
||||
case 261: // 26bit Indala
|
||||
fc &= 0xFFF; // 12bits
|
||||
cn &= 0xFFF; // 12bits
|
||||
value = fc << 12 | cn;
|
||||
num_to_bytebits(value, 24, temp);
|
||||
wiegand_add_parity(temp, dest, 24);
|
||||
break;
|
||||
case 34 : // 34bits HID
|
||||
fc &= 0xFFFF; // 16bits
|
||||
cn &= 0xFFFF; // 16bits
|
||||
value = fc << 16 | cn;
|
||||
num_to_bytebits(value, 32, temp);
|
||||
wiegand_add_parity(temp, dest, 32);
|
||||
break;
|
||||
case 35 : // 35bits HID
|
||||
fc &= 0xFFF; // 12bits
|
||||
cn &= 0xFFFFFF; // 20bits
|
||||
value = fc << 20 | cn;
|
||||
num_to_bytebits(value, 32, temp);
|
||||
wiegand_add_parity(temp, dest, 32);
|
||||
break;
|
||||
case 37 : // H10304
|
||||
fc &= 0xFFFF; // 16bits
|
||||
cn &= 0x7FFFF; // 19bits
|
||||
value = fc << 19 | cn;
|
||||
num_to_bytebits(value, 35, temp);
|
||||
wiegand_add_parity(temp, dest, 35);
|
||||
break;
|
||||
case 39 : // 39bit KERI System Pyramid
|
||||
fc &= 0x1FFFF; // 17bits
|
||||
cn &= 0xFFFFFFFF; // 20bits
|
||||
value = fc << 20 | cn;
|
||||
num_to_bytebits(value, 37, temp);
|
||||
wiegand_add_parity(temp, dest, 37);
|
||||
break;
|
||||
case 44 : // 44bit KERI system Pyramid
|
||||
oem &= 0xFF; // 8bits
|
||||
fc &= 0xFFF; // 12bits
|
||||
cn &= 0xFFFFFFFF; // 21bits
|
||||
value = oem << 20 | fc << 12 | cn;
|
||||
num_to_bytebits(value, 42, temp);
|
||||
wiegand_add_parity(temp, dest, 42);
|
||||
break;
|
||||
case 50 : // AWID 50 RBH
|
||||
fc &= 0xFFFF; // 16bits
|
||||
cn &= 0xFFFFFFFF // 32bits
|
||||
value = fc << 32 | cn;
|
||||
num_to_bytebits(value, 48, temp);
|
||||
wiegand_add_parity(temp, dest, 48); // verify!
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
Loading…
Add table
Add a link
Reference in a new issue