passy_reader.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587
  1. #include "passy_reader.h"
  2. #define ASN_EMIT_DEBUG 0
  3. #include <lib/asn1/COM.h>
  4. #define TAG "PassyReader"
  5. #define PASSY_READER_DG1_CHUNK_SIZE 0x20
  6. #define PASSY_READER_DG2_CHUNK_SIZE 0x20
  7. #define PASSY_DG2_LOOKAHEAD 120
  8. static uint8_t passport_aid[] = {0xA0, 0x00, 0x00, 0x02, 0x47, 0x10, 0x01};
  9. static uint8_t select_header[] = {0x00, 0xA4, 0x04, 0x0C};
  10. static uint8_t get_challenge[] = {0x00, 0x84, 0x00, 0x00, 0x08};
  11. static uint8_t SW_success[] = {0x90, 0x00};
  12. static const uint8_t jpeg_header[4] = {0xFF, 0xD8, 0xFF, 0xE0};
  13. static const uint8_t jpeg2k_header[6] = {0x00, 0x00, 0x00, 0x0C, 0x6A, 0x50};
  14. static const uint8_t jpeg2k_cs_header[4] = {0xFF, 0x4F, 0xFF, 0x51};
  15. size_t asn1_length(uint8_t data[3]) {
  16. if(data[0] <= 0x7F) {
  17. return data[0];
  18. } else if(data[0] == 0x81) {
  19. return data[1];
  20. } else if(data[0] == 0x82) {
  21. return (data[1] << 8) | data[2];
  22. }
  23. return 0;
  24. }
  25. size_t asn1_length_length(uint8_t data[3]) {
  26. if(data[0] <= 0x7F) {
  27. return 1;
  28. } else if(data[0] == 0x81) {
  29. return 2;
  30. } else if(data[0] == 0x82) {
  31. return 3;
  32. }
  33. return 0;
  34. }
  35. PassyReader* passy_reader_alloc(Passy* passy) {
  36. PassyReader* passy_reader = malloc(sizeof(PassyReader));
  37. memset(passy_reader, 0, sizeof(PassyReader));
  38. furi_assert(passy);
  39. passy_reader->passy = passy;
  40. passy_reader->DG1 = passy->DG1;
  41. passy_reader->COM = passy->COM;
  42. passy_reader->dg_header = passy->dg_header;
  43. passy_reader->tx_buffer = bit_buffer_alloc(PASSY_READER_MAX_BUFFER_SIZE);
  44. passy_reader->rx_buffer = bit_buffer_alloc(PASSY_READER_MAX_BUFFER_SIZE);
  45. char passport_number[11];
  46. memset(passport_number, 0, sizeof(passport_number));
  47. memcpy(passport_number, passy->passport_number, strlen(passy->passport_number));
  48. passport_number[strlen(passy->passport_number)] = passy_checksum(passy->passport_number);
  49. FURI_LOG_I(TAG, "Passport number: %s", passport_number);
  50. char date_of_birth[8];
  51. memset(date_of_birth, 0, sizeof(date_of_birth));
  52. memcpy(date_of_birth, passy->date_of_birth, strlen(passy->date_of_birth));
  53. date_of_birth[strlen(passy->date_of_birth)] = passy_checksum(passy->date_of_birth);
  54. FURI_LOG_I(TAG, "Date of birth: %s", date_of_birth);
  55. char date_of_expiry[8];
  56. memset(date_of_expiry, 0, sizeof(date_of_expiry));
  57. memcpy(date_of_expiry, passy->date_of_expiry, strlen(passy->date_of_expiry));
  58. date_of_expiry[strlen(passy->date_of_expiry)] = passy_checksum(passy->date_of_expiry);
  59. FURI_LOG_I(TAG, "Date of expiry: %s", date_of_expiry);
  60. passy_reader->secure_messaging = secure_messaging_alloc(
  61. (uint8_t*)passport_number, (uint8_t*)date_of_birth, (uint8_t*)date_of_expiry);
  62. return passy_reader;
  63. }
  64. void passy_reader_free(PassyReader* passy_reader) {
  65. furi_assert(passy_reader);
  66. bit_buffer_free(passy_reader->tx_buffer);
  67. bit_buffer_free(passy_reader->rx_buffer);
  68. if(passy_reader->secure_messaging) {
  69. secure_messaging_free(passy_reader->secure_messaging);
  70. }
  71. free(passy_reader);
  72. }
  73. NfcCommand passy_reader_send(PassyReader* passy_reader) {
  74. NfcCommand ret = NfcCommandContinue;
  75. Passy* passy = passy_reader->passy;
  76. BitBuffer* tx_buffer = passy_reader->tx_buffer;
  77. BitBuffer* rx_buffer = passy_reader->rx_buffer;
  78. if(strcmp(passy->proto, "4a") == 0) {
  79. Iso14443_4aPoller* iso14443_4a_poller = passy_reader->iso14443_4a_poller;
  80. Iso14443_4aError error;
  81. passy_log_bitbuffer(TAG, "NFC transmit", tx_buffer);
  82. error = iso14443_4a_poller_send_block(iso14443_4a_poller, tx_buffer, rx_buffer);
  83. if(error != Iso14443_4aErrorNone) {
  84. FURI_LOG_W(TAG, "iso14443_4a_poller_send_block error %d", error);
  85. return NfcCommandStop;
  86. }
  87. } else if(strcmp(passy->proto, "4b") == 0) {
  88. Iso14443_4bPoller* iso14443_4b_poller = passy_reader->iso14443_4b_poller;
  89. Iso14443_4bError error;
  90. passy_log_bitbuffer(TAG, "NFC transmit", tx_buffer);
  91. error = iso14443_4b_poller_send_block(iso14443_4b_poller, tx_buffer, rx_buffer);
  92. if(error != Iso14443_4bErrorNone) {
  93. FURI_LOG_W(TAG, "iso14443_4b_poller_send_block error %d", error);
  94. return NfcCommandStop;
  95. }
  96. } else {
  97. FURI_LOG_W(TAG, "Unknown protocol %s", passy->proto);
  98. return NfcCommandStop;
  99. }
  100. bit_buffer_reset(tx_buffer);
  101. passy_log_bitbuffer(TAG, "NFC response", rx_buffer);
  102. // Check SW
  103. size_t length = bit_buffer_get_size_bytes(rx_buffer);
  104. const uint8_t* data = bit_buffer_get_data(rx_buffer);
  105. if(length < 2) {
  106. FURI_LOG_W(TAG, "Invalid response length %d", length);
  107. return NfcCommandStop;
  108. }
  109. passy_reader->last_sw = (data[length - 2] << 8) | data[length - 1];
  110. if(memcmp(data + length - 2, SW_success, sizeof(SW_success)) != 0) {
  111. FURI_LOG_W(TAG, "Invalid SW %02x %02x", data[length - 2], data[length - 1]);
  112. return NfcCommandStop;
  113. }
  114. return ret;
  115. }
  116. NfcCommand passy_reader_select_application(PassyReader* passy_reader) {
  117. NfcCommand ret = NfcCommandContinue;
  118. BitBuffer* tx_buffer = passy_reader->tx_buffer;
  119. bit_buffer_append_bytes(tx_buffer, select_header, sizeof(select_header));
  120. bit_buffer_append_byte(tx_buffer, sizeof(passport_aid));
  121. bit_buffer_append_bytes(tx_buffer, passport_aid, sizeof(passport_aid));
  122. ret = passy_reader_send(passy_reader);
  123. if(ret != NfcCommandContinue) {
  124. return ret;
  125. }
  126. return ret;
  127. }
  128. NfcCommand passy_reader_get_challenge(PassyReader* passy_reader) {
  129. NfcCommand ret = NfcCommandContinue;
  130. bit_buffer_append_bytes(passy_reader->tx_buffer, get_challenge, sizeof(get_challenge));
  131. ret = passy_reader_send(passy_reader);
  132. if(ret != NfcCommandContinue) {
  133. return ret;
  134. }
  135. const uint8_t* data = bit_buffer_get_data(passy_reader->rx_buffer);
  136. SecureMessaging* secure_messaging = passy_reader->secure_messaging;
  137. const uint8_t* rnd_icc = data;
  138. memcpy(secure_messaging->rndICC, rnd_icc, 8);
  139. return ret;
  140. }
  141. NfcCommand passy_reader_authenticate(PassyReader* passy_reader) {
  142. NfcCommand ret = NfcCommandContinue;
  143. BitBuffer* tx_buffer = passy_reader->tx_buffer;
  144. // TODO: move into secure_messaging
  145. SecureMessaging* secure_messaging = passy_reader->secure_messaging;
  146. uint8_t S[32];
  147. memset(S, 0, sizeof(S));
  148. uint8_t eifd[32];
  149. memcpy(S, secure_messaging->rndIFD, sizeof(secure_messaging->rndIFD));
  150. memcpy(
  151. S + sizeof(secure_messaging->rndIFD),
  152. secure_messaging->rndICC,
  153. sizeof(secure_messaging->rndICC));
  154. memcpy(
  155. S + sizeof(secure_messaging->rndIFD) + sizeof(secure_messaging->rndICC),
  156. secure_messaging->Kifd,
  157. sizeof(secure_messaging->Kifd));
  158. uint8_t iv[8];
  159. memset(iv, 0, sizeof(iv));
  160. mbedtls_des3_context ctx;
  161. mbedtls_des3_init(&ctx);
  162. mbedtls_des3_set2key_enc(&ctx, secure_messaging->KENC);
  163. mbedtls_des3_crypt_cbc(&ctx, MBEDTLS_DES_ENCRYPT, sizeof(S), iv, S, eifd);
  164. mbedtls_des3_free(&ctx);
  165. passy_log_buffer(TAG, "S", S, sizeof(S));
  166. passy_log_buffer(TAG, "eifd", eifd, sizeof(eifd));
  167. uint8_t mifd[8];
  168. passy_mac(secure_messaging->KMAC, eifd, sizeof(eifd), mifd, false);
  169. passy_log_buffer(TAG, "mifd", mifd, sizeof(mifd));
  170. uint8_t authenticate_header[] = {0x00, 0x82, 0x00, 0x00};
  171. bit_buffer_append_bytes(tx_buffer, authenticate_header, sizeof(authenticate_header));
  172. bit_buffer_append_byte(tx_buffer, sizeof(eifd) + sizeof(mifd));
  173. bit_buffer_append_bytes(tx_buffer, eifd, sizeof(eifd));
  174. bit_buffer_append_bytes(tx_buffer, mifd, sizeof(mifd));
  175. bit_buffer_append_byte(tx_buffer, 0); // Le
  176. ret = passy_reader_send(passy_reader);
  177. if(ret != NfcCommandContinue) {
  178. return ret;
  179. }
  180. const uint8_t* data = bit_buffer_get_data(passy_reader->rx_buffer);
  181. size_t length = bit_buffer_get_size_bytes(passy_reader->rx_buffer);
  182. const uint8_t* mac = data + length - 2 - 8;
  183. uint8_t calculated_mac[8];
  184. passy_mac(secure_messaging->KMAC, (uint8_t*)data, length - 8 - 2, calculated_mac, false);
  185. if(memcmp(mac, calculated_mac, sizeof(calculated_mac)) != 0) {
  186. FURI_LOG_W(TAG, "Invalid MAC");
  187. return NfcCommandStop;
  188. }
  189. uint8_t decrypted[32];
  190. do {
  191. uint8_t iv[8];
  192. memset(iv, 0, sizeof(iv));
  193. mbedtls_des3_context ctx;
  194. mbedtls_des3_init(&ctx);
  195. mbedtls_des3_set2key_dec(&ctx, secure_messaging->KENC);
  196. mbedtls_des3_crypt_cbc(&ctx, MBEDTLS_DES_DECRYPT, length - 2 - 8, iv, data, decrypted);
  197. mbedtls_des3_free(&ctx);
  198. } while(false);
  199. passy_log_buffer(TAG, "decrypted", decrypted, sizeof(decrypted));
  200. uint8_t* rnd_icc = decrypted;
  201. uint8_t* rnd_ifd = decrypted + 8;
  202. uint8_t* Kicc = decrypted + 16;
  203. if(memcmp(rnd_icc, secure_messaging->rndICC, sizeof(secure_messaging->rndICC)) != 0) {
  204. FURI_LOG_W(TAG, "Invalid rndICC");
  205. return NfcCommandStop;
  206. }
  207. memcpy(secure_messaging->Kicc, Kicc, sizeof(secure_messaging->Kicc));
  208. memcpy(secure_messaging->SSC + 0, rnd_icc + 4, 4);
  209. memcpy(secure_messaging->SSC + 4, rnd_ifd + 4, 4);
  210. return ret;
  211. }
  212. NfcCommand passy_reader_select_file(PassyReader* passy_reader, uint16_t file_id) {
  213. NfcCommand ret = NfcCommandContinue;
  214. uint8_t select_0101[] = {0x00, 0xa4, 0x02, 0x0c, 0x02, 0x00, 0x00};
  215. select_0101[5] = (file_id >> 8) & 0xFF;
  216. select_0101[6] = file_id & 0xFF;
  217. secure_messaging_wrap_apdu(
  218. passy_reader->secure_messaging, select_0101, sizeof(select_0101), passy_reader->tx_buffer);
  219. ret = passy_reader_send(passy_reader);
  220. if(ret != NfcCommandContinue) {
  221. return ret;
  222. }
  223. secure_messaging_unwrap_rapdu(passy_reader->secure_messaging, passy_reader->rx_buffer);
  224. passy_log_bitbuffer(TAG, "NFC response (decrypted)", passy_reader->rx_buffer);
  225. return ret;
  226. }
  227. NfcCommand passy_reader_read_binary(
  228. PassyReader* passy_reader,
  229. uint16_t offset,
  230. uint8_t Le,
  231. uint8_t* output_buffer) {
  232. NfcCommand ret = NfcCommandContinue;
  233. if(offset & 0x8000) {
  234. FURI_LOG_W(TAG, "Invalid offset %04x", offset);
  235. }
  236. uint8_t read_binary[] = {0x00, 0xB0, (offset >> 8) & 0xff, (offset >> 0) & 0xff, Le};
  237. secure_messaging_wrap_apdu(
  238. passy_reader->secure_messaging, read_binary, sizeof(read_binary), passy_reader->tx_buffer);
  239. ret = passy_reader_send(passy_reader);
  240. if(ret != NfcCommandContinue) {
  241. return ret;
  242. }
  243. secure_messaging_unwrap_rapdu(passy_reader->secure_messaging, passy_reader->rx_buffer);
  244. passy_log_bitbuffer(TAG, "NFC response (decrypted)", passy_reader->rx_buffer);
  245. const uint8_t* decrypted_data = bit_buffer_get_data(passy_reader->rx_buffer);
  246. memcpy(output_buffer, decrypted_data, Le);
  247. return ret;
  248. }
  249. NfcCommand passy_reader_read_com(PassyReader* passy_reader) {
  250. NfcCommand ret = NfcCommandContinue;
  251. Passy* passy = passy_reader->passy;
  252. bit_buffer_reset(passy_reader->COM);
  253. uint8_t header[4];
  254. ret = passy_reader_read_binary(passy_reader, 0x00, sizeof(header), header);
  255. if(ret != NfcCommandContinue) {
  256. view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
  257. return ret;
  258. }
  259. size_t body_size = 1 + asn1_length_length(header + 1) + asn1_length(header + 1);
  260. uint8_t body_offset = sizeof(header);
  261. bit_buffer_append_bytes(passy_reader->COM, header, sizeof(header));
  262. do {
  263. view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderReading);
  264. uint8_t chunk[PASSY_READER_DG1_CHUNK_SIZE];
  265. uint8_t Le = MIN(sizeof(chunk), (size_t)(body_size - body_offset));
  266. ret = passy_reader_read_binary(passy_reader, body_offset, Le, chunk);
  267. if(ret != NfcCommandContinue) {
  268. view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
  269. break;
  270. }
  271. bit_buffer_append_bytes(passy_reader->COM, chunk, Le);
  272. body_offset += Le;
  273. } while(body_offset < body_size);
  274. return ret;
  275. }
  276. NfcCommand passy_reader_read_dg1(PassyReader* passy_reader) {
  277. NfcCommand ret = NfcCommandContinue;
  278. Passy* passy = passy_reader->passy;
  279. bit_buffer_reset(passy->DG1);
  280. uint8_t header[4];
  281. ret = passy_reader_read_binary(passy_reader, 0x00, sizeof(header), header);
  282. if(ret != NfcCommandContinue) {
  283. view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
  284. return ret;
  285. }
  286. size_t body_size = 1 + asn1_length_length(header + 1) + asn1_length(header + 1);
  287. uint8_t body_offset = sizeof(header);
  288. bit_buffer_append_bytes(passy_reader->DG1, header, sizeof(header));
  289. do {
  290. view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderReading);
  291. uint8_t chunk[PASSY_READER_DG1_CHUNK_SIZE];
  292. uint8_t Le = MIN(sizeof(chunk), (size_t)(body_size - body_offset));
  293. ret = passy_reader_read_binary(passy_reader, body_offset, Le, chunk);
  294. if(ret != NfcCommandContinue) {
  295. view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
  296. break;
  297. }
  298. bit_buffer_append_bytes(passy_reader->DG1, chunk, Le);
  299. body_offset += Le;
  300. } while(body_offset < body_size);
  301. passy_log_bitbuffer(TAG, "DG1", passy_reader->DG1);
  302. return ret;
  303. }
  304. NfcCommand passy_reader_read_dg2_or_dg7(PassyReader* passy_reader) {
  305. NfcCommand ret = NfcCommandContinue;
  306. Passy* passy = passy_reader->passy;
  307. uint8_t header[PASSY_DG2_LOOKAHEAD];
  308. ret = passy_reader_read_binary(passy_reader, 0x00, sizeof(header) / 2, header);
  309. if(ret != NfcCommandContinue) {
  310. view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
  311. return ret;
  312. }
  313. // Issue with reading whole 120 bytes at once, so we read 60 bytes and then
  314. ret = passy_reader_read_binary(
  315. passy_reader, sizeof(header) / 2, sizeof(header) / 2, header + sizeof(header) / 2);
  316. if(ret != NfcCommandContinue) {
  317. view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
  318. return ret;
  319. }
  320. view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderReading);
  321. size_t body_size = 1 + asn1_length_length(header + 1) + asn1_length(header + 1);
  322. FURI_LOG_I(TAG, "%s length: %d", passy->read_type == PassyReadDG2 ? "DG2" : "DG7", body_size);
  323. void* jpeg = memmem(header, sizeof(header), jpeg_header, sizeof(jpeg_header));
  324. void* jpeg2k = memmem(header, sizeof(header), jpeg2k_header, sizeof(jpeg2k_header));
  325. void* jpeg2k_cs = memmem(header, sizeof(header), jpeg2k_cs_header, sizeof(jpeg2k_cs_header));
  326. FuriString* path = furi_string_alloc();
  327. uint8_t start = 0;
  328. const char* dg_type = passy->read_type == PassyReadDG2 ? "DG2" : "DG7";
  329. char* dg_ext = ".bin";
  330. if(jpeg) {
  331. dg_ext = ".jpeg";
  332. start = (uint8_t*)jpeg - header;
  333. } else if(jpeg2k) {
  334. dg_ext = ".jp2";
  335. start = (uint8_t*)jpeg2k - header;
  336. } else if(jpeg2k_cs) {
  337. dg_ext = ".jpc";
  338. start = (uint8_t*)jpeg2k_cs - header;
  339. } else {
  340. furi_string_printf(path, "%s/%s%s", STORAGE_APP_DATA_PATH_PREFIX, dg_type, ".bin");
  341. start = 0;
  342. passy_log_buffer(TAG, "header", header, sizeof(header));
  343. }
  344. furi_string_printf(
  345. path, "%s/%s%s", STORAGE_APP_DATA_PATH_PREFIX, dg_type, dg_ext);
  346. FURI_LOG_I(TAG, "Writing offset %d to %s", start, furi_string_get_cstr(path));
  347. Storage* storage = furi_record_open(RECORD_STORAGE);
  348. Stream* stream = file_stream_alloc(storage);
  349. file_stream_open(stream, furi_string_get_cstr(path), FSAM_WRITE, FSOM_OPEN_ALWAYS);
  350. uint8_t chunk[PASSY_READER_DG2_CHUNK_SIZE];
  351. passy->offset = start;
  352. passy->bytes_total = body_size;
  353. do {
  354. memset(chunk, 0, sizeof(chunk));
  355. uint8_t Le = MIN(sizeof(chunk), (size_t)(body_size - passy->offset));
  356. ret = passy_reader_read_binary(passy_reader, passy->offset, Le, chunk);
  357. if(ret != NfcCommandContinue) {
  358. view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
  359. break;
  360. }
  361. passy->offset += Le;
  362. // passy_log_buffer(TAG, "chunk", chunk, sizeof(chunk));
  363. stream_write(stream, chunk, Le);
  364. view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderReading);
  365. } while(passy->offset < body_size);
  366. file_stream_close(stream);
  367. furi_record_close(RECORD_STORAGE);
  368. furi_string_free(path);
  369. return ret;
  370. }
  371. NfcCommand passy_reader_state_machine(PassyReader* passy_reader) {
  372. furi_assert(passy_reader);
  373. Passy* passy = passy_reader->passy;
  374. NfcCommand ret = NfcCommandContinue;
  375. do {
  376. ret = passy_reader_select_application(passy_reader);
  377. if(ret != NfcCommandContinue) {
  378. view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
  379. break;
  380. }
  381. ret = passy_reader_get_challenge(passy_reader);
  382. if(ret != NfcCommandContinue) {
  383. view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
  384. break;
  385. }
  386. ret = passy_reader_authenticate(passy_reader);
  387. if(ret != NfcCommandContinue) {
  388. view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
  389. break;
  390. }
  391. FURI_LOG_I(TAG, "Mututal authentication success");
  392. secure_messaging_calculate_session_keys(passy_reader->secure_messaging);
  393. view_dispatcher_send_custom_event(
  394. passy->view_dispatcher, PassyCustomEventReaderAuthenticated);
  395. ret = passy_reader_select_file(passy_reader, passy->read_type);
  396. if(ret != NfcCommandContinue) {
  397. view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
  398. break;
  399. }
  400. if(passy->read_type == PassyReadCOM) {
  401. ret = passy_reader_read_com(passy_reader);
  402. } else if(passy->read_type == PassyReadDG1) {
  403. ret = passy_reader_read_dg1(passy_reader);
  404. } else if(passy->read_type == PassyReadDG2) {
  405. ret = passy_reader_read_dg2_or_dg7(passy_reader);
  406. } else if(passy->read_type == PassyReadDG7) {
  407. ret = passy_reader_read_dg2_or_dg7(passy_reader);
  408. } else {
  409. // Until file specific handling is implemented, we just read the header
  410. bit_buffer_reset(passy_reader->dg_header);
  411. uint8_t header[4];
  412. ret = passy_reader_read_binary(passy_reader, 0x00, sizeof(header), header);
  413. if(ret != NfcCommandContinue) {
  414. view_dispatcher_send_custom_event(
  415. passy->view_dispatcher, PassyCustomEventReaderError);
  416. break;
  417. }
  418. bit_buffer_append_bytes(passy_reader->dg_header, header, sizeof(header));
  419. }
  420. // Everything done
  421. ret = NfcCommandStop;
  422. view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderSuccess);
  423. } while(false);
  424. return ret;
  425. }
  426. NfcCommand passy_reader_poller_callback(NfcGenericEvent event, void* context) {
  427. PassyReader* passy_reader = context;
  428. NfcCommand ret = NfcCommandContinue;
  429. Passy* passy = passy_reader->passy;
  430. if(strcmp(passy->proto, "4a") == 0) {
  431. furi_assert(event.protocol == NfcProtocolIso14443_4a);
  432. const Iso14443_4aPollerEvent* iso14443_4a_event = event.event_data;
  433. Iso14443_4aPoller* iso14443_4a_poller = event.instance;
  434. FURI_LOG_D(TAG, "iso14443_4a_event->type %i", iso14443_4a_event->type);
  435. passy_reader->iso14443_4a_poller = iso14443_4a_poller;
  436. if(iso14443_4a_event->type == Iso14443_4aPollerEventTypeReady) {
  437. nfc_device_set_data(
  438. passy_reader->passy->nfc_device,
  439. NfcProtocolIso14443_4a,
  440. nfc_poller_get_data(passy_reader->passy->poller));
  441. ret = passy_reader_state_machine(passy_reader);
  442. furi_thread_set_current_priority(FuriThreadPriorityLowest);
  443. } else if(iso14443_4a_event->type == Iso14443_4aPollerEventTypeError) {
  444. Iso14443_4aPollerEventData* data = iso14443_4a_event->data;
  445. Iso14443_4aError error = data->error;
  446. FURI_LOG_W(TAG, "Iso14443_4aError %i", error);
  447. switch(error) {
  448. case Iso14443_4aErrorNone:
  449. break;
  450. case Iso14443_4aErrorNotPresent:
  451. break;
  452. case Iso14443_4aErrorProtocol:
  453. ret = NfcCommandStop;
  454. break;
  455. case Iso14443_4aErrorTimeout:
  456. break;
  457. }
  458. }
  459. } else if(strcmp(passy->proto, "4b") == 0) {
  460. furi_assert(event.protocol == NfcProtocolIso14443_4b);
  461. const Iso14443_4bPollerEvent* iso14443_4b_event = event.event_data;
  462. Iso14443_4bPoller* iso14443_4b_poller = event.instance;
  463. FURI_LOG_D(TAG, "iso14443_4b_event->type %i", iso14443_4b_event->type);
  464. passy_reader->iso14443_4b_poller = iso14443_4b_poller;
  465. if(iso14443_4b_event->type == Iso14443_4bPollerEventTypeReady) {
  466. nfc_device_set_data(
  467. passy_reader->passy->nfc_device,
  468. NfcProtocolIso14443_4b,
  469. nfc_poller_get_data(passy_reader->passy->poller));
  470. ret = passy_reader_state_machine(passy_reader);
  471. furi_thread_set_current_priority(FuriThreadPriorityLowest);
  472. } else if(iso14443_4b_event->type == Iso14443_4bPollerEventTypeError) {
  473. Iso14443_4bPollerEventData* data = iso14443_4b_event->data;
  474. Iso14443_4bError error = data->error;
  475. FURI_LOG_W(TAG, "Iso14443_4bError %i", error);
  476. switch(error) {
  477. case Iso14443_4bErrorNone:
  478. break;
  479. case Iso14443_4bErrorNotPresent:
  480. break;
  481. case Iso14443_4bErrorProtocol:
  482. ret = NfcCommandStop;
  483. break;
  484. case Iso14443_4bErrorTimeout:
  485. break;
  486. }
  487. }
  488. } else {
  489. view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
  490. }
  491. return ret;
  492. }