seader_worker.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694
  1. #include "seader_worker_i.h"
  2. #include <flipper_format/flipper_format.h>
  3. #include <lib/lfrfid/tools/bit_lib.h>
  4. #define TAG "SeaderWorker"
  5. #define APDU_HEADER_LEN 5
  6. #define ASN1_PREFIX 6
  7. #define ASN1_DEBUG true
  8. #define RFAL_PICOPASS_TXRX_FLAGS \
  9. (FURI_HAL_NFC_LL_TXRX_FLAGS_CRC_TX_MANUAL | FURI_HAL_NFC_LL_TXRX_FLAGS_AGC_ON | \
  10. FURI_HAL_NFC_LL_TXRX_FLAGS_PAR_RX_REMV | FURI_HAL_NFC_LL_TXRX_FLAGS_CRC_RX_KEEP)
  11. // TODO: const
  12. uint8_t GET_RESPONSE[] = {0x00, 0xc0, 0x00, 0x00, 0xff};
  13. char payloadDebug[384] = {0};
  14. char display[SEADER_UART_RX_BUF_SIZE * 2 + 1] = {0};
  15. char asn1_log[SEADER_UART_RX_BUF_SIZE] = {0};
  16. bool requestPacs = true;
  17. // Forward declaration
  18. void seader_send_card_detected(SeaderUartBridge* seader_uart, CardDetails_t* cardDetails);
  19. /***************************** Seader Worker API *******************************/
  20. SeaderWorker* seader_worker_alloc() {
  21. SeaderWorker* seader_worker = malloc(sizeof(SeaderWorker));
  22. // Worker thread attributes
  23. seader_worker->thread =
  24. furi_thread_alloc_ex("SeaderWorker", 8192, seader_worker_task, seader_worker);
  25. seader_worker->callback = NULL;
  26. seader_worker->context = NULL;
  27. seader_worker->storage = furi_record_open(RECORD_STORAGE);
  28. memset(seader_worker->sam_version, 0, sizeof(seader_worker->sam_version));
  29. seader_worker_change_state(seader_worker, SeaderWorkerStateReady);
  30. return seader_worker;
  31. }
  32. void seader_worker_free(SeaderWorker* seader_worker) {
  33. furi_assert(seader_worker);
  34. furi_thread_free(seader_worker->thread);
  35. furi_record_close(RECORD_STORAGE);
  36. free(seader_worker);
  37. }
  38. SeaderWorkerState seader_worker_get_state(SeaderWorker* seader_worker) {
  39. return seader_worker->state;
  40. }
  41. void seader_worker_start(
  42. SeaderWorker* seader_worker,
  43. SeaderWorkerState state,
  44. SeaderUartBridge* uart,
  45. SeaderCredential* credential,
  46. SeaderWorkerCallback callback,
  47. void* context) {
  48. furi_assert(seader_worker);
  49. furi_assert(uart);
  50. furi_assert(credential);
  51. seader_worker->callback = callback;
  52. seader_worker->context = context;
  53. seader_worker->uart = uart;
  54. seader_worker->credential = credential;
  55. seader_worker_change_state(seader_worker, state);
  56. furi_thread_start(seader_worker->thread);
  57. }
  58. void seader_worker_stop(SeaderWorker* seader_worker) {
  59. furi_assert(seader_worker);
  60. if(seader_worker->state == SeaderWorkerStateBroken ||
  61. seader_worker->state == SeaderWorkerStateReady) {
  62. return;
  63. }
  64. // seader_worker_disable_field();
  65. seader_worker_change_state(seader_worker, SeaderWorkerStateStop);
  66. furi_thread_join(seader_worker->thread);
  67. }
  68. void seader_worker_change_state(SeaderWorker* seader_worker, SeaderWorkerState state) {
  69. seader_worker->state = state;
  70. }
  71. /***************************** Seader Worker Thread *******************************/
  72. void* calloc(size_t count, size_t size) {
  73. return malloc(count * size);
  74. }
  75. bool seader_send_apdu(
  76. SeaderUartBridge* seader_uart,
  77. uint8_t CLA,
  78. uint8_t INS,
  79. uint8_t P1,
  80. uint8_t P2,
  81. uint8_t* payload,
  82. uint8_t length) {
  83. if(APDU_HEADER_LEN + length > SEADER_UART_RX_BUF_SIZE) {
  84. FURI_LOG_E(TAG, "Cannot send message, too long: %d", APDU_HEADER_LEN + length);
  85. return false;
  86. }
  87. uint8_t* apdu = malloc(APDU_HEADER_LEN + length);
  88. apdu[0] = CLA;
  89. apdu[1] = INS;
  90. apdu[2] = P1;
  91. apdu[3] = P2;
  92. apdu[4] = length;
  93. memcpy(apdu + APDU_HEADER_LEN, payload, length);
  94. seader_ccid_XfrBlock(seader_uart, apdu, APDU_HEADER_LEN + length);
  95. free(apdu);
  96. return true;
  97. }
  98. static int seader_asn_to_string(const void* buffer, size_t size, void* app_key) {
  99. if(app_key) {
  100. char* str = (char*)app_key;
  101. size_t next = strlen(str);
  102. strncpy(str + next, buffer, size);
  103. } else {
  104. uint8_t next = strlen(asn1_log);
  105. strncpy(asn1_log + next, buffer, size);
  106. }
  107. return 0;
  108. }
  109. bool seader_read_nfc(SeaderUartBridge* seader_uart) {
  110. UNUSED(seader_uart);
  111. return false;
  112. }
  113. bool seader_detect_nfc(SeaderWorker* seader_worker) {
  114. SeaderUartBridge* seader_uart = seader_worker->uart;
  115. while(seader_worker->state == SeaderWorkerStateRead14a) {
  116. // Card found
  117. if(seader_read_nfc(seader_uart)) {
  118. return true;
  119. }
  120. furi_delay_ms(100);
  121. }
  122. return false;
  123. }
  124. void seader_send_payload(
  125. SeaderUartBridge* seader_uart,
  126. Payload_t* payload,
  127. uint8_t to,
  128. uint8_t from,
  129. uint8_t replyTo) {
  130. uint8_t rBuffer[SEADER_UART_RX_BUF_SIZE] = {0};
  131. asn_enc_rval_t er = der_encode_to_buffer(
  132. &asn_DEF_Payload, payload, rBuffer + ASN1_PREFIX, sizeof(rBuffer) - ASN1_PREFIX);
  133. #ifdef ASN1_DEBUG
  134. if(er.encoded > -1) {
  135. memset(payloadDebug, 0, sizeof(payloadDebug));
  136. (&asn_DEF_Payload)
  137. ->op->print_struct(&asn_DEF_Payload, payload, 1, seader_asn_to_string, payloadDebug);
  138. if(strlen(payloadDebug) > 0) {
  139. FURI_LOG_D(TAG, "Sending payload[%d %d %d]: %s", to, from, replyTo, payloadDebug);
  140. }
  141. }
  142. #endif
  143. //0xa0, 0xda, 0x02, 0x63, 0x00, 0x00, 0x0a,
  144. //0x44, 0x0a, 0x44, 0x00, 0x00, 0x00, 0xa0, 0x02, 0x96, 0x00
  145. rBuffer[0] = to;
  146. rBuffer[1] = from;
  147. rBuffer[2] = replyTo;
  148. seader_send_apdu(seader_uart, 0xA0, 0xDA, 0x02, 0x63, rBuffer, 6 + er.encoded);
  149. }
  150. void seader_send_response(
  151. SeaderUartBridge* seader_uart,
  152. Response_t* response,
  153. uint8_t to,
  154. uint8_t from,
  155. uint8_t replyTo) {
  156. Payload_t* payload = 0;
  157. payload = calloc(1, sizeof *payload);
  158. assert(payload);
  159. payload->present = Payload_PR_response;
  160. payload->choice.response = *response;
  161. seader_send_payload(seader_uart, payload, to, from, replyTo);
  162. ASN_STRUCT_FREE(asn_DEF_Payload, payload);
  163. }
  164. void sendRequestPacs(SeaderUartBridge* seader_uart) {
  165. RequestPacs_t* requestPacs = 0;
  166. requestPacs = calloc(1, sizeof *requestPacs);
  167. assert(requestPacs);
  168. requestPacs->contentElementTag = ContentElementTag_implicitFormatPhysicalAccessBits;
  169. SamCommand_t* samCommand = 0;
  170. samCommand = calloc(1, sizeof *samCommand);
  171. assert(samCommand);
  172. samCommand->present = SamCommand_PR_requestPacs;
  173. samCommand->choice.requestPacs = *requestPacs;
  174. Payload_t* payload = 0;
  175. payload = calloc(1, sizeof *payload);
  176. assert(payload);
  177. payload->present = Payload_PR_samCommand;
  178. payload->choice.samCommand = *samCommand;
  179. seader_send_payload(seader_uart, payload, 0x44, 0x0a, 0x44);
  180. ASN_STRUCT_FREE(asn_DEF_RequestPacs, requestPacs);
  181. ASN_STRUCT_FREE(asn_DEF_SamCommand, samCommand);
  182. ASN_STRUCT_FREE(asn_DEF_Payload, payload);
  183. }
  184. void seader_worker_send_version(SeaderWorker* seader_worker) {
  185. SeaderUartBridge* seader_uart = seader_worker->uart;
  186. SamCommand_t* samCommand = 0;
  187. samCommand = calloc(1, sizeof *samCommand);
  188. assert(samCommand);
  189. samCommand->present = SamCommand_PR_version;
  190. Payload_t* payload = 0;
  191. payload = calloc(1, sizeof *payload);
  192. assert(payload);
  193. payload->present = Payload_PR_samCommand;
  194. payload->choice.samCommand = *samCommand;
  195. seader_send_payload(seader_uart, payload, 0x44, 0x0a, 0x44);
  196. ASN_STRUCT_FREE(asn_DEF_SamCommand, samCommand);
  197. ASN_STRUCT_FREE(asn_DEF_Payload, payload);
  198. }
  199. void seader_send_card_detected(SeaderUartBridge* seader_uart, CardDetails_t* cardDetails) {
  200. CardDetected_t* cardDetected = 0;
  201. cardDetected = calloc(1, sizeof *cardDetected);
  202. assert(cardDetected);
  203. cardDetected->detectedCardDetails = *cardDetails;
  204. SamCommand_t* samCommand = 0;
  205. samCommand = calloc(1, sizeof *samCommand);
  206. assert(samCommand);
  207. samCommand->present = SamCommand_PR_cardDetected;
  208. samCommand->choice.cardDetected = *cardDetected;
  209. Payload_t* payload = 0;
  210. payload = calloc(1, sizeof *payload);
  211. assert(payload);
  212. payload->present = Payload_PR_samCommand;
  213. payload->choice.samCommand = *samCommand;
  214. seader_send_payload(seader_uart, payload, 0x44, 0x0a, 0x44);
  215. ASN_STRUCT_FREE(asn_DEF_CardDetected, cardDetected);
  216. ASN_STRUCT_FREE(asn_DEF_SamCommand, samCommand);
  217. ASN_STRUCT_FREE(asn_DEF_Payload, payload);
  218. }
  219. bool seader_unpack_pacs(
  220. SeaderWorker* seader_worker,
  221. SeaderCredential* seader_credential,
  222. uint8_t* buf,
  223. size_t size) {
  224. PAC_t* pac = 0;
  225. pac = calloc(1, sizeof *pac);
  226. assert(pac);
  227. bool rtn = false;
  228. asn_dec_rval_t rval = asn_decode(0, ATS_DER, &asn_DEF_PAC, (void**)&pac, buf, size);
  229. if(rval.code == RC_OK) {
  230. char pacDebug[384] = {0};
  231. (&asn_DEF_PAC)->op->print_struct(&asn_DEF_PAC, pac, 1, seader_asn_to_string, pacDebug);
  232. if(strlen(pacDebug) > 0) {
  233. FURI_LOG_D(TAG, "Received pac: %s", pacDebug);
  234. memset(display, 0, sizeof(display));
  235. if(seader_credential->sio[0] == 0x30) {
  236. for(uint8_t i = 0; i < sizeof(seader_credential->sio); i++) {
  237. snprintf(
  238. display + (i * 2), sizeof(display), "%02x", seader_credential->sio[i]);
  239. }
  240. FURI_LOG_D(TAG, "SIO %s", display);
  241. }
  242. }
  243. if(pac->size <= sizeof(seader_credential->credential)) {
  244. // TODO: make credential into a 12 byte array
  245. seader_credential->bit_length = pac->size * 8 - pac->bits_unused;
  246. memcpy(&seader_credential->credential, pac->buf, pac->size);
  247. seader_credential->credential = __builtin_bswap64(seader_credential->credential);
  248. seader_credential->credential = seader_credential->credential >>
  249. (64 - seader_credential->bit_length);
  250. rtn = true;
  251. } else {
  252. // PACS too big (probably bad data)
  253. if(seader_worker->callback) {
  254. seader_worker->callback(SeaderWorkerEventFail, seader_worker->context);
  255. }
  256. }
  257. }
  258. ASN_STRUCT_FREE(asn_DEF_PAC, pac);
  259. return rtn;
  260. }
  261. // 800201298106683d052026b6820101
  262. //300F800201298106683D052026B6820101
  263. bool seader_parse_version(SeaderWorker* seader_worker, uint8_t* buf, size_t size) {
  264. SamVersion_t* version = 0;
  265. version = calloc(1, sizeof *version);
  266. assert(version);
  267. bool rtn = false;
  268. if(size > 30) {
  269. // Too large to handle now
  270. FURI_LOG_W(TAG, "Version of %d is to long to parse", size);
  271. return false;
  272. }
  273. // Add sequence prefix
  274. uint8_t seq[32] = {0x30};
  275. seq[1] = (uint8_t)size;
  276. memcpy(seq + 2, buf, size);
  277. asn_dec_rval_t rval =
  278. asn_decode(0, ATS_DER, &asn_DEF_SamVersion, (void**)&version, seq, size + 2);
  279. if(rval.code == RC_OK) {
  280. char versionDebug[128] = {0};
  281. (&asn_DEF_SamVersion)
  282. ->op->print_struct(
  283. &asn_DEF_SamVersion, version, 1, seader_asn_to_string, versionDebug);
  284. if(strlen(versionDebug) > 0) {
  285. FURI_LOG_D(TAG, "Received version: %s", versionDebug);
  286. }
  287. if(version->version.size == 2) {
  288. memcpy(seader_worker->sam_version, version->version.buf, version->version.size);
  289. }
  290. rtn = true;
  291. }
  292. ASN_STRUCT_FREE(asn_DEF_SamVersion, version);
  293. return rtn;
  294. }
  295. bool seader_parse_sam_response(SeaderWorker* seader_worker, SamResponse_t* samResponse) {
  296. SeaderUartBridge* seader_uart = seader_worker->uart;
  297. SeaderCredential* credential = seader_worker->credential;
  298. if(samResponse->size == 0) {
  299. if(requestPacs) {
  300. // FURI_LOG_D(TAG, "samResponse %d => requesting PACS", samResponse->size);
  301. sendRequestPacs(seader_uart);
  302. requestPacs = false;
  303. } else {
  304. // FURI_LOG_D(TAG, "samResponse %d, no action", samResponse->size);
  305. if(seader_worker->callback) {
  306. seader_worker->callback(SeaderWorkerEventFail, seader_worker->context);
  307. }
  308. }
  309. } else if(seader_parse_version(seader_worker, samResponse->buf, samResponse->size)) {
  310. // no-op
  311. } else if(seader_unpack_pacs(seader_worker, credential, samResponse->buf, samResponse->size)) {
  312. if(seader_worker->callback) {
  313. seader_worker->callback(SeaderWorkerEventSuccess, seader_worker->context);
  314. }
  315. } else {
  316. memset(display, 0, sizeof(display));
  317. for(uint8_t i = 0; i < samResponse->size; i++) {
  318. snprintf(display + (i * 2), sizeof(display), "%02x", samResponse->buf[i]);
  319. }
  320. FURI_LOG_D(TAG, "unknown samResponse %d: %s", samResponse->size, display);
  321. }
  322. return false;
  323. }
  324. bool seader_parse_response(SeaderWorker* seader_worker, Response_t* response) {
  325. switch(response->present) {
  326. case Response_PR_samResponse:
  327. seader_parse_sam_response(seader_worker, &response->choice.samResponse);
  328. break;
  329. default:
  330. break;
  331. };
  332. return false;
  333. }
  334. void seader_send_nfc_rx(SeaderUartBridge* seader_uart, uint8_t* buffer, size_t len) {
  335. OCTET_STRING_t rxData = {.buf = buffer, .size = len};
  336. uint8_t status[] = {0x00, 0x00};
  337. RfStatus_t rfStatus = {.buf = status, .size = 2};
  338. NFCRx_t* nfcRx = 0;
  339. nfcRx = calloc(1, sizeof *nfcRx);
  340. assert(nfcRx);
  341. nfcRx->rfStatus = rfStatus;
  342. nfcRx->data = &rxData;
  343. NFCResponse_t* nfcResponse = 0;
  344. nfcResponse = calloc(1, sizeof *nfcResponse);
  345. assert(nfcResponse);
  346. nfcResponse->present = NFCResponse_PR_nfcRx;
  347. nfcResponse->choice.nfcRx = *nfcRx;
  348. Response_t* response = 0;
  349. response = calloc(1, sizeof *response);
  350. assert(response);
  351. response->present = Response_PR_nfcResponse;
  352. response->choice.nfcResponse = *nfcResponse;
  353. seader_send_response(seader_uart, response, 0x14, 0x0a, 0x0);
  354. ASN_STRUCT_FREE(asn_DEF_NFCRx, nfcRx);
  355. ASN_STRUCT_FREE(asn_DEF_NFCResponse, nfcResponse);
  356. ASN_STRUCT_FREE(asn_DEF_Response, response);
  357. }
  358. bool seader_parse_nfc_command_transmit(SeaderWorker* seader_worker, NFCSend_t* nfcSend) {
  359. UNUSED(seader_worker);
  360. long timeOut = nfcSend->timeOut;
  361. Protocol_t protocol = nfcSend->protocol;
  362. FrameProtocol_t frameProtocol = protocol.buf[1];
  363. #ifdef ASN1_DEBUG
  364. memset(display, 0, sizeof(display));
  365. for(uint8_t i = 0; i < nfcSend->data.size; i++) {
  366. snprintf(display + (i * 2), sizeof(display), "%02x", nfcSend->data.buf[i]);
  367. }
  368. char protocolName[8] = {0};
  369. memset(protocolName, 0, sizeof(protocolName));
  370. (&asn_DEF_FrameProtocol)
  371. ->op->print_struct(
  372. &asn_DEF_FrameProtocol, &frameProtocol, 1, seader_asn_to_string, protocolName);
  373. FURI_LOG_D(
  374. TAG,
  375. "Transmit (%ld timeout) %d bytes [%s] via %s",
  376. timeOut,
  377. nfcSend->data.size,
  378. display,
  379. protocolName);
  380. #endif
  381. if(frameProtocol == FrameProtocol_iclass) {
  382. // TODO
  383. } else if(frameProtocol == FrameProtocol_nfc) {
  384. // TODO
  385. }
  386. return false;
  387. }
  388. bool seader_parse_nfc_off(SeaderUartBridge* seader_uart) {
  389. FURI_LOG_D(TAG, "Set Field Off");
  390. // seader_worker_disable_field();
  391. // seader_nfc_scene_field_on_exit();
  392. NFCResponse_t* nfcResponse = 0;
  393. nfcResponse = calloc(1, sizeof *nfcResponse);
  394. assert(nfcResponse);
  395. nfcResponse->present = NFCResponse_PR_nfcAck;
  396. Response_t* response = 0;
  397. response = calloc(1, sizeof *response);
  398. assert(response);
  399. response->present = Response_PR_nfcResponse;
  400. response->choice.nfcResponse = *nfcResponse;
  401. seader_send_response(seader_uart, response, 0x44, 0x0a, 0);
  402. ASN_STRUCT_FREE(asn_DEF_Response, response);
  403. ASN_STRUCT_FREE(asn_DEF_NFCResponse, nfcResponse);
  404. return false;
  405. }
  406. bool seader_parse_nfc_command(SeaderWorker* seader_worker, NFCCommand_t* nfcCommand) {
  407. SeaderUartBridge* seader_uart = seader_worker->uart;
  408. switch(nfcCommand->present) {
  409. case NFCCommand_PR_nfcSend:
  410. seader_parse_nfc_command_transmit(seader_worker, &nfcCommand->choice.nfcSend);
  411. break;
  412. case NFCCommand_PR_nfcOff:
  413. seader_parse_nfc_off(seader_uart);
  414. break;
  415. default:
  416. FURI_LOG_W(TAG, "unparsed NFCCommand");
  417. break;
  418. };
  419. return false;
  420. }
  421. bool seader_worker_state_machine(SeaderWorker* seader_worker, Payload_t* payload) {
  422. switch(payload->present) {
  423. case Payload_PR_response:
  424. seader_parse_response(seader_worker, &payload->choice.response);
  425. break;
  426. case Payload_PR_nfcCommand:
  427. seader_parse_nfc_command(seader_worker, &payload->choice.nfcCommand);
  428. break;
  429. case Payload_PR_errorResponse:
  430. // TODO: screen saying this was a failure, or maybe start over?
  431. if(seader_worker->callback) {
  432. seader_worker->callback(SeaderWorkerEventFail, seader_worker->context);
  433. }
  434. break;
  435. default:
  436. FURI_LOG_W(TAG, "unhandled payload");
  437. break;
  438. };
  439. return false;
  440. }
  441. bool seader_process_success_response(SeaderWorker* seader_worker, uint8_t* apdu, size_t len) {
  442. Payload_t* payload = 0;
  443. payload = calloc(1, sizeof *payload);
  444. assert(payload);
  445. asn_dec_rval_t rval =
  446. asn_decode(0, ATS_DER, &asn_DEF_Payload, (void**)&payload, apdu + 6, len - 6);
  447. if(rval.code == RC_OK) {
  448. #ifdef ASN1_DEBUG
  449. memset(payloadDebug, 0, sizeof(payloadDebug));
  450. (&asn_DEF_Payload)
  451. ->op->print_struct(&asn_DEF_Payload, payload, 1, seader_asn_to_string, payloadDebug);
  452. if(strlen(payloadDebug) > 0) {
  453. FURI_LOG_D(TAG, "Received payload: %s", payloadDebug);
  454. }
  455. #endif
  456. seader_worker_state_machine(seader_worker, payload);
  457. }
  458. ASN_STRUCT_FREE(asn_DEF_Payload, payload);
  459. return (rval.code == RC_OK);
  460. }
  461. bool seader_process_apdu(SeaderWorker* seader_worker, uint8_t* apdu, size_t len) {
  462. SeaderUartBridge* seader_uart = seader_worker->uart;
  463. if(len < 2) {
  464. return false;
  465. }
  466. /*
  467. memset(display, 0, sizeof(display));
  468. for(uint8_t i = 0; i < len; i++) {
  469. snprintf(display + (i * 2), sizeof(display), "%02x", apdu[i]);
  470. }
  471. FURI_LOG_I(TAG, "APDU: %s", display);
  472. */
  473. uint8_t SW1 = apdu[len - 2];
  474. uint8_t SW2 = apdu[len - 1];
  475. switch(SW1) {
  476. case 0x61:
  477. // FURI_LOG_I(TAG, "Request %d bytes", SW2);
  478. GET_RESPONSE[4] = SW2;
  479. seader_ccid_XfrBlock(seader_uart, GET_RESPONSE, sizeof(GET_RESPONSE));
  480. return true;
  481. break;
  482. case 0x90:
  483. if(SW2 == 0x00) {
  484. if(len > 2) {
  485. return seader_process_success_response(seader_worker, apdu, len - 2);
  486. }
  487. }
  488. break;
  489. }
  490. return false;
  491. }
  492. void seader_worker_process_sam_message(SeaderWorker* seader_worker, CCID_Message* message) {
  493. if(seader_process_apdu(seader_worker, message->payload, message->dwLength)) {
  494. // no-op
  495. } else {
  496. memset(display, 0, sizeof(display));
  497. for(uint8_t i = 0; i < message->dwLength; i++) {
  498. snprintf(display + (i * 2), sizeof(display), "%02x", message->payload[i]);
  499. }
  500. FURI_LOG_W(TAG, "Unknown block: [%ld] %s", message->dwLength, display);
  501. if(seader_worker->callback) {
  502. seader_worker->callback(SeaderWorkerEventFail, seader_worker->context);
  503. }
  504. }
  505. }
  506. int32_t seader_worker_task(void* context) {
  507. SeaderWorker* seader_worker = context;
  508. SeaderUartBridge* seader_uart = seader_worker->uart;
  509. if(seader_worker->state == SeaderWorkerStateCheckSam) {
  510. seader_ccid_check_for_sam(seader_uart);
  511. } else if(seader_worker->state == SeaderWorkerStateReadPicopass) {
  512. FURI_LOG_D(TAG, "Read Picopass");
  513. requestPacs = true;
  514. seader_credential_clear(seader_worker->credential);
  515. seader_worker->credential->type = SeaderCredentialTypePicopass;
  516. // TODO
  517. } else if(seader_worker->state == SeaderWorkerStateRead14a) {
  518. FURI_LOG_D(TAG, "Read 14a");
  519. requestPacs = true;
  520. seader_credential_clear(seader_worker->credential);
  521. seader_worker->credential->type = SeaderCredentialType14A;
  522. // seader_nfc_scene_field_on_enter();
  523. if(!seader_detect_nfc(seader_worker)) {
  524. // Turn off if cancelled / no card found
  525. // seader_nfc_scene_field_on_exit();
  526. }
  527. }
  528. FURI_LOG_D(TAG, "Worker Task Complete");
  529. seader_worker_change_state(seader_worker, SeaderWorkerStateReady);
  530. return 0;
  531. }
  532. NfcCommand seader_worker_poller_callback_iso14443_4a(NfcGenericEvent event, void* context) {
  533. furi_assert(event.protocol == NfcProtocolIso14443_4a);
  534. Seader* seader = context;
  535. SeaderUartBridge* seader_uart = seader->uart;
  536. const Iso14443_4aPollerEvent* iso14443_4a_event = event.event_data;
  537. if(iso14443_4a_event->type == Iso14443_4aPollerEventTypeReady) {
  538. nfc_device_set_data(seader->nfc_device, NfcProtocolIso14443_4a, nfc_poller_get_data(seader->poller));
  539. FURI_LOG_D(TAG, "poller 14a ready");
  540. size_t uid_len;
  541. const uint8_t* uid = nfc_device_get_uid(seader->nfc_device, &uid_len);
  542. // const Iso14443_4aData* iso14443_4a_data = nfc_device_get_data(seader->nfc_device, NfcProtocolIso14443_4a);
  543. //const Iso14443_3aData* iso14443_3a_data = iso14443_4a_data->iso14443_3a_data;
  544. const Iso14443_3aData* iso14443_3a_data = nfc_device_get_data(seader->nfc_device, NfcProtocolIso14443_3a);
  545. uint8_t sak_val = iso14443_3a_get_sak(iso14443_3a_data);
  546. CardDetails_t* cardDetails = 0;
  547. cardDetails = calloc(1, sizeof *cardDetails);
  548. assert(cardDetails);
  549. OCTET_STRING_fromBuf(&cardDetails->csn, (const char*)uid, uid_len);
  550. uint8_t protocolBytes[] = {0x00, FrameProtocol_nfc};
  551. OCTET_STRING_fromBuf(&cardDetails->protocol, (const char*)protocolBytes, sizeof(protocolBytes));
  552. OCTET_STRING_t sak = {.buf = &sak_val, .size = 1};
  553. cardDetails->sak = &sak;
  554. OCTET_STRING_t atqa = {.buf = (uint8_t*)iso14443_3a_data->atqa, .size = 2};
  555. cardDetails->atqa = &atqa;
  556. seader_send_card_detected(seader_uart, cardDetails);
  557. ASN_STRUCT_FREE(asn_DEF_CardDetails, cardDetails);
  558. return NfcCommandStop;
  559. }
  560. return NfcCommandContinue;
  561. }