nfc_device.c 3.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139
  1. #include "nfc_device.h"
  2. #include <file-worker.h>
  3. #include <path.h>
  4. #define NFC_DEVICE_MAX_DATA_LEN 14
  5. static const char* nfc_app_folder = "nfc";
  6. static const char* nfc_app_extension = ".nfc";
  7. void nfc_device_set_name(NfcDevice* dev, const char* name) {
  8. furi_assert(dev);
  9. strlcpy(dev->dev_name, name, NFC_DEV_NAME_MAX_LEN);
  10. }
  11. bool nfc_device_save(NfcDevice* dev, const char* dev_name) {
  12. furi_assert(dev);
  13. FileWorker* file_worker = file_worker_alloc(false);
  14. string_t dev_file_name;
  15. // Create nfc directory if necessary
  16. if(!file_worker_mkdir(file_worker, nfc_app_folder)) {
  17. return false;
  18. };
  19. // First remove nfc device file if it was saved
  20. string_init_printf(dev_file_name, "%s/%s%s", nfc_app_folder, dev_name, nfc_app_extension);
  21. if(!file_worker_remove(file_worker, string_get_cstr(dev_file_name))) {
  22. string_clear(dev_file_name);
  23. return false;
  24. };
  25. // Prepare buffer to write
  26. uint8_t buff[NFC_DEVICE_MAX_DATA_LEN];
  27. buff[0] = dev->data.uid_len;
  28. memcpy(&buff[1], dev->data.uid, dev->data.uid_len);
  29. memcpy(&buff[dev->data.uid_len + 1], dev->data.atqa, 2);
  30. buff[dev->data.uid_len + 3] = dev->data.sak;
  31. // Save nfc device
  32. bool res = file_worker_open(
  33. file_worker, string_get_cstr(dev_file_name), FSAM_WRITE, FSOM_CREATE_ALWAYS);
  34. string_clear(dev_file_name);
  35. if(res) {
  36. // Write UID length
  37. if(!file_worker_write_hex(file_worker, buff, dev->data.uid_len + 4)) {
  38. file_worker_close(file_worker);
  39. return false;
  40. }
  41. }
  42. file_worker_close(file_worker);
  43. file_worker_free(file_worker);
  44. return true;
  45. }
  46. static bool nfc_device_load_data(FileWorker* file_worker, string_t path, NfcDevice* dev) {
  47. // Open key file
  48. if(!file_worker_open(file_worker, string_get_cstr(path), FSAM_READ, FSOM_OPEN_EXISTING)) {
  49. return false;
  50. }
  51. uint8_t buff[NFC_DEVICE_MAX_DATA_LEN] = {};
  52. // Load first byte - UID length
  53. if(!file_worker_read_hex(file_worker, buff, 1)) {
  54. return false;
  55. }
  56. // Read space
  57. uint8_t space = 0;
  58. if(!file_worker_read(file_worker, &space, 1)) {
  59. return false;
  60. }
  61. // Load other data
  62. if(!file_worker_read_hex(file_worker, &buff[1], buff[0] + 3)) {
  63. return false;
  64. }
  65. // Set loaded data
  66. dev->data.uid_len = buff[0];
  67. memcpy(dev->data.uid, &buff[1], dev->data.uid_len);
  68. memcpy(dev->data.atqa, &buff[dev->data.uid_len + 1], 2);
  69. dev->data.sak = buff[dev->data.uid_len + 3];
  70. return true;
  71. }
  72. bool nfc_device_load(NfcDevice* dev, const char* file_path) {
  73. furi_assert(dev);
  74. furi_assert(file_path);
  75. FileWorker* file_worker = file_worker_alloc(false);
  76. // Load device data
  77. string_t path;
  78. string_init_set_str(path, file_path);
  79. bool dev_load = nfc_device_load_data(file_worker, path, dev);
  80. if(dev_load) {
  81. // Set device name
  82. path_extract_filename_no_ext(file_path, path);
  83. nfc_device_set_name(dev, string_get_cstr(path));
  84. }
  85. string_clear(path);
  86. file_worker_close(file_worker);
  87. file_worker_free(file_worker);
  88. return dev_load;
  89. }
  90. bool nfc_file_select(NfcDevice* dev) {
  91. furi_assert(dev);
  92. FileWorker* file_worker = file_worker_alloc(false);
  93. // Input events and views are managed by file_select
  94. bool res = file_worker_file_select(
  95. file_worker,
  96. nfc_app_folder,
  97. nfc_app_extension,
  98. dev->file_name,
  99. sizeof(dev->file_name),
  100. NULL);
  101. if(res) {
  102. string_t dev_str;
  103. // Get key file path
  104. string_init_printf(dev_str, "%s/%s%s", nfc_app_folder, dev->file_name, nfc_app_extension);
  105. res = nfc_device_load_data(file_worker, dev_str, dev);
  106. if(res) {
  107. nfc_device_set_name(dev, dev->file_name);
  108. }
  109. string_clear(dev_str);
  110. }
  111. file_worker_close(file_worker);
  112. file_worker_free(file_worker);
  113. return res;
  114. }