mirror of
https://github.com/DarkFlippers/unleashed-firmware
synced 2025-02-18 22:38:35 +00:00
467e973da2
* Moved some structs and defs from poller to generic felica * Buffer size increased for transferring more data * Felica HAL Tx function implemented * Some structs and fields for listener * Raw listener implementation * Added new event for felica activation * Proper config fot listener added * Moved some structs from poller in order to use them in listener too * New function for calculating MAC * Listener data structures and function definitions * Private listener functions implementation added * Raw felica listener logic implementation added * Fix total sector count both for poller and listener * Defined type for write handlers * New logic for write operations added * Removed old commented code * Splitted read logic into several separate functions * New type added and some fields to instance * New logic of read command implemented * Defines added for response codes * Functions moved to private namespace * Function visibility changed and some cleanups * Update felica_listener.c, felica_listener_i.c, and felica_listener_i.h * Some type adjustments * Moved frame_exchange function to private namespace * Error handling added * Function to get data_ptr for write request added * Missing declaration added * Add processing of nfc errors * write_with_mac is a local variable now * Adjustments to MAC calculation logic * Values replaced with defines * Update nfc_transport.c with felica logic * Sync felica poller added for unit tests * Felica unit_tests and data dump added * Fixed proper reading of MAC_A block when it is 1st * Macro definitions for MC added * Function simplified * More defines * CRC check for incomming packets added * Readonly logic adjusted * Block write validation adjusted * New logic for ID block writing * Some cleanups * New logic of moving across the block list with different element length * Some cleanups * Adjusted requires_mac logic to cover all blocks needed * Cleanups and renaming * New block list validation logic * Block list logic iteration simplified * Some asserts and checks added * Replaced MC[2] checks with macros * Marked def values as unsigned * Removed old code * Removed commented function declarations * Changed protected block in felica test card dump and adjusted tests * Fixes after merge * Moved defines to header * Now we allocate memory for max possible response pack in any case * Some renaming and documentation * Bump api symbols * Set feature to emulate full for felica * Removed 'More' button and added MoreInfo feature which adds this button back * Types renamed * Removed unnecessary code * Reformat comments * Fixing missing signatures * Replaced crash with error log and return value * Format doxygen comments Co-authored-by: Aleksandr Kutuzov <alleteam@gmail.com>
57 lines
1.6 KiB
C
57 lines
1.6 KiB
C
#include "felica_crc.h"
|
|
|
|
#include <furi/furi.h>
|
|
|
|
#define FELICA_CRC_POLY (0x1021U) // Polynomial: x^16 + x^12 + x^5 + 1
|
|
#define FELICA_CRC_INIT (0x0000U)
|
|
|
|
uint16_t felica_crc_calculate(const uint8_t* data, size_t length) {
|
|
furi_check(data);
|
|
|
|
uint16_t crc = FELICA_CRC_INIT;
|
|
|
|
for(size_t i = 0; i < length; i++) {
|
|
crc ^= ((uint16_t)data[i] << 8);
|
|
for(size_t j = 0; j < 8; j++) {
|
|
if(crc & 0x8000) {
|
|
crc <<= 1;
|
|
crc ^= FELICA_CRC_POLY;
|
|
} else {
|
|
crc <<= 1;
|
|
}
|
|
}
|
|
}
|
|
|
|
return (crc << 8) | (crc >> 8);
|
|
}
|
|
|
|
void felica_crc_append(BitBuffer* buf) {
|
|
furi_check(buf);
|
|
const uint8_t* data = bit_buffer_get_data(buf);
|
|
const size_t data_size = bit_buffer_get_size_bytes(buf);
|
|
|
|
const uint16_t crc = felica_crc_calculate(data, data_size);
|
|
bit_buffer_append_bytes(buf, (const uint8_t*)&crc, FELICA_CRC_SIZE);
|
|
}
|
|
|
|
bool felica_crc_check(const BitBuffer* buf) {
|
|
furi_check(buf);
|
|
const size_t data_size = bit_buffer_get_size_bytes(buf);
|
|
if(data_size <= FELICA_CRC_SIZE) return false;
|
|
|
|
uint16_t crc_received;
|
|
bit_buffer_write_bytes_mid(buf, &crc_received, data_size - FELICA_CRC_SIZE, FELICA_CRC_SIZE);
|
|
|
|
const uint8_t* data = bit_buffer_get_data(buf);
|
|
const uint16_t crc_calc = felica_crc_calculate(data, data_size - FELICA_CRC_SIZE);
|
|
|
|
return (crc_calc == crc_received);
|
|
}
|
|
|
|
void felica_crc_trim(BitBuffer* buf) {
|
|
furi_check(buf);
|
|
const size_t data_size = bit_buffer_get_size_bytes(buf);
|
|
furi_assert(data_size > FELICA_CRC_SIZE);
|
|
|
|
bit_buffer_set_size_bytes(buf, data_size - FELICA_CRC_SIZE);
|
|
}
|