mirror of
https://github.com/DarkFlippers/unleashed-firmware
synced 2024-11-10 15:04:19 +00:00
dd988ba449
* nfc_util functions for processing bytes moved into bit_lib * bitlib test update * bit_lib moved from lfrfid to standalone lib * Added bit functions for any supported data types * Error fix and api add * Added test for 64 * Added doc * Testcase for 64 rewrited * Realization error fix * API version bump * sync api version, fix after-merge old libs usage * fix build errors * build fix * fbt format Co-authored-by: assasinfil <nfa57643@gmail.com> Co-authored-by: gornekich <n.gorbadey@gmail.com> Co-authored-by: あく <alleteam@gmail.com>
48 lines
No EOL
1.6 KiB
C
48 lines
No EOL
1.6 KiB
C
#include "nfc_util.h"
|
|
|
|
#include <furi.h>
|
|
|
|
static const uint8_t nfc_util_odd_byte_parity[256] = {
|
|
1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1, 0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0,
|
|
1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0, 1, 0, 0, 1, 0, 1, 1, 0, 0, 1,
|
|
1, 0, 1, 0, 0, 1, 0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0, 1, 0, 0, 1, 0, 1, 1,
|
|
0, 0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1, 0, 1, 1, 0,
|
|
1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0, 1,
|
|
0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0,
|
|
0, 1, 0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0, 1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1,
|
|
0, 1, 0, 0, 1, 0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1,
|
|
1, 0, 0, 1, 0, 1, 1, 0, 1, 0, 0, 1, 0, 1, 1, 0, 0, 1, 1, 0, 1, 0, 0, 1};
|
|
|
|
uint8_t nfc_util_even_parity32(uint32_t data) {
|
|
// data ^= data >> 16;
|
|
// data ^= data >> 8;
|
|
// return !nfc_util_odd_byte_parity[data];
|
|
return (__builtin_parity(data) & 0xFF);
|
|
}
|
|
|
|
uint8_t nfc_util_odd_parity8(uint8_t data) {
|
|
return nfc_util_odd_byte_parity[data];
|
|
}
|
|
|
|
void nfc_util_odd_parity(const uint8_t* src, uint8_t* dst, uint8_t len) {
|
|
furi_assert(src);
|
|
furi_assert(dst);
|
|
|
|
uint8_t parity = 0;
|
|
uint8_t bit = 0;
|
|
while(len--) {
|
|
parity |= nfc_util_odd_parity8(*src) << (7 - bit); // parity is MSB first
|
|
bit++;
|
|
if(bit == 8) {
|
|
*dst = parity;
|
|
dst++;
|
|
parity = 0;
|
|
bit = 0;
|
|
}
|
|
src++;
|
|
}
|
|
|
|
if(bit) {
|
|
*dst = parity;
|
|
}
|
|
} |