nfc_worker.c 28 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674
  1. #include "nfc_worker_i.h"
  2. #include <furi_hal.h>
  3. #include <lib/nfc_protocols/nfc_util.h>
  4. #include <lib/nfc_protocols/emv.h>
  5. #include <lib/nfc_protocols/mifare_common.h>
  6. #include <lib/nfc_protocols/mifare_ultralight.h>
  7. #include <lib/nfc_protocols/mifare_classic.h>
  8. #include <lib/nfc_protocols/mifare_desfire.h>
  9. #include "helpers/nfc_mf_classic_dict.h"
  10. #define TAG "NfcWorker"
  11. /***************************** NFC Worker API *******************************/
  12. NfcWorker* nfc_worker_alloc() {
  13. NfcWorker* nfc_worker = malloc(sizeof(NfcWorker));
  14. // Worker thread attributes
  15. nfc_worker->thread = furi_thread_alloc();
  16. furi_thread_set_name(nfc_worker->thread, "NfcWorker");
  17. furi_thread_set_stack_size(nfc_worker->thread, 8192);
  18. furi_thread_set_callback(nfc_worker->thread, nfc_worker_task);
  19. furi_thread_set_context(nfc_worker->thread, nfc_worker);
  20. nfc_worker->callback = NULL;
  21. nfc_worker->context = NULL;
  22. nfc_worker->storage = furi_record_open("storage");
  23. // Initialize rfal
  24. while(furi_hal_nfc_is_busy()) {
  25. osDelay(10);
  26. }
  27. nfc_worker_change_state(nfc_worker, NfcWorkerStateReady);
  28. return nfc_worker;
  29. }
  30. void nfc_worker_free(NfcWorker* nfc_worker) {
  31. furi_assert(nfc_worker);
  32. furi_thread_free(nfc_worker->thread);
  33. furi_record_close("storage");
  34. free(nfc_worker);
  35. }
  36. NfcWorkerState nfc_worker_get_state(NfcWorker* nfc_worker) {
  37. return nfc_worker->state;
  38. }
  39. void nfc_worker_start(
  40. NfcWorker* nfc_worker,
  41. NfcWorkerState state,
  42. NfcDeviceData* dev_data,
  43. NfcWorkerCallback callback,
  44. void* context) {
  45. furi_assert(nfc_worker);
  46. furi_assert(dev_data);
  47. while(furi_hal_nfc_is_busy()) {
  48. osDelay(10);
  49. }
  50. nfc_worker->callback = callback;
  51. nfc_worker->context = context;
  52. nfc_worker->dev_data = dev_data;
  53. nfc_worker_change_state(nfc_worker, state);
  54. furi_thread_start(nfc_worker->thread);
  55. }
  56. void nfc_worker_stop(NfcWorker* nfc_worker) {
  57. furi_assert(nfc_worker);
  58. if(nfc_worker->state == NfcWorkerStateBroken || nfc_worker->state == NfcWorkerStateReady) {
  59. return;
  60. }
  61. furi_hal_nfc_stop();
  62. nfc_worker_change_state(nfc_worker, NfcWorkerStateStop);
  63. furi_thread_join(nfc_worker->thread);
  64. }
  65. void nfc_worker_change_state(NfcWorker* nfc_worker, NfcWorkerState state) {
  66. nfc_worker->state = state;
  67. }
  68. /***************************** NFC Worker Thread *******************************/
  69. int32_t nfc_worker_task(void* context) {
  70. NfcWorker* nfc_worker = context;
  71. furi_hal_nfc_exit_sleep();
  72. if(nfc_worker->state == NfcWorkerStateDetect) {
  73. nfc_worker_detect(nfc_worker);
  74. } else if(nfc_worker->state == NfcWorkerStateEmulate) {
  75. nfc_worker_emulate(nfc_worker);
  76. } else if(nfc_worker->state == NfcWorkerStateReadEMVApp) {
  77. nfc_worker_read_emv_app(nfc_worker);
  78. } else if(nfc_worker->state == NfcWorkerStateReadEMVData) {
  79. nfc_worker_read_emv(nfc_worker);
  80. } else if(nfc_worker->state == NfcWorkerStateEmulateApdu) {
  81. nfc_worker_emulate_apdu(nfc_worker);
  82. } else if(nfc_worker->state == NfcWorkerStateReadMifareUltralight) {
  83. nfc_worker_read_mifare_ultralight(nfc_worker);
  84. } else if(nfc_worker->state == NfcWorkerStateEmulateMifareUltralight) {
  85. nfc_worker_emulate_mifare_ul(nfc_worker);
  86. } else if(nfc_worker->state == NfcWorkerStateReadMifareClassic) {
  87. nfc_worker_mifare_classic_dict_attack(nfc_worker);
  88. } else if(nfc_worker->state == NfcWorkerStateReadMifareDesfire) {
  89. nfc_worker_read_mifare_desfire(nfc_worker);
  90. }
  91. furi_hal_nfc_sleep();
  92. nfc_worker_change_state(nfc_worker, NfcWorkerStateReady);
  93. return 0;
  94. }
  95. void nfc_worker_detect(NfcWorker* nfc_worker) {
  96. nfc_device_data_clear(nfc_worker->dev_data);
  97. NfcDeviceData* dev_data = nfc_worker->dev_data;
  98. FuriHalNfcDevData* nfc_data = &nfc_worker->dev_data->nfc_data;
  99. while(nfc_worker->state == NfcWorkerStateDetect) {
  100. if(furi_hal_nfc_detect(nfc_data, 1000)) {
  101. // Process first found device
  102. if(nfc_data->type == FuriHalNfcTypeA) {
  103. if(mf_ul_check_card_type(nfc_data->atqa[0], nfc_data->atqa[1], nfc_data->sak)) {
  104. dev_data->protocol = NfcDeviceProtocolMifareUl;
  105. } else if(mf_classic_check_card_type(
  106. nfc_data->atqa[0], nfc_data->atqa[1], nfc_data->sak)) {
  107. dev_data->protocol = NfcDeviceProtocolMifareClassic;
  108. } else if(mf_df_check_card_type(
  109. nfc_data->atqa[0], nfc_data->atqa[1], nfc_data->sak)) {
  110. dev_data->protocol = NfcDeviceProtocolMifareDesfire;
  111. } else if(nfc_data->interface == FuriHalNfcInterfaceIsoDep) {
  112. dev_data->protocol = NfcDeviceProtocolEMV;
  113. } else {
  114. dev_data->protocol = NfcDeviceProtocolUnknown;
  115. }
  116. }
  117. // Notify caller and exit
  118. if(nfc_worker->callback) {
  119. nfc_worker->callback(NfcWorkerEventSuccess, nfc_worker->context);
  120. }
  121. break;
  122. }
  123. furi_hal_nfc_sleep();
  124. osDelay(100);
  125. }
  126. }
  127. void nfc_worker_emulate(NfcWorker* nfc_worker) {
  128. FuriHalNfcTxRxContext tx_rx = {};
  129. FuriHalNfcDevData* data = &nfc_worker->dev_data->nfc_data;
  130. NfcReaderRequestData* reader_data = &nfc_worker->dev_data->reader_data;
  131. while(nfc_worker->state == NfcWorkerStateEmulate) {
  132. if(furi_hal_nfc_listen(data->uid, data->uid_len, data->atqa, data->sak, true, 100)) {
  133. if(furi_hal_nfc_tx_rx(&tx_rx, 100)) {
  134. reader_data->size = tx_rx.rx_bits / 8;
  135. if(reader_data->size > 0) {
  136. memcpy(reader_data->data, tx_rx.rx_data, reader_data->size);
  137. if(nfc_worker->callback) {
  138. nfc_worker->callback(NfcWorkerEventSuccess, nfc_worker->context);
  139. }
  140. }
  141. } else {
  142. FURI_LOG_E(TAG, "Failed to get reader commands");
  143. }
  144. }
  145. }
  146. }
  147. void nfc_worker_read_emv_app(NfcWorker* nfc_worker) {
  148. FuriHalNfcTxRxContext tx_rx = {};
  149. EmvApplication emv_app = {};
  150. NfcDeviceData* result = nfc_worker->dev_data;
  151. FuriHalNfcDevData* nfc_data = &nfc_worker->dev_data->nfc_data;
  152. nfc_device_data_clear(result);
  153. while(nfc_worker->state == NfcWorkerStateReadEMVApp) {
  154. if(furi_hal_nfc_detect(nfc_data, 1000)) {
  155. // Card was found. Check that it supports EMV
  156. if(nfc_data->interface == FuriHalNfcInterfaceIsoDep) {
  157. result->protocol = NfcDeviceProtocolEMV;
  158. if(emv_search_application(&tx_rx, &emv_app)) {
  159. // Notify caller and exit
  160. result->emv_data.aid_len = emv_app.aid_len;
  161. memcpy(result->emv_data.aid, emv_app.aid, emv_app.aid_len);
  162. if(nfc_worker->callback) {
  163. nfc_worker->callback(NfcWorkerEventSuccess, nfc_worker->context);
  164. }
  165. }
  166. } else {
  167. FURI_LOG_W(TAG, "Card doesn't support EMV");
  168. }
  169. } else {
  170. FURI_LOG_D(TAG, "Can't find any cards");
  171. }
  172. furi_hal_nfc_sleep();
  173. osDelay(20);
  174. }
  175. }
  176. void nfc_worker_read_emv(NfcWorker* nfc_worker) {
  177. FuriHalNfcTxRxContext tx_rx = {};
  178. EmvApplication emv_app = {};
  179. NfcDeviceData* result = nfc_worker->dev_data;
  180. FuriHalNfcDevData* nfc_data = &nfc_worker->dev_data->nfc_data;
  181. nfc_device_data_clear(result);
  182. while(nfc_worker->state == NfcWorkerStateReadEMVData) {
  183. if(furi_hal_nfc_detect(nfc_data, 1000)) {
  184. // Card was found. Check that it supports EMV
  185. if(nfc_data->interface == FuriHalNfcInterfaceIsoDep) {
  186. result->protocol = NfcDeviceProtocolEMV;
  187. if(emv_read_bank_card(&tx_rx, &emv_app)) {
  188. result->emv_data.number_len = emv_app.card_number_len;
  189. memcpy(
  190. result->emv_data.number, emv_app.card_number, result->emv_data.number_len);
  191. result->emv_data.aid_len = emv_app.aid_len;
  192. memcpy(result->emv_data.aid, emv_app.aid, emv_app.aid_len);
  193. if(emv_app.name_found) {
  194. memcpy(result->emv_data.name, emv_app.name, sizeof(emv_app.name));
  195. }
  196. if(emv_app.exp_month) {
  197. result->emv_data.exp_mon = emv_app.exp_month;
  198. result->emv_data.exp_year = emv_app.exp_year;
  199. }
  200. if(emv_app.country_code) {
  201. result->emv_data.country_code = emv_app.country_code;
  202. }
  203. if(emv_app.currency_code) {
  204. result->emv_data.currency_code = emv_app.currency_code;
  205. }
  206. // Notify caller and exit
  207. if(nfc_worker->callback) {
  208. nfc_worker->callback(NfcWorkerEventSuccess, nfc_worker->context);
  209. }
  210. break;
  211. }
  212. } else {
  213. FURI_LOG_W(TAG, "Card doesn't support EMV");
  214. }
  215. } else {
  216. FURI_LOG_D(TAG, "Can't find any cards");
  217. }
  218. furi_hal_nfc_sleep();
  219. osDelay(20);
  220. }
  221. }
  222. void nfc_worker_emulate_apdu(NfcWorker* nfc_worker) {
  223. FuriHalNfcTxRxContext tx_rx = {};
  224. FuriHalNfcDevData params = {
  225. .uid = {0xCF, 0x72, 0xd4, 0x40},
  226. .uid_len = 4,
  227. .atqa = {0x00, 0x04},
  228. .sak = 0x20,
  229. .type = FuriHalNfcTypeA,
  230. };
  231. while(nfc_worker->state == NfcWorkerStateEmulateApdu) {
  232. if(furi_hal_nfc_listen(params.uid, params.uid_len, params.atqa, params.sak, false, 300)) {
  233. FURI_LOG_D(TAG, "POS terminal detected");
  234. if(emv_card_emulation(&tx_rx)) {
  235. FURI_LOG_D(TAG, "EMV card emulated");
  236. }
  237. } else {
  238. FURI_LOG_D(TAG, "Can't find reader");
  239. }
  240. furi_hal_nfc_sleep();
  241. osDelay(20);
  242. }
  243. }
  244. void nfc_worker_read_mifare_ultralight(NfcWorker* nfc_worker) {
  245. FuriHalNfcTxRxContext tx_rx = {};
  246. MfUltralightReader reader = {};
  247. MfUltralightData data = {};
  248. NfcDeviceData* result = nfc_worker->dev_data;
  249. FuriHalNfcDevData* nfc_data = &nfc_worker->dev_data->nfc_data;
  250. while(nfc_worker->state == NfcWorkerStateReadMifareUltralight) {
  251. if(furi_hal_nfc_detect(nfc_data, 300)) {
  252. if(nfc_data->type == FuriHalNfcTypeA &&
  253. mf_ul_check_card_type(nfc_data->atqa[0], nfc_data->atqa[1], nfc_data->sak)) {
  254. FURI_LOG_D(TAG, "Found Mifare Ultralight tag. Start reading");
  255. if(mf_ul_read_card(&tx_rx, &reader, &data)) {
  256. result->protocol = NfcDeviceProtocolMifareUl;
  257. result->mf_ul_data = data;
  258. // Notify caller and exit
  259. if(nfc_worker->callback) {
  260. nfc_worker->callback(NfcWorkerEventSuccess, nfc_worker->context);
  261. }
  262. break;
  263. } else {
  264. FURI_LOG_D(TAG, "Failed reading Mifare Ultralight");
  265. }
  266. } else {
  267. FURI_LOG_W(TAG, "Tag is not Mifare Ultralight");
  268. }
  269. } else {
  270. FURI_LOG_D(TAG, "Can't find any tags");
  271. }
  272. furi_hal_nfc_sleep();
  273. osDelay(100);
  274. }
  275. }
  276. void nfc_worker_emulate_mifare_ul(NfcWorker* nfc_worker) {
  277. FuriHalNfcDevData* nfc_data = &nfc_worker->dev_data->nfc_data;
  278. MfUltralightEmulator emulator = {};
  279. mf_ul_prepare_emulation(&emulator, &nfc_worker->dev_data->mf_ul_data);
  280. while(nfc_worker->state == NfcWorkerStateEmulateMifareUltralight) {
  281. furi_hal_nfc_emulate_nfca(
  282. nfc_data->uid,
  283. nfc_data->uid_len,
  284. nfc_data->atqa,
  285. nfc_data->sak,
  286. mf_ul_prepare_emulation_response,
  287. &emulator,
  288. 5000);
  289. // Check if data was modified
  290. if(emulator.data_changed) {
  291. nfc_worker->dev_data->mf_ul_data = emulator.data;
  292. if(nfc_worker->callback) {
  293. nfc_worker->callback(NfcWorkerEventSuccess, nfc_worker->context);
  294. }
  295. emulator.data_changed = false;
  296. }
  297. }
  298. }
  299. void nfc_worker_mifare_classic_dict_attack(NfcWorker* nfc_worker) {
  300. furi_assert(nfc_worker->callback);
  301. FuriHalNfcTxRxContext tx_rx_ctx = {};
  302. MfClassicAuthContext auth_ctx = {};
  303. MfClassicReader reader = {};
  304. uint64_t curr_key = 0;
  305. uint16_t curr_sector = 0;
  306. uint8_t total_sectors = 0;
  307. NfcWorkerEvent event;
  308. FuriHalNfcDevData* nfc_data = &nfc_worker->dev_data->nfc_data;
  309. // Open dictionary
  310. nfc_worker->dict_stream = file_stream_alloc(nfc_worker->storage);
  311. if(!nfc_mf_classic_dict_open_file(nfc_worker->dict_stream)) {
  312. event = NfcWorkerEventNoDictFound;
  313. nfc_worker->callback(event, nfc_worker->context);
  314. nfc_mf_classic_dict_close_file(nfc_worker->dict_stream);
  315. stream_free(nfc_worker->dict_stream);
  316. return;
  317. }
  318. // Detect Mifare Classic card
  319. while(nfc_worker->state == NfcWorkerStateReadMifareClassic) {
  320. if(furi_hal_nfc_detect(nfc_data, 300)) {
  321. if(mf_classic_get_type(
  322. nfc_data->uid,
  323. nfc_data->uid_len,
  324. nfc_data->atqa[0],
  325. nfc_data->atqa[1],
  326. nfc_data->sak,
  327. &reader)) {
  328. total_sectors = mf_classic_get_total_sectors_num(&reader);
  329. if(reader.type == MfClassicType1k) {
  330. event = NfcWorkerEventDetectedClassic1k;
  331. } else {
  332. event = NfcWorkerEventDetectedClassic4k;
  333. }
  334. nfc_worker->callback(event, nfc_worker->context);
  335. break;
  336. }
  337. } else {
  338. event = NfcWorkerEventNoCardDetected;
  339. nfc_worker->callback(event, nfc_worker->context);
  340. }
  341. }
  342. if(nfc_worker->state == NfcWorkerStateReadMifareClassic) {
  343. bool card_removed_notified = false;
  344. bool card_found_notified = false;
  345. // Seek for mifare classic keys
  346. for(curr_sector = 0; curr_sector < total_sectors; curr_sector++) {
  347. FURI_LOG_I(TAG, "Sector: %d ...", curr_sector);
  348. event = NfcWorkerEventNewSector;
  349. nfc_worker->callback(event, nfc_worker->context);
  350. mf_classic_auth_init_context(&auth_ctx, reader.cuid, curr_sector);
  351. bool sector_key_found = false;
  352. while(nfc_mf_classic_dict_get_next_key(nfc_worker->dict_stream, &curr_key)) {
  353. furi_hal_nfc_sleep();
  354. if(furi_hal_nfc_activate_nfca(300, &reader.cuid)) {
  355. if(!card_found_notified) {
  356. if(reader.type == MfClassicType1k) {
  357. event = NfcWorkerEventDetectedClassic1k;
  358. } else {
  359. event = NfcWorkerEventDetectedClassic4k;
  360. }
  361. nfc_worker->callback(event, nfc_worker->context);
  362. card_found_notified = true;
  363. card_removed_notified = false;
  364. }
  365. FURI_LOG_D(
  366. TAG,
  367. "Try to auth to sector %d with key %04lx%08lx",
  368. curr_sector,
  369. (uint32_t)(curr_key >> 32),
  370. (uint32_t)curr_key);
  371. if(mf_classic_auth_attempt(&tx_rx_ctx, &auth_ctx, curr_key)) {
  372. sector_key_found = true;
  373. if((auth_ctx.key_a != MF_CLASSIC_NO_KEY) &&
  374. (auth_ctx.key_b != MF_CLASSIC_NO_KEY))
  375. break;
  376. }
  377. } else {
  378. // Notify that no tag is availalble
  379. FURI_LOG_D(TAG, "Can't find tags");
  380. if(!card_removed_notified) {
  381. event = NfcWorkerEventNoCardDetected;
  382. nfc_worker->callback(event, nfc_worker->context);
  383. card_removed_notified = true;
  384. card_found_notified = false;
  385. }
  386. }
  387. if(nfc_worker->state != NfcWorkerStateReadMifareClassic) break;
  388. osDelay(1);
  389. }
  390. if(nfc_worker->state != NfcWorkerStateReadMifareClassic) break;
  391. if(sector_key_found) {
  392. // Notify that keys were found
  393. if(auth_ctx.key_a != MF_CLASSIC_NO_KEY) {
  394. FURI_LOG_I(
  395. TAG,
  396. "Sector %d key A: %04lx%08lx",
  397. curr_sector,
  398. (uint32_t)(auth_ctx.key_a >> 32),
  399. (uint32_t)auth_ctx.key_a);
  400. event = NfcWorkerEventFoundKeyA;
  401. nfc_worker->callback(event, nfc_worker->context);
  402. }
  403. if(auth_ctx.key_b != MF_CLASSIC_NO_KEY) {
  404. FURI_LOG_I(
  405. TAG,
  406. "Sector %d key B: %04lx%08lx",
  407. curr_sector,
  408. (uint32_t)(auth_ctx.key_b >> 32),
  409. (uint32_t)auth_ctx.key_b);
  410. event = NfcWorkerEventFoundKeyB;
  411. nfc_worker->callback(event, nfc_worker->context);
  412. }
  413. // Add sectors to read sequence
  414. mf_classic_reader_add_sector(&reader, curr_sector, auth_ctx.key_a, auth_ctx.key_b);
  415. }
  416. nfc_mf_classic_dict_reset(nfc_worker->dict_stream);
  417. }
  418. }
  419. if(nfc_worker->state == NfcWorkerStateReadMifareClassic) {
  420. FURI_LOG_I(TAG, "Found keys to %d sectors. Start reading sectors", reader.sectors_to_read);
  421. uint8_t sectors_read =
  422. mf_classic_read_card(&tx_rx_ctx, &reader, &nfc_worker->dev_data->mf_classic_data);
  423. if(sectors_read) {
  424. event = NfcWorkerEventSuccess;
  425. nfc_worker->dev_data->protocol = NfcDeviceProtocolMifareClassic;
  426. FURI_LOG_I(TAG, "Successfully read %d sectors", sectors_read);
  427. } else {
  428. event = NfcWorkerEventFail;
  429. FURI_LOG_W(TAG, "Failed to read any sector");
  430. }
  431. nfc_worker->callback(event, nfc_worker->context);
  432. }
  433. nfc_mf_classic_dict_close_file(nfc_worker->dict_stream);
  434. stream_free(nfc_worker->dict_stream);
  435. }
  436. void nfc_worker_read_mifare_desfire(NfcWorker* nfc_worker) {
  437. ReturnCode err;
  438. uint8_t tx_buff[64] = {};
  439. uint16_t tx_len = 0;
  440. uint8_t rx_buff[512] = {};
  441. uint16_t rx_len;
  442. NfcDeviceData* result = nfc_worker->dev_data;
  443. nfc_device_data_clear(result);
  444. MifareDesfireData* data = &result->mf_df_data;
  445. FuriHalNfcDevData* nfc_data = &nfc_worker->dev_data->nfc_data;
  446. while(nfc_worker->state == NfcWorkerStateReadMifareDesfire) {
  447. furi_hal_nfc_sleep();
  448. if(!furi_hal_nfc_detect(nfc_data, 300)) {
  449. osDelay(100);
  450. continue;
  451. }
  452. memset(data, 0, sizeof(MifareDesfireData));
  453. if(nfc_data->type != FuriHalNfcTypeA ||
  454. !mf_df_check_card_type(nfc_data->atqa[0], nfc_data->atqa[1], nfc_data->sak)) {
  455. FURI_LOG_D(TAG, "Tag is not DESFire");
  456. osDelay(100);
  457. continue;
  458. }
  459. FURI_LOG_D(TAG, "Found DESFire tag");
  460. result->protocol = NfcDeviceProtocolMifareDesfire;
  461. // Get DESFire version
  462. tx_len = mf_df_prepare_get_version(tx_buff);
  463. err = furi_hal_nfc_exchange_full(tx_buff, tx_len, rx_buff, sizeof(rx_buff), &rx_len);
  464. if(err != ERR_NONE) {
  465. FURI_LOG_W(TAG, "Bad exchange getting version, err: %d", err);
  466. continue;
  467. }
  468. if(!mf_df_parse_get_version_response(rx_buff, rx_len, &data->version)) {
  469. FURI_LOG_W(TAG, "Bad DESFire GET_VERSION response");
  470. continue;
  471. }
  472. tx_len = mf_df_prepare_get_free_memory(tx_buff);
  473. err = furi_hal_nfc_exchange_full(tx_buff, tx_len, rx_buff, sizeof(rx_buff), &rx_len);
  474. if(err == ERR_NONE) {
  475. data->free_memory = malloc(sizeof(MifareDesfireFreeMemory));
  476. memset(data->free_memory, 0, sizeof(MifareDesfireFreeMemory));
  477. if(!mf_df_parse_get_free_memory_response(rx_buff, rx_len, data->free_memory)) {
  478. FURI_LOG_D(TAG, "Bad DESFire GET_FREE_MEMORY response (normal for pre-EV1 cards)");
  479. free(data->free_memory);
  480. data->free_memory = NULL;
  481. }
  482. }
  483. tx_len = mf_df_prepare_get_key_settings(tx_buff);
  484. err = furi_hal_nfc_exchange_full(tx_buff, tx_len, rx_buff, sizeof(rx_buff), &rx_len);
  485. if(err != ERR_NONE) {
  486. FURI_LOG_D(TAG, "Bad exchange getting key settings, err: %d", err);
  487. } else {
  488. data->master_key_settings = malloc(sizeof(MifareDesfireKeySettings));
  489. memset(data->master_key_settings, 0, sizeof(MifareDesfireKeySettings));
  490. if(!mf_df_parse_get_key_settings_response(rx_buff, rx_len, data->master_key_settings)) {
  491. FURI_LOG_W(TAG, "Bad DESFire GET_KEY_SETTINGS response");
  492. free(data->master_key_settings);
  493. data->master_key_settings = NULL;
  494. continue;
  495. }
  496. MifareDesfireKeyVersion** key_version_head =
  497. &data->master_key_settings->key_version_head;
  498. for(uint8_t key_id = 0; key_id < data->master_key_settings->max_keys; key_id++) {
  499. tx_len = mf_df_prepare_get_key_version(tx_buff, key_id);
  500. err =
  501. furi_hal_nfc_exchange_full(tx_buff, tx_len, rx_buff, sizeof(rx_buff), &rx_len);
  502. if(err != ERR_NONE) {
  503. FURI_LOG_W(TAG, "Bad exchange getting key version, err: %d", err);
  504. continue;
  505. }
  506. MifareDesfireKeyVersion* key_version = malloc(sizeof(MifareDesfireKeyVersion));
  507. memset(key_version, 0, sizeof(MifareDesfireKeyVersion));
  508. key_version->id = key_id;
  509. if(!mf_df_parse_get_key_version_response(rx_buff, rx_len, key_version)) {
  510. FURI_LOG_W(TAG, "Bad DESFire GET_KEY_VERSION response");
  511. free(key_version);
  512. continue;
  513. }
  514. *key_version_head = key_version;
  515. key_version_head = &key_version->next;
  516. }
  517. }
  518. tx_len = mf_df_prepare_get_application_ids(tx_buff);
  519. err = furi_hal_nfc_exchange_full(tx_buff, tx_len, rx_buff, sizeof(rx_buff), &rx_len);
  520. if(err != ERR_NONE) {
  521. FURI_LOG_W(TAG, "Bad exchange getting application IDs, err: %d", err);
  522. } else {
  523. if(!mf_df_parse_get_application_ids_response(rx_buff, rx_len, &data->app_head)) {
  524. FURI_LOG_W(TAG, "Bad DESFire GET_APPLICATION_IDS response");
  525. }
  526. }
  527. for(MifareDesfireApplication* app = data->app_head; app; app = app->next) {
  528. tx_len = mf_df_prepare_select_application(tx_buff, app->id);
  529. err = furi_hal_nfc_exchange_full(tx_buff, tx_len, rx_buff, sizeof(rx_buff), &rx_len);
  530. if(!mf_df_parse_select_application_response(rx_buff, rx_len)) {
  531. FURI_LOG_W(TAG, "Bad exchange selecting application, err: %d", err);
  532. continue;
  533. }
  534. tx_len = mf_df_prepare_get_key_settings(tx_buff);
  535. err = furi_hal_nfc_exchange_full(tx_buff, tx_len, rx_buff, sizeof(rx_buff), &rx_len);
  536. if(err != ERR_NONE) {
  537. FURI_LOG_W(TAG, "Bad exchange getting key settings, err: %d", err);
  538. } else {
  539. app->key_settings = malloc(sizeof(MifareDesfireKeySettings));
  540. memset(app->key_settings, 0, sizeof(MifareDesfireKeySettings));
  541. if(!mf_df_parse_get_key_settings_response(rx_buff, rx_len, app->key_settings)) {
  542. FURI_LOG_W(TAG, "Bad DESFire GET_KEY_SETTINGS response");
  543. free(app->key_settings);
  544. app->key_settings = NULL;
  545. continue;
  546. }
  547. MifareDesfireKeyVersion** key_version_head = &app->key_settings->key_version_head;
  548. for(uint8_t key_id = 0; key_id < app->key_settings->max_keys; key_id++) {
  549. tx_len = mf_df_prepare_get_key_version(tx_buff, key_id);
  550. err = furi_hal_nfc_exchange_full(
  551. tx_buff, tx_len, rx_buff, sizeof(rx_buff), &rx_len);
  552. if(err != ERR_NONE) {
  553. FURI_LOG_W(TAG, "Bad exchange getting key version, err: %d", err);
  554. continue;
  555. }
  556. MifareDesfireKeyVersion* key_version = malloc(sizeof(MifareDesfireKeyVersion));
  557. memset(key_version, 0, sizeof(MifareDesfireKeyVersion));
  558. key_version->id = key_id;
  559. if(!mf_df_parse_get_key_version_response(rx_buff, rx_len, key_version)) {
  560. FURI_LOG_W(TAG, "Bad DESFire GET_KEY_VERSION response");
  561. free(key_version);
  562. continue;
  563. }
  564. *key_version_head = key_version;
  565. key_version_head = &key_version->next;
  566. }
  567. }
  568. tx_len = mf_df_prepare_get_file_ids(tx_buff);
  569. err = furi_hal_nfc_exchange_full(tx_buff, tx_len, rx_buff, sizeof(rx_buff), &rx_len);
  570. if(err != ERR_NONE) {
  571. FURI_LOG_W(TAG, "Bad exchange getting file IDs, err: %d", err);
  572. } else {
  573. if(!mf_df_parse_get_file_ids_response(rx_buff, rx_len, &app->file_head)) {
  574. FURI_LOG_W(TAG, "Bad DESFire GET_FILE_IDS response");
  575. }
  576. }
  577. for(MifareDesfireFile* file = app->file_head; file; file = file->next) {
  578. tx_len = mf_df_prepare_get_file_settings(tx_buff, file->id);
  579. err =
  580. furi_hal_nfc_exchange_full(tx_buff, tx_len, rx_buff, sizeof(rx_buff), &rx_len);
  581. if(err != ERR_NONE) {
  582. FURI_LOG_W(TAG, "Bad exchange getting file settings, err: %d", err);
  583. continue;
  584. }
  585. if(!mf_df_parse_get_file_settings_response(rx_buff, rx_len, file)) {
  586. FURI_LOG_W(TAG, "Bad DESFire GET_FILE_SETTINGS response");
  587. continue;
  588. }
  589. switch(file->type) {
  590. case MifareDesfireFileTypeStandard:
  591. case MifareDesfireFileTypeBackup:
  592. tx_len = mf_df_prepare_read_data(tx_buff, file->id, 0, 0);
  593. break;
  594. case MifareDesfireFileTypeValue:
  595. tx_len = mf_df_prepare_get_value(tx_buff, file->id);
  596. break;
  597. case MifareDesfireFileTypeLinearRecord:
  598. case MifareDesfireFileTypeCyclicRecord:
  599. tx_len = mf_df_prepare_read_records(tx_buff, file->id, 0, 0);
  600. break;
  601. }
  602. err =
  603. furi_hal_nfc_exchange_full(tx_buff, tx_len, rx_buff, sizeof(rx_buff), &rx_len);
  604. if(err != ERR_NONE) {
  605. FURI_LOG_W(TAG, "Bad exchange reading file %d, err: %d", file->id, err);
  606. continue;
  607. }
  608. if(!mf_df_parse_read_data_response(rx_buff, rx_len, file)) {
  609. FURI_LOG_W(TAG, "Bad response reading file %d", file->id);
  610. continue;
  611. }
  612. }
  613. }
  614. // Notify caller and exit
  615. if(nfc_worker->callback) {
  616. nfc_worker->callback(NfcWorkerEventSuccess, nfc_worker->context);
  617. }
  618. break;
  619. }
  620. }