#include "uhf_device.h" #include #include #include #include #define TAG "UHFDevice" static const char* uhf_file_header = "Flipper UHF RFID device"; static const uint32_t uhf_file_version = 1; // static const uint8_t bank_data_start = 20; // static const uint8_t bank_data_length = 16; UHFDevice* uhf_device_alloc() { UHFDevice* uhf_device = malloc(sizeof(UHFDevice)); uhf_device->storage = furi_record_open(RECORD_STORAGE); uhf_device->dialogs = furi_record_open(RECORD_DIALOGS); uhf_device->load_path = furi_string_alloc(); return uhf_device; } void uhf_device_set_name(UHFDevice* dev, const char* name) { furi_assert(dev); strlcpy(dev->dev_name, name, UHF_DEV_NAME_MAX_LEN); } static bool uhf_device_save_file( UHFDevice* dev, const char* dev_name, const char* folder, const char* extension, bool use_load_path) { furi_assert(dev); UHFTag* uhf_tag = dev->uhf_tag_wrapper->uhf_tag; bool saved = false; FlipperFormat* file = flipper_format_file_alloc(dev->storage); FuriString* temp_str; temp_str = furi_string_alloc(); do { if(use_load_path && !furi_string_empty(dev->load_path)) { // Get directory name path_extract_dirname(furi_string_get_cstr(dev->load_path), temp_str); // Make path to file to save furi_string_cat_printf(temp_str, "/%s%s", dev_name, extension); } else { // First remove uhf device file if it was saved furi_string_printf(temp_str, "%s/%s%s", folder, dev_name, extension); } // Open file if(!flipper_format_file_open_always(file, furi_string_get_cstr(temp_str))) break; // Write header if(!flipper_format_write_header_cstr(file, uhf_file_header, uhf_file_version)) break; // Reserved bank might be added // todo : maybe uint32_t temp_arr[1]; uint8_t temp_arr2[2]; // write pc temp_arr2[0] = (uint8_t)(uhf_tag_get_epc_pc(uhf_tag) >> 8) & 0xFF; temp_arr2[1] = (uint8_t)(uhf_tag_get_epc_pc(uhf_tag) & 0xFF); if(!flipper_format_write_hex(file, UHF_EPC_PC_LABEL, temp_arr2, 2)) break; // write crc temp_arr2[0] = (uint8_t)(uhf_tag_get_epc_crc(uhf_tag) >> 8) & 0xFF; temp_arr2[1] = (uint8_t)(uhf_tag_get_epc_crc(uhf_tag) & 0xFF); if(!flipper_format_write_hex(file, UHF_EPC_CRC_LABEL, temp_arr2, 2)) break; // write epc temp_arr[0] = uhf_tag_get_epc_size(uhf_tag); if(!flipper_format_write_uint32(file, UHF_EPC_BANK_LENGTH_LABEL, temp_arr, 1)) break; if(!flipper_format_write_hex( file, UHF_EPC_BANK_LABEL, uhf_tag_get_epc(uhf_tag), uhf_tag_get_epc_size(uhf_tag))) break; // write tid temp_arr[0] = uhf_tag_get_tid_size(uhf_tag); if(!flipper_format_write_uint32(file, UHF_TID_BANK_LENGTH_LABEL, temp_arr, 1)) break; if(!flipper_format_write_hex( file, UHF_TID_BANK_LABEL, uhf_tag_get_tid(uhf_tag), uhf_tag_get_tid_size(uhf_tag))) break; // write user temp_arr[0] = uhf_tag_get_user_size(uhf_tag); if(!flipper_format_write_uint32(file, UHF_USER_BANK_LENGTH_LABEL, temp_arr, 1)) break; if(!flipper_format_write_hex( file, UHF_USER_BANK_LABEL, uhf_tag_get_user(uhf_tag), uhf_tag_get_user_size(uhf_tag))) break; saved = true; } while(0); if(!saved) { dialog_message_show_storage_error(dev->dialogs, "Can not save\nfile"); } furi_string_free(temp_str); flipper_format_free(file); return saved; } bool uhf_device_save(UHFDevice* dev, const char* dev_name) { return uhf_device_save_file( dev, dev_name, STORAGE_APP_DATA_PATH_PREFIX, UHF_APP_EXTENSION, true); return false; } // uncomment static bool uhf_device_load_data(UHFDevice* dev, FuriString* path, bool show_dialog) { bool parsed = false; FlipperFormat* file = flipper_format_file_alloc(dev->storage); // UHFResponseData* uhf_response_data = dev->dev_data; FuriString* temp_str; temp_str = furi_string_alloc(); bool deprecated_version = false; UHFTag* uhf_tag = uhf_tag_alloc(); uhf_tag_reset(uhf_tag); uint32_t temp_arr[1]; if(dev->loading_cb) { dev->loading_cb(dev->loading_cb_ctx, true); } do { if(!flipper_format_file_open_existing(file, furi_string_get_cstr(path))) break; // Read and verify file header uint32_t version = 0; if(!flipper_format_read_header(file, temp_str, &version)) break; if(furi_string_cmp_str(temp_str, uhf_file_header) || (version != uhf_file_version)) { deprecated_version = true; break; } // read pc uint8_t temp_arr2[2]; if(!flipper_format_read_hex(file, UHF_EPC_PC_LABEL, temp_arr2, 2)) break; uhf_tag_set_epc_pc(uhf_tag, (temp_arr2[0] << 8) + temp_arr2[1]); // read crc if(!flipper_format_read_hex(file, UHF_EPC_CRC_LABEL, temp_arr2, 2)) break; uhf_tag_set_epc_crc(uhf_tag, (temp_arr2[0] << 8) + temp_arr2[1]); // read epc if(!flipper_format_read_uint32(file, UHF_EPC_BANK_LENGTH_LABEL, temp_arr, 1)) break; uhf_tag_set_epc_size(uhf_tag, temp_arr[0]); if(!flipper_format_read_hex( file, UHF_EPC_BANK_LABEL, uhf_tag_get_epc(uhf_tag), uhf_tag_get_epc_size(uhf_tag))) break; // read tid if(!flipper_format_read_uint32(file, UHF_TID_BANK_LENGTH_LABEL, temp_arr, 1)) break; uhf_tag_set_tid_size(uhf_tag, temp_arr[0]); if(!flipper_format_read_hex( file, UHF_TID_BANK_LABEL, uhf_tag_get_tid(uhf_tag), uhf_tag_get_tid_size(uhf_tag))) break; // read user if(!flipper_format_read_uint32(file, UHF_USER_BANK_LENGTH_LABEL, temp_arr, 1)) break; uhf_tag_set_user_size(uhf_tag, temp_arr[0]); if(!flipper_format_read_hex( file, UHF_USER_BANK_LABEL, uhf_tag_get_user(uhf_tag), uhf_tag_get_user_size(uhf_tag))) break; parsed = true; } while(false); if(dev->loading_cb) { dev->loading_cb(dev->loading_cb_ctx, false); } if((!parsed) && (show_dialog)) { if(deprecated_version) { dialog_message_show_storage_error(dev->dialogs, "File format deprecated"); } else { dialog_message_show_storage_error(dev->dialogs, "Can not parse\nfile"); } } uhf_tag_wrapper_set_tag(dev->uhf_tag_wrapper, uhf_tag); furi_string_free(temp_str); flipper_format_free(file); return parsed; } // void picopass_device_clear(UHFDevice* dev) { // furi_assert(dev); // picopass_device_data_clear(&dev->dev_data); // memset(&dev->dev_data, 0, sizeof(dev->dev_data)); // dev->format = PicopassDeviceSaveFormatHF; // furi_string_reset(dev->load_path); // } void uhf_device_free(UHFDevice* uhf_dev) { furi_assert(uhf_dev); furi_record_close(RECORD_STORAGE); furi_record_close(RECORD_DIALOGS); furi_string_free(uhf_dev->load_path); free(uhf_dev); } bool uhf_file_select(UHFDevice* dev) { furi_assert(dev); FuriString* uhf_app_folder; uhf_app_folder = furi_string_alloc_set(STORAGE_APP_DATA_PATH_PREFIX); DialogsFileBrowserOptions browser_options; dialog_file_browser_set_basic_options(&browser_options, UHF_APP_EXTENSION, &I_Nfc_10px); browser_options.base_path = STORAGE_APP_DATA_PATH_PREFIX; bool res = dialog_file_browser_show(dev->dialogs, dev->load_path, uhf_app_folder, &browser_options); furi_string_free(uhf_app_folder); if(res) { FuriString* filename; filename = furi_string_alloc(); path_extract_filename(dev->load_path, filename, true); strncpy(dev->dev_name, furi_string_get_cstr(filename), UHF_DEV_NAME_MAX_LEN); res = uhf_device_load_data(dev, dev->load_path, true); if(res) { uhf_device_set_name(dev, dev->dev_name); } furi_string_free(filename); } return res; } // void uhf_device_data_clear(UHFDevice* dev_data) { // for(size_t i = 0; i < PICOPASS_MAX_APP_LIMIT; i++) { // memset(dev_data->AA1[i].data, 0, sizeof(dev_data->AA1[i].data)); // } // dev_data->pacs.legacy = false; // dev_data->pacs.se_enabled = false; // dev_data->pacs.elite_kdf = false; // dev_data->pacs.pin_length = 0; // } bool uhf_device_delete(UHFDevice* dev, bool use_load_path) { furi_assert(dev); bool deleted = false; FuriString* file_path; file_path = furi_string_alloc(); do { // Delete original file if(use_load_path && !furi_string_empty(dev->load_path)) { furi_string_set(file_path, dev->load_path); } else { furi_string_printf(file_path, APP_DATA_PATH("%s%s"), dev->dev_name, UHF_APP_EXTENSION); } if(!storage_simply_remove(dev->storage, furi_string_get_cstr(file_path))) break; deleted = true; } while(0); if(!deleted) { dialog_message_show_storage_error(dev->dialogs, "Can not remove file"); } furi_string_free(file_path); return deleted; } void uhf_device_set_loading_callback(UHFDevice* dev, UHFLoadingCallback callback, void* context) { furi_assert(dev); dev->loading_cb = callback; dev->loading_cb_ctx = context; } // ReturnCode picopass_device_decrypt(uint8_t* enc_data, uint8_t* dec_data) { // uint8_t key[32] = {0}; // memcpy(key, picopass_iclass_decryptionkey, sizeof(picopass_iclass_decryptionkey)); // mbedtls_des3_context ctx; // mbedtls_des3_init(&ctx); // mbedtls_des3_set2key_dec(&ctx, key); // mbedtls_des3_crypt_ecb(&ctx, enc_data, dec_data); // mbedtls_des3_free(&ctx); // return ERR_NONE; // } // ReturnCode picopass_device_parse_credential(PicopassBlock* AA1, PicopassPacs* pacs) { // ReturnCode err; // pacs->biometrics = AA1[6].data[4]; // pacs->pin_length = AA1[6].data[6] & 0x0F; // pacs->encryption = AA1[6].data[7]; // if(pacs->encryption == PicopassDeviceEncryption3DES) { // FURI_LOG_D(TAG, "3DES Encrypted"); // err = picopass_device_decrypt(AA1[7].data, pacs->credential); // if(err != ERR_NONE) { // FURI_LOG_E(TAG, "decrypt error %d", err); // return err; // } // err = picopass_device_decrypt(AA1[8].data, pacs->pin0); // if(err != ERR_NONE) { // FURI_LOG_E(TAG, "decrypt error %d", err); // return err; // } // err = picopass_device_decrypt(AA1[9].data, pacs->pin1); // if(err != ERR_NONE) { // FURI_LOG_E(TAG, "decrypt error %d", err); // return err; // } // } else if(pacs->encryption == PicopassDeviceEncryptionNone) { // FURI_LOG_D(TAG, "No Encryption"); // memcpy(pacs->credential, AA1[7].data, PICOPASS_BLOCK_LEN); // memcpy(pacs->pin0, AA1[8].data, PICOPASS_BLOCK_LEN); // memcpy(pacs->pin1, AA1[9].data, PICOPASS_BLOCK_LEN); // } else if(pacs->encryption == PicopassDeviceEncryptionDES) { // FURI_LOG_D(TAG, "DES Encrypted"); // } else { // FURI_LOG_D(TAG, "Unknown encryption"); // } // pacs->sio = (AA1[10].data[0] == 0x30); // rough check // return ERR_NONE; // } // ReturnCode picopass_device_parse_wiegand(uint8_t* data, PicopassWiegandRecord* record) { // uint32_t* halves = (uint32_t*)data; // if(halves[0] == 0) { // uint8_t leading0s = __builtin_clz(REVERSE_BYTES_U32(halves[1])); // record->bitLength = 31 - leading0s; // } else { // uint8_t leading0s = __builtin_clz(REVERSE_BYTES_U32(halves[0])); // record->bitLength = 63 - leading0s; // } // FURI_LOG_D(TAG, "bitLength: %d", record->bitLength); // if(record->bitLength == 26) { // uint8_t* v4 = data + 4; // uint32_t bot = v4[3] | (v4[2] << 8) | (v4[1] << 16) | (v4[0] << 24); // record->CardNumber = (bot >> 1) & 0xFFFF; // record->FacilityCode = (bot >> 17) & 0xFF; // FURI_LOG_D(TAG, "FC: %u CN: %u", record->FacilityCode, record->CardNumber); // record->valid = true; // } else { // record->CardNumber = 0; // record->FacilityCode = 0; // record->valid = false; // } // return ERR_NONE; // }