picopass_device.c 5.6 KB

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