picopass_device.c 6.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154
  1. #include "picopass_device.h"
  2. #include <toolbox/path.h>
  3. #include <flipper_format/flipper_format.h>
  4. #define TAG "PicopassDevice"
  5. static const char* picopass_file_header = "Flipper Picopass device";
  6. static const uint32_t picopass_file_version = 1;
  7. PicopassDevice* picopass_device_alloc() {
  8. PicopassDevice* picopass_dev = malloc(sizeof(PicopassDevice));
  9. picopass_dev->dev_data.pacs.legacy = false;
  10. picopass_dev->dev_data.pacs.se_enabled = false;
  11. picopass_dev->dev_data.pacs.pin_length = 0;
  12. picopass_dev->storage = furi_record_open(RECORD_STORAGE);
  13. picopass_dev->dialogs = furi_record_open(RECORD_DIALOGS);
  14. return picopass_dev;
  15. }
  16. void picopass_device_set_name(PicopassDevice* dev, const char* name) {
  17. furi_assert(dev);
  18. strlcpy(dev->dev_name, name, PICOPASS_DEV_NAME_MAX_LEN);
  19. }
  20. static bool picopass_device_save_file(
  21. PicopassDevice* dev,
  22. const char* dev_name,
  23. const char* folder,
  24. const char* extension,
  25. bool use_load_path) {
  26. furi_assert(dev);
  27. bool saved = false;
  28. FlipperFormat* file = flipper_format_file_alloc(dev->storage);
  29. PicopassPacs* pacs = &dev->dev_data.pacs;
  30. PicopassBlock* AA1 = dev->dev_data.AA1;
  31. string_t temp_str;
  32. string_init(temp_str);
  33. do {
  34. if(use_load_path && !string_empty_p(dev->load_path)) {
  35. // Get directory name
  36. path_extract_dirname(string_get_cstr(dev->load_path), temp_str);
  37. // Create picopass directory if necessary
  38. if(!storage_simply_mkdir(dev->storage, string_get_cstr(temp_str))) break;
  39. // Make path to file to save
  40. string_cat_printf(temp_str, "/%s%s", dev_name, extension);
  41. } else {
  42. // Create picopass directory if necessary
  43. if(!storage_simply_mkdir(dev->storage, PICOPASS_APP_FOLDER)) break;
  44. // First remove picopass device file if it was saved
  45. string_printf(temp_str, "%s/%s%s", folder, dev_name, extension);
  46. }
  47. // Open file
  48. if(!flipper_format_file_open_always(file, string_get_cstr(temp_str))) break;
  49. if(dev->format == PicopassDeviceSaveFormatHF) {
  50. uint32_t fc = pacs->record.FacilityCode;
  51. uint32_t cn = pacs->record.CardNumber;
  52. // Write header
  53. if(!flipper_format_write_header_cstr(file, picopass_file_header, picopass_file_version))
  54. break;
  55. if(pacs->record.valid) {
  56. if(!flipper_format_write_uint32(file, "Facility Code", &fc, 1)) break;
  57. if(!flipper_format_write_uint32(file, "Card Number", &cn, 1)) break;
  58. if(!flipper_format_write_hex(
  59. file, "Credential", pacs->credential, PICOPASS_BLOCK_LEN))
  60. break;
  61. if(pacs->pin_length > 0) {
  62. if(!flipper_format_write_hex(file, "PIN\t\t", pacs->pin0, PICOPASS_BLOCK_LEN))
  63. break;
  64. if(!flipper_format_write_hex(
  65. file, "PIN(cont.)\t", pacs->pin1, PICOPASS_BLOCK_LEN))
  66. break;
  67. }
  68. }
  69. if(!flipper_format_write_comment_cstr(file, "Picopass blocks")) break;
  70. bool block_saved = true;
  71. size_t app_limit = AA1[PICOPASS_CONFIG_BLOCK_INDEX].data[0] < PICOPASS_MAX_APP_LIMIT ?
  72. AA1[PICOPASS_CONFIG_BLOCK_INDEX].data[0] :
  73. PICOPASS_MAX_APP_LIMIT;
  74. for(size_t i = 0; i < app_limit; i++) {
  75. string_printf(temp_str, "Block %d", i);
  76. if(!flipper_format_write_hex(
  77. file, string_get_cstr(temp_str), AA1[i].data, PICOPASS_BLOCK_LEN)) {
  78. block_saved = false;
  79. break;
  80. }
  81. }
  82. if(!block_saved) break;
  83. } else if(dev->format == PicopassDeviceSaveFormatLF) {
  84. const char* lf_header = "Flipper RFID key";
  85. // Write header
  86. if(!flipper_format_write_header_cstr(file, lf_header, 1)) break;
  87. if(!flipper_format_write_comment_cstr(
  88. file,
  89. "This was generated from the Picopass plugin and may not match current lfrfid"))
  90. break;
  91. // When lfrfid supports more formats, update this
  92. if(!flipper_format_write_string_cstr(file, "Key type", "H10301")) break;
  93. uint8_t H10301[3] = {0};
  94. H10301[0] = pacs->record.FacilityCode;
  95. H10301[1] = pacs->record.CardNumber >> 8;
  96. H10301[2] = pacs->record.CardNumber & 0x00FF;
  97. if(!flipper_format_write_hex(file, "Data", H10301, 3)) break;
  98. }
  99. saved = true;
  100. } while(0);
  101. if(!saved) {
  102. dialog_message_show_storage_error(dev->dialogs, "Can not save\nkey file");
  103. }
  104. string_clear(temp_str);
  105. flipper_format_free(file);
  106. return saved;
  107. }
  108. bool picopass_device_save(PicopassDevice* dev, const char* dev_name) {
  109. if(dev->format == PicopassDeviceSaveFormatHF) {
  110. return picopass_device_save_file(
  111. dev, dev_name, PICOPASS_APP_FOLDER, PICOPASS_APP_EXTENSION, true);
  112. } else if(dev->format == PicopassDeviceSaveFormatLF) {
  113. return picopass_device_save_file(dev, dev_name, ANY_PATH("lfrfid"), ".rfid", true);
  114. }
  115. return false;
  116. }
  117. void picopass_device_clear(PicopassDevice* dev) {
  118. furi_assert(dev);
  119. picopass_device_data_clear(&dev->dev_data);
  120. memset(&dev->dev_data, 0, sizeof(dev->dev_data));
  121. }
  122. void picopass_device_free(PicopassDevice* picopass_dev) {
  123. furi_assert(picopass_dev);
  124. picopass_device_clear(picopass_dev);
  125. furi_record_close(RECORD_STORAGE);
  126. furi_record_close(RECORD_DIALOGS);
  127. string_clear(picopass_dev->load_path);
  128. free(picopass_dev);
  129. }
  130. void picopass_device_data_clear(PicopassDeviceData* dev_data) {
  131. for(size_t i = 0; i < PICOPASS_MAX_APP_LIMIT; i++) {
  132. memset(dev_data->AA1[i].data, 0, sizeof(dev_data->AA1[i].data));
  133. }
  134. dev_data->pacs.legacy = false;
  135. dev_data->pacs.se_enabled = false;
  136. dev_data->pacs.pin_length = 0;
  137. }