nfc_test.c 11 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303
  1. #include <furi.h>
  2. #include <furi_hal.h>
  3. #include <storage/storage.h>
  4. #include <lib/flipper_format/flipper_format.h>
  5. #include <lib/nfc/protocols/nfca.h>
  6. #include <lib/nfc/helpers/mf_classic_dict.h>
  7. #include <lib/digital_signal/digital_signal.h>
  8. #include <lib/flipper_format/flipper_format_i.h>
  9. #include <lib/toolbox/stream/file_stream.h>
  10. #include "../minunit.h"
  11. #define TAG "NfcTest"
  12. #define NFC_TEST_RESOURCES_DIR EXT_PATH("unit_tests/nfc/")
  13. #define NFC_TEST_SIGNAL_SHORT_FILE "nfc_nfca_signal_short.nfc"
  14. #define NFC_TEST_SIGNAL_LONG_FILE "nfc_nfca_signal_long.nfc"
  15. #define NFC_TEST_DICT_PATH EXT_PATH("unit_tests/mf_classic_dict.nfc")
  16. static const char* nfc_test_file_type = "Flipper NFC test";
  17. static const uint32_t nfc_test_file_version = 1;
  18. #define NFC_TEST_DATA_MAX_LEN 18
  19. #define NFC_TETS_TIMINGS_MAX_LEN 1350
  20. typedef struct {
  21. Storage* storage;
  22. NfcaSignal* signal;
  23. uint32_t test_data_len;
  24. uint8_t test_data[NFC_TEST_DATA_MAX_LEN];
  25. uint32_t test_timings_len;
  26. uint32_t test_timings[NFC_TETS_TIMINGS_MAX_LEN];
  27. } NfcTest;
  28. static NfcTest* nfc_test = NULL;
  29. static void nfc_test_alloc() {
  30. nfc_test = malloc(sizeof(NfcTest));
  31. nfc_test->signal = nfca_signal_alloc();
  32. nfc_test->storage = furi_record_open(RECORD_STORAGE);
  33. }
  34. static void nfc_test_free() {
  35. furi_assert(nfc_test);
  36. furi_record_close(RECORD_STORAGE);
  37. nfca_signal_free(nfc_test->signal);
  38. free(nfc_test);
  39. nfc_test = NULL;
  40. }
  41. static bool nfc_test_read_signal_from_file(const char* file_name) {
  42. bool success = false;
  43. FlipperFormat* file = flipper_format_file_alloc(nfc_test->storage);
  44. FuriString* file_type;
  45. file_type = furi_string_alloc();
  46. uint32_t file_version = 0;
  47. do {
  48. if(!flipper_format_file_open_existing(file, file_name)) break;
  49. if(!flipper_format_read_header(file, file_type, &file_version)) break;
  50. if(furi_string_cmp_str(file_type, nfc_test_file_type) ||
  51. file_version != nfc_test_file_version)
  52. break;
  53. if(!flipper_format_read_uint32(file, "Data length", &nfc_test->test_data_len, 1)) break;
  54. if(nfc_test->test_data_len > NFC_TEST_DATA_MAX_LEN) break;
  55. if(!flipper_format_read_hex(
  56. file, "Plain data", nfc_test->test_data, nfc_test->test_data_len))
  57. break;
  58. if(!flipper_format_read_uint32(file, "Timings length", &nfc_test->test_timings_len, 1))
  59. break;
  60. if(nfc_test->test_timings_len > NFC_TETS_TIMINGS_MAX_LEN) break;
  61. if(!flipper_format_read_uint32(
  62. file, "Timings", nfc_test->test_timings, nfc_test->test_timings_len))
  63. break;
  64. success = true;
  65. } while(false);
  66. furi_string_free(file_type);
  67. flipper_format_free(file);
  68. return success;
  69. }
  70. static bool nfc_test_digital_signal_test_encode(
  71. const char* file_name,
  72. uint32_t encode_max_time,
  73. uint32_t timing_tolerance,
  74. uint32_t timings_sum_tolerance) {
  75. furi_assert(nfc_test);
  76. bool success = false;
  77. uint32_t time = 0;
  78. uint32_t dut_timings_sum = 0;
  79. uint32_t ref_timings_sum = 0;
  80. uint8_t parity[10] = {};
  81. do {
  82. // Read test data
  83. if(!nfc_test_read_signal_from_file(file_name)) break;
  84. // Encode signal
  85. FURI_CRITICAL_ENTER();
  86. time = DWT->CYCCNT;
  87. nfca_signal_encode(
  88. nfc_test->signal, nfc_test->test_data, nfc_test->test_data_len * 8, parity);
  89. digital_signal_prepare_arr(nfc_test->signal->tx_signal);
  90. time = (DWT->CYCCNT - time) / furi_hal_cortex_instructions_per_microsecond();
  91. FURI_CRITICAL_EXIT();
  92. // Check timings
  93. if(time > encode_max_time) {
  94. FURI_LOG_E(
  95. TAG, "Encoding time: %ld us while accepted value: %ld us", time, encode_max_time);
  96. break;
  97. }
  98. // Check data
  99. if(nfc_test->signal->tx_signal->edge_cnt != nfc_test->test_timings_len) {
  100. FURI_LOG_E(TAG, "Not equal timings buffers length");
  101. break;
  102. }
  103. uint32_t timings_diff = 0;
  104. uint32_t* ref = nfc_test->test_timings;
  105. uint32_t* dut = nfc_test->signal->tx_signal->reload_reg_buff;
  106. bool timing_check_success = true;
  107. for(size_t i = 0; i < nfc_test->test_timings_len; i++) {
  108. timings_diff = dut[i] > ref[i] ? dut[i] - ref[i] : ref[i] - dut[i];
  109. dut_timings_sum += dut[i];
  110. ref_timings_sum += ref[i];
  111. if(timings_diff > timing_tolerance) {
  112. FURI_LOG_E(
  113. TAG, "Too big differece in %d timings. Ref: %ld, DUT: %ld", i, ref[i], dut[i]);
  114. timing_check_success = false;
  115. break;
  116. }
  117. }
  118. if(!timing_check_success) break;
  119. uint32_t sum_diff = dut_timings_sum > ref_timings_sum ? dut_timings_sum - ref_timings_sum :
  120. ref_timings_sum - dut_timings_sum;
  121. if(sum_diff > timings_sum_tolerance) {
  122. FURI_LOG_E(
  123. TAG,
  124. "Too big difference in timings sum. Ref: %ld, DUT: %ld",
  125. ref_timings_sum,
  126. dut_timings_sum);
  127. break;
  128. }
  129. FURI_LOG_I(TAG, "Encoding time: %ld us. Acceptable time: %ld us", time, encode_max_time);
  130. FURI_LOG_I(
  131. TAG,
  132. "Timings sum difference: %ld [1/64MHZ]. Acceptable difference: %ld [1/64MHz]",
  133. sum_diff,
  134. timings_sum_tolerance);
  135. success = true;
  136. } while(false);
  137. return success;
  138. }
  139. MU_TEST(nfc_digital_signal_test) {
  140. mu_assert(
  141. nfc_test_digital_signal_test_encode(
  142. NFC_TEST_RESOURCES_DIR NFC_TEST_SIGNAL_SHORT_FILE, 500, 1, 37),
  143. "NFC short digital signal test failed\r\n");
  144. mu_assert(
  145. nfc_test_digital_signal_test_encode(
  146. NFC_TEST_RESOURCES_DIR NFC_TEST_SIGNAL_LONG_FILE, 2000, 1, 37),
  147. "NFC long digital signal test failed\r\n");
  148. }
  149. MU_TEST(mf_classic_dict_test) {
  150. MfClassicDict* instance = NULL;
  151. uint64_t key = 0;
  152. FuriString* temp_str;
  153. temp_str = furi_string_alloc();
  154. instance = mf_classic_dict_alloc(MfClassicDictTypeUnitTest);
  155. mu_assert(instance != NULL, "mf_classic_dict_alloc\r\n");
  156. mu_assert(
  157. mf_classic_dict_get_total_keys(instance) == 0,
  158. "mf_classic_dict_get_total_keys == 0 assert failed\r\n");
  159. furi_string_set(temp_str, "2196FAD8115B");
  160. mu_assert(
  161. mf_classic_dict_add_key_str(instance, temp_str),
  162. "mf_classic_dict_add_key == true assert failed\r\n");
  163. mu_assert(
  164. mf_classic_dict_get_total_keys(instance) == 1,
  165. "mf_classic_dict_get_total_keys == 1 assert failed\r\n");
  166. mu_assert(mf_classic_dict_rewind(instance), "mf_classic_dict_rewind == 1 assert failed\r\n");
  167. mu_assert(
  168. mf_classic_dict_get_key_at_index_str(instance, temp_str, 0),
  169. "mf_classic_dict_get_key_at_index_str == true assert failed\r\n");
  170. mu_assert(
  171. furi_string_cmp(temp_str, "2196FAD8115B") == 0,
  172. "string_cmp(temp_str, \"2196FAD8115B\") == 0 assert failed\r\n");
  173. mu_assert(mf_classic_dict_rewind(instance), "mf_classic_dict_rewind == 1 assert failed\r\n");
  174. mu_assert(
  175. mf_classic_dict_get_key_at_index(instance, &key, 0),
  176. "mf_classic_dict_get_key_at_index == true assert failed\r\n");
  177. mu_assert(key == 0x2196FAD8115B, "key == 0x2196FAD8115B assert failed\r\n");
  178. mu_assert(mf_classic_dict_rewind(instance), "mf_classic_dict_rewind == 1 assert failed\r\n");
  179. mu_assert(
  180. mf_classic_dict_delete_index(instance, 0),
  181. "mf_classic_dict_delete_index == true assert failed\r\n");
  182. mf_classic_dict_free(instance);
  183. furi_string_free(temp_str);
  184. }
  185. MU_TEST(mf_classic_dict_load_test) {
  186. Storage* storage = furi_record_open(RECORD_STORAGE);
  187. mu_assert(storage != NULL, "storage != NULL assert failed\r\n");
  188. // Delete unit test dict file if exists
  189. if(storage_file_exists(storage, NFC_TEST_DICT_PATH)) {
  190. mu_assert(
  191. storage_simply_remove(storage, NFC_TEST_DICT_PATH),
  192. "remove == true assert failed\r\n");
  193. }
  194. // Create unit test dict file
  195. Stream* file_stream = file_stream_alloc(storage);
  196. mu_assert(file_stream != NULL, "file_stream != NULL assert failed\r\n");
  197. mu_assert(
  198. file_stream_open(file_stream, NFC_TEST_DICT_PATH, FSAM_WRITE, FSOM_OPEN_ALWAYS),
  199. "file_stream_open == true assert failed\r\n");
  200. // Write unit test dict file
  201. char key_str[] = "a0a1a2a3a4a5";
  202. mu_assert(
  203. stream_write_cstring(file_stream, key_str) == strlen(key_str),
  204. "write == true assert failed\r\n");
  205. // Close unit test dict file
  206. mu_assert(file_stream_close(file_stream), "file_stream_close == true assert failed\r\n");
  207. // Load unit test dict file
  208. MfClassicDict* instance = NULL;
  209. instance = mf_classic_dict_alloc(MfClassicDictTypeUnitTest);
  210. mu_assert(instance != NULL, "mf_classic_dict_alloc\r\n");
  211. uint32_t total_keys = mf_classic_dict_get_total_keys(instance);
  212. mu_assert(total_keys == 1, "total_keys == 1 assert failed\r\n");
  213. // Read key
  214. uint64_t key_ref = 0xa0a1a2a3a4a5;
  215. uint64_t key_dut = 0;
  216. FuriString* temp_str = furi_string_alloc();
  217. mu_assert(
  218. mf_classic_dict_get_next_key_str(instance, temp_str),
  219. "get_next_key_str == true assert failed\r\n");
  220. mu_assert(furi_string_cmp_str(temp_str, key_str) == 0, "invalid key loaded\r\n");
  221. mu_assert(mf_classic_dict_rewind(instance), "mf_classic_dict_rewind == 1 assert failed\r\n");
  222. mu_assert(
  223. mf_classic_dict_get_next_key(instance, &key_dut),
  224. "get_next_key == true assert failed\r\n");
  225. mu_assert(key_dut == key_ref, "invalid key loaded\r\n");
  226. furi_string_free(temp_str);
  227. mf_classic_dict_free(instance);
  228. // Check that MfClassicDict added new line to the end of the file
  229. mu_assert(
  230. file_stream_open(file_stream, NFC_TEST_DICT_PATH, FSAM_READ, FSOM_OPEN_EXISTING),
  231. "file_stream_open == true assert failed\r\n");
  232. mu_assert(stream_seek(file_stream, -1, StreamOffsetFromEnd), "seek == true assert failed\r\n");
  233. uint8_t last_char = 0;
  234. mu_assert(stream_read(file_stream, &last_char, 1) == 1, "read == true assert failed\r\n");
  235. mu_assert(last_char == '\n', "last_char == '\\n' assert failed\r\n");
  236. mu_assert(file_stream_close(file_stream), "file_stream_close == true assert failed\r\n");
  237. // Delete unit test dict file
  238. mu_assert(
  239. storage_simply_remove(storage, NFC_TEST_DICT_PATH), "remove == true assert failed\r\n");
  240. stream_free(file_stream);
  241. furi_record_close(RECORD_STORAGE);
  242. }
  243. MU_TEST_SUITE(nfc) {
  244. nfc_test_alloc();
  245. MU_RUN_TEST(nfc_digital_signal_test);
  246. MU_RUN_TEST(mf_classic_dict_test);
  247. MU_RUN_TEST(mf_classic_dict_load_test);
  248. nfc_test_free();
  249. }
  250. int run_minunit_test_nfc() {
  251. MU_RUN_SUITE(nfc);
  252. return MU_EXIT_CODE;
  253. }