unleashed-firmware/lib/lfrfid/lfrfid_dict_file.c

#include "lfrfid_dict_file.h"
#include <storage/storage.h>
#include <flipper_format/flipper_format.h>
#include <lfrfid/tools/bit_lib.h>

#define LFRFID_DICT_FILETYPE "Flipper RFID key"

bool lfrfid_dict_file_save(ProtocolDict* dict, ProtocolId protocol, const char* filename) {
    furi_check(protocol != PROTOCOL_NO);
    Storage* storage = furi_record_open(RECORD_STORAGE);
    FlipperFormat* file = flipper_format_file_alloc(storage);
    size_t data_size = protocol_dict_get_data_size(dict, protocol);
    uint8_t* data = malloc(data_size);
    bool result = false;

    do {
        if(!flipper_format_file_open_always(file, filename)) break;
        if(!flipper_format_write_header_cstr(file, LFRFID_DICT_FILETYPE, 1)) break;

        // TODO: write comment about protocol types into file

        if(!flipper_format_write_string_cstr(
               file, "Key type", protocol_dict_get_name(dict, protocol)))
            break;

        // TODO: write comment about protocol sizes into file

        protocol_dict_get_data(dict, protocol, data, data_size);

        if(!flipper_format_write_hex(file, "Data", data, data_size)) break;
        result = true;
    } while(false);

    flipper_format_free(file);
    furi_record_close(RECORD_STORAGE);
    free(data);

    return result;
}

static void lfrfid_dict_protocol_indala_data(
    uint8_t* data,
    size_t data_size,
    uint8_t* protocol_data,
    size_t protocol_data_size) {
    UNUSED(data_size);
    memset(protocol_data, 0, protocol_data_size);

    // fc
    bit_lib_set_bit(protocol_data, 24, bit_lib_get_bit(data, 0));
    bit_lib_set_bit(protocol_data, 16, bit_lib_get_bit(data, 1));
    bit_lib_set_bit(protocol_data, 11, bit_lib_get_bit(data, 2));
    bit_lib_set_bit(protocol_data, 14, bit_lib_get_bit(data, 3));
    bit_lib_set_bit(protocol_data, 15, bit_lib_get_bit(data, 4));
    bit_lib_set_bit(protocol_data, 20, bit_lib_get_bit(data, 5));
    bit_lib_set_bit(protocol_data, 6, bit_lib_get_bit(data, 6));
    bit_lib_set_bit(protocol_data, 25, bit_lib_get_bit(data, 7));

    // cn
    bit_lib_set_bit(protocol_data, 9, bit_lib_get_bit(data, 8 + 0));
    bit_lib_set_bit(protocol_data, 12, bit_lib_get_bit(data, 8 + 1));
    bit_lib_set_bit(protocol_data, 10, bit_lib_get_bit(data, 8 + 2));
    bit_lib_set_bit(protocol_data, 7, bit_lib_get_bit(data, 8 + 3));
    bit_lib_set_bit(protocol_data, 19, bit_lib_get_bit(data, 8 + 4));
    bit_lib_set_bit(protocol_data, 3, bit_lib_get_bit(data, 8 + 5));
    bit_lib_set_bit(protocol_data, 2, bit_lib_get_bit(data, 8 + 6));
    bit_lib_set_bit(protocol_data, 18, bit_lib_get_bit(data, 8 + 7));
    bit_lib_set_bit(protocol_data, 13, bit_lib_get_bit(data, 8 + 8));
    bit_lib_set_bit(protocol_data, 0, bit_lib_get_bit(data, 8 + 9));
    bit_lib_set_bit(protocol_data, 4, bit_lib_get_bit(data, 8 + 10));
    bit_lib_set_bit(protocol_data, 21, bit_lib_get_bit(data, 8 + 11));
    bit_lib_set_bit(protocol_data, 23, bit_lib_get_bit(data, 8 + 12));
    bit_lib_set_bit(protocol_data, 26, bit_lib_get_bit(data, 8 + 13));
    bit_lib_set_bit(protocol_data, 17, bit_lib_get_bit(data, 8 + 14));
    bit_lib_set_bit(protocol_data, 8, bit_lib_get_bit(data, 8 + 15));

    const uint32_t fc_and_card = data[0] << 16 | data[1] << 8 | data[2];

    // indala checksum
    uint8_t checksum_sum = 0;
    checksum_sum += ((fc_and_card >> 14) & 1);
    checksum_sum += ((fc_and_card >> 12) & 1);
    checksum_sum += ((fc_and_card >> 9) & 1);
    checksum_sum += ((fc_and_card >> 8) & 1);
    checksum_sum += ((fc_and_card >> 6) & 1);
    checksum_sum += ((fc_and_card >> 5) & 1);
    checksum_sum += ((fc_and_card >> 2) & 1);
    checksum_sum += ((fc_and_card >> 0) & 1);
    checksum_sum = checksum_sum & 0b1;

    if(checksum_sum) {
        bit_lib_set_bit(protocol_data, 27, 0);
        bit_lib_set_bit(protocol_data, 28, 1);
    } else {
        bit_lib_set_bit(protocol_data, 27, 1);
        bit_lib_set_bit(protocol_data, 28, 0);
    }

    // wiegand parity
    uint8_t even_parity_sum = 0;
    for(int8_t i = 12; i < 24; i++) {
        if(((fc_and_card >> i) & 1) == 1) {
            even_parity_sum++;
        }
    }
    bit_lib_set_bit(protocol_data, 1, even_parity_sum % 2);

    uint8_t odd_parity_sum = 1;
    for(int8_t i = 0; i < 12; i++) {
        if(((fc_and_card >> i) & 1) == 1) {
            odd_parity_sum++;
        }
    }
    bit_lib_set_bit(protocol_data, 5, odd_parity_sum % 2);
}

static ProtocolId lfrfid_dict_protocol_fallback(
    ProtocolDict* dict,
    const char* protocol_name,
    FlipperFormat* file) {
    ProtocolId result = PROTOCOL_NO;
    if(strcmp(protocol_name, "I40134") == 0) {
        ProtocolId protocol = LFRFIDProtocolIndala26;

        size_t data_size = 3;
        size_t protocol_data_size = protocol_dict_get_data_size(dict, protocol);
        uint8_t* data = malloc(data_size);
        uint8_t* protocol_data = malloc(protocol_data_size);
        if(flipper_format_read_hex(file, "Data", data, data_size)) {
            lfrfid_dict_protocol_indala_data(data, data_size, protocol_data, protocol_data_size);
            protocol_dict_set_data(dict, protocol, protocol_data, protocol_data_size);
            result = protocol;
        }
        free(protocol_data);
        free(data);
    }

    return result;
}

ProtocolId lfrfid_dict_file_load(ProtocolDict* dict, const char* filename) {
    Storage* storage = furi_record_open(RECORD_STORAGE);
    FlipperFormat* file = flipper_format_file_alloc(storage);
    ProtocolId result = PROTOCOL_NO;
    uint8_t* data = malloc(protocol_dict_get_max_data_size(dict));
    string_t str_result;
    string_init(str_result);

    do {
        if(!flipper_format_file_open_existing(file, filename)) break;

        // header
        uint32_t version;
        if(!flipper_format_read_header(file, str_result, &version)) break;
        if(string_cmp_str(str_result, LFRFID_DICT_FILETYPE) != 0) break;
        if(version != 1) break;

        // type
        if(!flipper_format_read_string(file, "Key type", str_result)) break;
        ProtocolId protocol;
        protocol = protocol_dict_get_protocol_by_name(dict, string_get_cstr(str_result));

        if(protocol == PROTOCOL_NO) {
            protocol = lfrfid_dict_protocol_fallback(dict, string_get_cstr(str_result), file);
            if(protocol == PROTOCOL_NO) break;
        } else {
            // data
            size_t data_size = protocol_dict_get_data_size(dict, protocol);
            if(!flipper_format_read_hex(file, "Data", data, data_size)) break;
            protocol_dict_set_data(dict, protocol, data, data_size);
        }

        result = protocol;
    } while(false);

    free(data);
    string_clear(str_result);
    flipper_format_free(file);
    furi_record_close(RECORD_STORAGE);

    return result;
}