nfc_device.c 3.4 KB

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