commonutil: pack / unpack ISO14443-A air order bits with parity
A HID SAM driving MIFARE Classic hands over Crypto1 frames as one bit stream: each byte's 8 data bits LSB first followed by its parity bit. These convert between that stream and the bytes plus parity array the PM3 reader and trace code use. Shared so the client can self test them. Cross checked against a port of Seader's plugin_hf_mfc_transmit for frames up to 8 bytes (its limit) and for 4 and 18 byte answers. Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
This commit is contained in:
1 parent
8d2a419319
commit
6100a46f12
2 files changed
+44
No files matched your search
@@ -702,3 +702,44 @@ int hexstr2ByteArr(const char *hexstr, unsigned char *array, size_t asize) {
|
||||
}
|
||||
return n >> 1;
|
||||
}
|
||||
|
||||
// ISO14443-A air order stream: per byte 8 data bits LSB first, then its parity
|
||||
// bit, packed LSB first. Parity arrays use the PM3 layout, MSB first per byte.
|
||||
// Returns the number of bytes written to out.
|
||||
uint16_t iso14a_air_bits_pack(const uint8_t *data, const uint8_t *par, uint16_t n, uint8_t *out) {
|
||||
uint16_t out_len = (uint16_t)(((uint32_t)n * 9 + 7) / 8);
|
||||
memset(out, 0, out_len);
|
||||
|
||||
for (uint16_t i = 0; i < n; i++) {
|
||||
uint32_t pos = (uint32_t)i * 9;
|
||||
for (uint8_t j = 0; j < 8; j++, pos++) {
|
||||
if ((data[i] >> j) & 1) {
|
||||
out[pos >> 3] |= (uint8_t)(1 << (pos & 7));
|
||||
}
|
||||
}
|
||||
if (par[i >> 3] & (0x80 >> (i & 7))) {
|
||||
out[pos >> 3] |= (uint8_t)(1 << (pos & 7));
|
||||
}
|
||||
}
|
||||
return out_len;
|
||||
}
|
||||
|
||||
// Inverse of iso14a_air_bits_pack. Trailing bits short of a whole 9 bit symbol
|
||||
// are padding. Returns the number of data bytes.
|
||||
uint16_t iso14a_air_bits_unpack(const uint8_t *in, uint16_t in_len, uint8_t *data, uint8_t *par) {
|
||||
uint16_t n = (uint16_t)(((uint32_t)in_len * 8) / 9);
|
||||
memset(par, 0, (n + 7) / 8);
|
||||
|
||||
for (uint16_t i = 0; i < n; i++) {
|
||||
uint32_t pos = (uint32_t)i * 9;
|
||||
uint8_t b = 0;
|
||||
for (uint8_t j = 0; j < 8; j++, pos++) {
|
||||
b |= (uint8_t)(((in[pos >> 3] >> (pos & 7)) & 1) << j);
|
||||
}
|
||||
data[i] = b;
|
||||
if ((in[pos >> 3] >> (pos & 7)) & 1) {
|
||||
par[i >> 3] |= (uint8_t)(0x80 >> (i & 7));
|
||||
}
|
||||
}
|
||||
return n;
|
||||
}
|
||||
@@ -161,4 +161,7 @@ void reverse_arraybytes_copy(const uint8_t *arr, uint8_t *dest, size_t len);
|
||||
size_t concatbits(uint8_t *dest, int dest_offset, const uint8_t *src, int src_offset, size_t nbits, bool src_lsb);
|
||||
int char2int(char c);
|
||||
int hexstr2ByteArr(const char *hexstr, unsigned char *array, size_t asize);
|
||||
|
||||
uint16_t iso14a_air_bits_pack(const uint8_t *data, const uint8_t *par, uint16_t n, uint8_t *out);
|
||||
uint16_t iso14a_air_bits_unpack(const uint8_t *in, uint16_t in_len, uint8_t *data, uint8_t *par);
|
||||
#endif
|
||||
Reference in new issue
Block a user