sam_api.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687
  1. #include "sam_api.h"
  2. #define TAG "SAMAPI"
  3. #define APDU_HEADER_LEN 5
  4. #define ASN1_PREFIX 6
  5. #define ASN1_DEBUG true
  6. static char display[SEADER_UART_RX_BUF_SIZE * 2 + 1] = {0};
  7. char asn1_log[SEADER_UART_RX_BUF_SIZE] = {0};
  8. bool requestPacs = true;
  9. void* calloc(size_t count, size_t size) {
  10. return malloc(count * size);
  11. }
  12. bool seader_send_apdu(
  13. SeaderUartBridge* seader_uart,
  14. uint8_t CLA,
  15. uint8_t INS,
  16. uint8_t P1,
  17. uint8_t P2,
  18. uint8_t* payload,
  19. uint8_t length) {
  20. if(APDU_HEADER_LEN + length > SEADER_UART_RX_BUF_SIZE) {
  21. FURI_LOG_E(TAG, "Cannot send message, too long: %d", APDU_HEADER_LEN + length);
  22. return false;
  23. }
  24. uint8_t apdu[SEADER_UART_RX_BUF_SIZE];
  25. apdu[0] = CLA;
  26. apdu[1] = INS;
  27. apdu[2] = P1;
  28. apdu[3] = P2;
  29. apdu[4] = length;
  30. memcpy(apdu + APDU_HEADER_LEN, payload, length);
  31. seader_ccid_XfrBlock(seader_uart, apdu, APDU_HEADER_LEN + length);
  32. return true;
  33. }
  34. static int seader_print_struct_callback(const void* buffer, size_t size, void* app_key) {
  35. if(app_key) {
  36. char* str = (char*)app_key;
  37. size_t next = strlen(str);
  38. strncpy(str + next, buffer, size);
  39. } else {
  40. uint8_t next = strlen(asn1_log);
  41. strncpy(asn1_log + next, buffer, size);
  42. }
  43. return 0;
  44. }
  45. void seader_send_payload(
  46. SeaderUartBridge* seader_uart,
  47. Payload_t* payload,
  48. uint8_t to,
  49. uint8_t from,
  50. uint8_t replyTo) {
  51. uint8_t rBuffer[SEADER_UART_RX_BUF_SIZE] = {0};
  52. asn_enc_rval_t er = der_encode_to_buffer(
  53. &asn_DEF_Payload, payload, rBuffer + ASN1_PREFIX, sizeof(rBuffer) - ASN1_PREFIX);
  54. #ifdef ASN1_DEBUG
  55. if(er.encoded > -1) {
  56. char payloadDebug[384] = {0};
  57. memset(payloadDebug, 0, sizeof(payloadDebug));
  58. (&asn_DEF_Payload)
  59. ->op->print_struct(
  60. &asn_DEF_Payload, payload, 1, seader_print_struct_callback, payloadDebug);
  61. if(strlen(payloadDebug) > 0) {
  62. FURI_LOG_D(TAG, "Sending payload[%d %d %d]: %s", to, from, replyTo, payloadDebug);
  63. }
  64. }
  65. #endif
  66. //0xa0, 0xda, 0x02, 0x63, 0x00, 0x00, 0x0a,
  67. //0x44, 0x0a, 0x44, 0x00, 0x00, 0x00, 0xa0, 0x02, 0x96, 0x00
  68. rBuffer[0] = to;
  69. rBuffer[1] = from;
  70. rBuffer[2] = replyTo;
  71. seader_send_apdu(seader_uart, 0xA0, 0xDA, 0x02, 0x63, rBuffer, 6 + er.encoded);
  72. }
  73. void seader_send_response(
  74. SeaderUartBridge* seader_uart,
  75. Response_t* response,
  76. uint8_t to,
  77. uint8_t from,
  78. uint8_t replyTo) {
  79. Payload_t* payload = 0;
  80. payload = calloc(1, sizeof *payload);
  81. assert(payload);
  82. payload->present = Payload_PR_response;
  83. payload->choice.response = *response;
  84. seader_send_payload(seader_uart, payload, to, from, replyTo);
  85. ASN_STRUCT_FREE(asn_DEF_Payload, payload);
  86. }
  87. void sendRequestPacs(SeaderUartBridge* seader_uart) {
  88. RequestPacs_t* requestPacs = 0;
  89. requestPacs = calloc(1, sizeof *requestPacs);
  90. assert(requestPacs);
  91. requestPacs->contentElementTag = ContentElementTag_implicitFormatPhysicalAccessBits;
  92. SamCommand_t* samCommand = 0;
  93. samCommand = calloc(1, sizeof *samCommand);
  94. assert(samCommand);
  95. samCommand->present = SamCommand_PR_requestPacs;
  96. samCommand->choice.requestPacs = *requestPacs;
  97. Payload_t* payload = 0;
  98. payload = calloc(1, sizeof *payload);
  99. assert(payload);
  100. payload->present = Payload_PR_samCommand;
  101. payload->choice.samCommand = *samCommand;
  102. seader_send_payload(seader_uart, payload, 0x44, 0x0a, 0x44);
  103. ASN_STRUCT_FREE(asn_DEF_RequestPacs, requestPacs);
  104. ASN_STRUCT_FREE(asn_DEF_SamCommand, samCommand);
  105. ASN_STRUCT_FREE(asn_DEF_Payload, payload);
  106. }
  107. void seader_worker_send_version(SeaderWorker* seader_worker) {
  108. SeaderUartBridge* seader_uart = seader_worker->uart;
  109. SamCommand_t* samCommand = 0;
  110. samCommand = calloc(1, sizeof *samCommand);
  111. assert(samCommand);
  112. samCommand->present = SamCommand_PR_version;
  113. Payload_t* payload = 0;
  114. payload = calloc(1, sizeof *payload);
  115. assert(payload);
  116. payload->present = Payload_PR_samCommand;
  117. payload->choice.samCommand = *samCommand;
  118. seader_send_payload(seader_uart, payload, 0x44, 0x0a, 0x44);
  119. ASN_STRUCT_FREE(asn_DEF_SamCommand, samCommand);
  120. ASN_STRUCT_FREE(asn_DEF_Payload, payload);
  121. }
  122. void seader_send_card_detected(SeaderUartBridge* seader_uart, CardDetails_t* cardDetails) {
  123. CardDetected_t* cardDetected = 0;
  124. cardDetected = calloc(1, sizeof *cardDetected);
  125. assert(cardDetected);
  126. cardDetected->detectedCardDetails = *cardDetails;
  127. SamCommand_t* samCommand = 0;
  128. samCommand = calloc(1, sizeof *samCommand);
  129. assert(samCommand);
  130. samCommand->present = SamCommand_PR_cardDetected;
  131. samCommand->choice.cardDetected = *cardDetected;
  132. Payload_t* payload = 0;
  133. payload = calloc(1, sizeof *payload);
  134. assert(payload);
  135. payload->present = Payload_PR_samCommand;
  136. payload->choice.samCommand = *samCommand;
  137. seader_send_payload(seader_uart, payload, 0x44, 0x0a, 0x44);
  138. ASN_STRUCT_FREE(asn_DEF_Payload, payload);
  139. ASN_STRUCT_FREE(asn_DEF_SamCommand, samCommand);
  140. ASN_STRUCT_FREE(asn_DEF_CardDetected, cardDetected);
  141. }
  142. bool seader_unpack_pacs(Seader* seader, uint8_t* buf, size_t size) {
  143. SeaderCredential* seader_credential = seader->credential;
  144. PAC_t* pac = 0;
  145. pac = calloc(1, sizeof *pac);
  146. assert(pac);
  147. bool rtn = false;
  148. asn_dec_rval_t rval = asn_decode(0, ATS_DER, &asn_DEF_PAC, (void**)&pac, buf, size);
  149. if(rval.code == RC_OK) {
  150. char pacDebug[384] = {0};
  151. (&asn_DEF_PAC)
  152. ->op->print_struct(&asn_DEF_PAC, pac, 1, seader_print_struct_callback, pacDebug);
  153. if(strlen(pacDebug) > 0) {
  154. FURI_LOG_D(TAG, "Received pac: %s", pacDebug);
  155. memset(display, 0, sizeof(display));
  156. if(seader_credential->sio[0] == 0x30) {
  157. for(uint8_t i = 0; i < sizeof(seader_credential->sio); i++) {
  158. snprintf(
  159. display + (i * 2), sizeof(display), "%02x", seader_credential->sio[i]);
  160. }
  161. FURI_LOG_D(TAG, "SIO %s", display);
  162. }
  163. }
  164. if(pac->size <= sizeof(seader_credential->credential)) {
  165. // TODO: make credential into a 12 byte array
  166. seader_credential->bit_length = pac->size * 8 - pac->bits_unused;
  167. memcpy(&seader_credential->credential, pac->buf, pac->size);
  168. seader_credential->credential = __builtin_bswap64(seader_credential->credential);
  169. seader_credential->credential = seader_credential->credential >>
  170. (64 - seader_credential->bit_length);
  171. rtn = true;
  172. } else {
  173. // PACS too big (probably bad data)
  174. view_dispatcher_send_custom_event(
  175. seader->view_dispatcher, SeaderCustomEventWorkerExit);
  176. }
  177. }
  178. ASN_STRUCT_FREE(asn_DEF_PAC, pac);
  179. return rtn;
  180. }
  181. // 800201298106683d052026b6820101
  182. //300F800201298106683D052026B6820101
  183. bool seader_parse_version(SeaderWorker* seader_worker, uint8_t* buf, size_t size) {
  184. SamVersion_t* version = 0;
  185. version = calloc(1, sizeof *version);
  186. assert(version);
  187. bool rtn = false;
  188. if(size > 30) {
  189. // Too large to handle now
  190. FURI_LOG_W(TAG, "Version of %d is to long to parse", size);
  191. return false;
  192. }
  193. // Add sequence prefix
  194. uint8_t seq[32] = {0x30};
  195. seq[1] = (uint8_t)size;
  196. memcpy(seq + 2, buf, size);
  197. asn_dec_rval_t rval =
  198. asn_decode(0, ATS_DER, &asn_DEF_SamVersion, (void**)&version, seq, size + 2);
  199. if(rval.code == RC_OK) {
  200. char versionDebug[128] = {0};
  201. (&asn_DEF_SamVersion)
  202. ->op->print_struct(
  203. &asn_DEF_SamVersion, version, 1, seader_print_struct_callback, versionDebug);
  204. if(strlen(versionDebug) > 0) {
  205. // FURI_LOG_D(TAG, "Received version: %s", versionDebug);
  206. }
  207. if(version->version.size == 2) {
  208. memcpy(seader_worker->sam_version, version->version.buf, version->version.size);
  209. }
  210. rtn = true;
  211. }
  212. ASN_STRUCT_FREE(asn_DEF_SamVersion, version);
  213. return rtn;
  214. }
  215. bool seader_parse_sam_response(Seader* seader, SamResponse_t* samResponse) {
  216. SeaderWorker* seader_worker = seader->worker;
  217. SeaderUartBridge* seader_uart = seader_worker->uart;
  218. FURI_LOG_D(TAG, "seader_parse_sam_response");
  219. if(samResponse->size == 0) {
  220. if(requestPacs) {
  221. FURI_LOG_D(TAG, "samResponse %d => requesting PACS", samResponse->size);
  222. sendRequestPacs(seader_uart);
  223. requestPacs = false;
  224. } else {
  225. FURI_LOG_D(
  226. TAG, "samResponse %d, PACS already requested, pushing view", samResponse->size);
  227. view_dispatcher_send_custom_event(
  228. seader->view_dispatcher, SeaderCustomEventWorkerExit);
  229. }
  230. } else if(seader_parse_version(seader_worker, samResponse->buf, samResponse->size)) {
  231. // no-op
  232. } else if(seader_unpack_pacs(seader, samResponse->buf, samResponse->size)) {
  233. view_dispatcher_send_custom_event(seader->view_dispatcher, SeaderCustomEventWorkerExit);
  234. } else {
  235. memset(display, 0, sizeof(display));
  236. for(uint8_t i = 0; i < samResponse->size; i++) {
  237. snprintf(display + (i * 2), sizeof(display), "%02x", samResponse->buf[i]);
  238. }
  239. FURI_LOG_D(TAG, "Unknown samResponse %d: %s", samResponse->size, display);
  240. }
  241. return false;
  242. }
  243. bool seader_parse_response(Seader* seader, Response_t* response) {
  244. switch(response->present) {
  245. case Response_PR_samResponse:
  246. seader_parse_sam_response(seader, &response->choice.samResponse);
  247. break;
  248. default:
  249. FURI_LOG_D(TAG, "non-sam response");
  250. break;
  251. };
  252. return false;
  253. }
  254. void seader_send_nfc_rx(SeaderUartBridge* seader_uart, uint8_t* buffer, size_t len) {
  255. OCTET_STRING_t rxData = {.buf = buffer, .size = len};
  256. uint8_t status[] = {0x00, 0x00};
  257. RfStatus_t rfStatus = {.buf = status, .size = 2};
  258. NFCRx_t* nfcRx = 0;
  259. nfcRx = calloc(1, sizeof *nfcRx);
  260. assert(nfcRx);
  261. nfcRx->rfStatus = rfStatus;
  262. nfcRx->data = &rxData;
  263. NFCResponse_t* nfcResponse = 0;
  264. nfcResponse = calloc(1, sizeof *nfcResponse);
  265. assert(nfcResponse);
  266. nfcResponse->present = NFCResponse_PR_nfcRx;
  267. nfcResponse->choice.nfcRx = *nfcRx;
  268. Response_t* response = 0;
  269. response = calloc(1, sizeof *response);
  270. assert(response);
  271. response->present = Response_PR_nfcResponse;
  272. response->choice.nfcResponse = *nfcResponse;
  273. seader_send_response(seader_uart, response, 0x14, 0x0a, 0x0);
  274. ASN_STRUCT_FREE(asn_DEF_NFCRx, nfcRx);
  275. ASN_STRUCT_FREE(asn_DEF_NFCResponse, nfcResponse);
  276. ASN_STRUCT_FREE(asn_DEF_Response, response);
  277. }
  278. static uint16_t seader_worker_picopass_update_ccitt(uint16_t crcSeed, uint8_t dataByte) {
  279. uint16_t crc = crcSeed;
  280. uint8_t dat = dataByte;
  281. dat ^= (uint8_t)(crc & 0xFFU);
  282. dat ^= (dat << 4);
  283. crc = (crc >> 8) ^ (((uint16_t)dat) << 8) ^ (((uint16_t)dat) << 3) ^ (((uint16_t)dat) >> 4);
  284. return crc;
  285. }
  286. static uint16_t seader_worker_picopass_calculate_ccitt(
  287. uint16_t preloadValue,
  288. const uint8_t* buf,
  289. uint16_t length) {
  290. uint16_t crc = preloadValue;
  291. uint16_t index;
  292. for(index = 0; index < length; index++) {
  293. crc = seader_worker_picopass_update_ccitt(crc, buf[index]);
  294. }
  295. return crc;
  296. }
  297. uint8_t read4Block6[] = {0x06, 0x06, 0x45, 0x56};
  298. uint8_t read4Block9[] = {0x06, 0x09, 0xB2, 0xAE};
  299. uint8_t read4Block10[] = {0x06, 0x0A, 0x29, 0x9C};
  300. uint8_t read4Block13[] = {0x06, 0x0D, 0x96, 0xE8};
  301. uint8_t updateBlock2[] = {0x87, 0x02}; // TODO
  302. void seader_capture_sio(BitBuffer* tx_buffer, BitBuffer* rx_buffer, SeaderCredential* credential) {
  303. const uint8_t* buffer = bit_buffer_get_data(tx_buffer);
  304. size_t len = bit_buffer_get_size_bytes(tx_buffer);
  305. const uint8_t* rxBuffer = bit_buffer_get_data(rx_buffer);
  306. if(memcmp(buffer, read4Block6, len) == 0 && rxBuffer[0] == 0x30) {
  307. memcpy(credential->sio, rxBuffer, 32);
  308. } else if(memcmp(buffer, read4Block10, len) == 0 && rxBuffer[0] == 0x30) {
  309. memcpy(credential->sio, rxBuffer, 32);
  310. } else if(memcmp(buffer, read4Block9, len) == 0) {
  311. memcpy(credential->sio + 32, rxBuffer + 8, 24);
  312. } else if(memcmp(buffer, read4Block13, len) == 0) {
  313. memcpy(credential->sio + 32, rxBuffer + 8, 24);
  314. }
  315. }
  316. PicopassError seader_worker_fake_epurse_update(BitBuffer* tx_buffer, BitBuffer* rx_buffer) {
  317. const uint8_t* buffer = bit_buffer_get_data(tx_buffer);
  318. uint8_t fake_response[10];
  319. memset(fake_response, 0, sizeof(fake_response));
  320. memcpy(fake_response + 0, buffer + 6, 4);
  321. memcpy(fake_response + 4, buffer + 2, 4);
  322. uint16_t crc = seader_worker_picopass_calculate_ccitt(0xE012, fake_response, 8);
  323. memcpy(fake_response + 8, &crc, sizeof(uint16_t));
  324. bit_buffer_append_bytes(rx_buffer, fake_response, sizeof(fake_response));
  325. memset(display, 0, sizeof(display));
  326. for(uint8_t i = 0; i < sizeof(fake_response); i++) {
  327. snprintf(display + (i * 2), sizeof(display), "%02x", fake_response[i]);
  328. }
  329. FURI_LOG_I(TAG, "Fake update E-Purse response: %s", display);
  330. return PicopassErrorNone;
  331. }
  332. void seader_iso15693_transmit(
  333. Seader* seader,
  334. PicopassPoller* picopass_poller,
  335. uint8_t* buffer,
  336. size_t len) {
  337. UNUSED(seader);
  338. UNUSED(buffer);
  339. UNUSED(len);
  340. SeaderWorker* seader_worker = seader->worker;
  341. SeaderUartBridge* seader_uart = seader_worker->uart;
  342. BitBuffer* tx_buffer = bit_buffer_alloc(len);
  343. BitBuffer* rx_buffer = bit_buffer_alloc(SEADER_POLLER_MAX_BUFFER_SIZE);
  344. PicopassError error = PicopassErrorNone;
  345. do {
  346. bit_buffer_append_bytes(tx_buffer, buffer, len);
  347. if(memcmp(buffer, updateBlock2, sizeof(updateBlock2)) == 0) {
  348. error = seader_worker_fake_epurse_update(tx_buffer, rx_buffer);
  349. } else {
  350. error = picopass_poller_send_frame(
  351. picopass_poller, tx_buffer, rx_buffer, SEADER_POLLER_MAX_FWT);
  352. }
  353. if(error == PicopassErrorIncorrectCrc) {
  354. error = PicopassErrorNone;
  355. }
  356. if(error != PicopassErrorNone) {
  357. seader_worker->stage = SeaderPollerEventTypeFail;
  358. break;
  359. }
  360. seader_capture_sio(tx_buffer, rx_buffer, seader->credential);
  361. seader_send_nfc_rx(
  362. seader_uart,
  363. (uint8_t*)bit_buffer_get_data(rx_buffer),
  364. bit_buffer_get_size_bytes(rx_buffer));
  365. } while(false);
  366. bit_buffer_free(tx_buffer);
  367. bit_buffer_free(rx_buffer);
  368. }
  369. /* Assumes this is called in the context of the NFC API callback */
  370. void seader_iso14443a_transmit(
  371. Seader* seader,
  372. Iso14443_4aPoller* iso14443_4a_poller,
  373. uint8_t* buffer,
  374. size_t len,
  375. uint16_t timeout,
  376. uint8_t format[3]) {
  377. UNUSED(timeout);
  378. UNUSED(format);
  379. furi_assert(seader);
  380. furi_assert(buffer);
  381. furi_assert(iso14443_4a_poller);
  382. SeaderWorker* seader_worker = seader->worker;
  383. SeaderUartBridge* seader_uart = seader_worker->uart;
  384. BitBuffer* tx_buffer = bit_buffer_alloc(len);
  385. BitBuffer* rx_buffer = bit_buffer_alloc(SEADER_POLLER_MAX_BUFFER_SIZE);
  386. do {
  387. bit_buffer_append_bytes(tx_buffer, buffer, len);
  388. Iso14443_4aError error =
  389. iso14443_4a_poller_send_block(iso14443_4a_poller, tx_buffer, rx_buffer);
  390. if(error != Iso14443_4aErrorNone) {
  391. FURI_LOG_W(TAG, "iso14443_4a_poller_send_block error %d", error);
  392. seader_worker->stage = SeaderPollerEventTypeFail;
  393. break;
  394. }
  395. seader_send_nfc_rx(
  396. seader_uart,
  397. (uint8_t*)bit_buffer_get_data(rx_buffer),
  398. bit_buffer_get_size_bytes(rx_buffer));
  399. } while(false);
  400. bit_buffer_free(tx_buffer);
  401. bit_buffer_free(rx_buffer);
  402. }
  403. void seader_parse_nfc_command_transmit(
  404. Seader* seader,
  405. NFCSend_t* nfcSend,
  406. SeaderPollerContainer* spc) {
  407. long timeOut = nfcSend->timeOut;
  408. Protocol_t protocol = nfcSend->protocol;
  409. FrameProtocol_t frameProtocol = protocol.buf[1];
  410. #ifdef ASN1_DEBUG
  411. memset(display, 0, sizeof(display));
  412. for(uint8_t i = 0; i < nfcSend->data.size; i++) {
  413. snprintf(display + (i * 2), sizeof(display), "%02x", nfcSend->data.buf[i]);
  414. }
  415. FURI_LOG_D(
  416. TAG,
  417. "Transmit (%ld timeout) %d bytes [%s] via %lx",
  418. timeOut,
  419. nfcSend->data.size,
  420. display,
  421. frameProtocol);
  422. #endif
  423. if(frameProtocol == FrameProtocol_iclass) {
  424. seader_iso15693_transmit(
  425. seader, spc->picopass_poller, nfcSend->data.buf, nfcSend->data.size);
  426. } else if(frameProtocol == FrameProtocol_nfc) {
  427. seader_iso14443a_transmit(
  428. seader,
  429. spc->iso14443_4a_poller,
  430. nfcSend->data.buf,
  431. nfcSend->data.size,
  432. (uint16_t)timeOut,
  433. nfcSend->format->buf);
  434. } else {
  435. FURI_LOG_W(TAG, "unknown frame protocol %lx", frameProtocol);
  436. }
  437. }
  438. void seader_parse_nfc_off(SeaderUartBridge* seader_uart) {
  439. FURI_LOG_D(TAG, "Set Field Off");
  440. NFCResponse_t* nfcResponse = 0;
  441. nfcResponse = calloc(1, sizeof *nfcResponse);
  442. assert(nfcResponse);
  443. nfcResponse->present = NFCResponse_PR_nfcAck;
  444. Response_t* response = 0;
  445. response = calloc(1, sizeof *response);
  446. assert(response);
  447. response->present = Response_PR_nfcResponse;
  448. response->choice.nfcResponse = *nfcResponse;
  449. seader_send_response(seader_uart, response, 0x44, 0x0a, 0);
  450. ASN_STRUCT_FREE(asn_DEF_Response, response);
  451. ASN_STRUCT_FREE(asn_DEF_NFCResponse, nfcResponse);
  452. }
  453. void seader_parse_nfc_command(Seader* seader, NFCCommand_t* nfcCommand, SeaderPollerContainer* spc) {
  454. SeaderWorker* seader_worker = seader->worker;
  455. SeaderUartBridge* seader_uart = seader_worker->uart;
  456. switch(nfcCommand->present) {
  457. case NFCCommand_PR_nfcSend:
  458. seader_parse_nfc_command_transmit(seader, &nfcCommand->choice.nfcSend, spc);
  459. break;
  460. case NFCCommand_PR_nfcOff:
  461. seader_parse_nfc_off(seader_uart);
  462. seader->worker->stage = SeaderPollerEventTypeComplete;
  463. break;
  464. default:
  465. FURI_LOG_W(TAG, "unparsed NFCCommand");
  466. break;
  467. };
  468. }
  469. bool seader_worker_state_machine(
  470. Seader* seader,
  471. Payload_t* payload,
  472. bool online,
  473. SeaderPollerContainer* spc) {
  474. bool processed = false;
  475. switch(payload->present) {
  476. case Payload_PR_response:
  477. seader_parse_response(seader, &payload->choice.response);
  478. processed = true;
  479. break;
  480. case Payload_PR_nfcCommand:
  481. if(online) {
  482. seader_parse_nfc_command(seader, &payload->choice.nfcCommand, spc);
  483. processed = true;
  484. }
  485. break;
  486. case Payload_PR_errorResponse:
  487. FURI_LOG_W(TAG, "Error Response");
  488. processed = true;
  489. view_dispatcher_send_custom_event(seader->view_dispatcher, SeaderCustomEventWorkerExit);
  490. break;
  491. default:
  492. FURI_LOG_W(TAG, "unhandled payload");
  493. break;
  494. };
  495. return processed;
  496. }
  497. bool seader_process_success_response_i(
  498. Seader* seader,
  499. uint8_t* apdu,
  500. size_t len,
  501. bool online,
  502. SeaderPollerContainer* spc) {
  503. Payload_t* payload = 0;
  504. payload = calloc(1, sizeof *payload);
  505. assert(payload);
  506. bool processed = false;
  507. asn_dec_rval_t rval =
  508. asn_decode(0, ATS_DER, &asn_DEF_Payload, (void**)&payload, apdu + 6, len - 6);
  509. if(rval.code == RC_OK) {
  510. processed = seader_worker_state_machine(seader, payload, online, spc);
  511. #ifdef ASN1_DEBUG
  512. if(processed) {
  513. char payloadDebug[384] = {0};
  514. memset(payloadDebug, 0, sizeof(payloadDebug));
  515. (&asn_DEF_Payload)
  516. ->op->print_struct(
  517. &asn_DEF_Payload, payload, 1, seader_print_struct_callback, payloadDebug);
  518. if(strlen(payloadDebug) > 0) {
  519. FURI_LOG_D(TAG, "Payload processed: %s", payloadDebug);
  520. }
  521. }
  522. #endif
  523. } else {
  524. FURI_LOG_D(TAG, "Failed to decode APDU payload");
  525. }
  526. ASN_STRUCT_FREE(asn_DEF_Payload, payload);
  527. return processed;
  528. }
  529. NfcCommand seader_worker_card_detect(
  530. Seader* seader,
  531. uint8_t sak,
  532. uint8_t* atqa,
  533. const uint8_t* uid,
  534. uint8_t uid_len,
  535. uint8_t* ats,
  536. uint8_t ats_len) {
  537. UNUSED(ats);
  538. UNUSED(ats_len);
  539. // We're telling the SAM we've seen a new card, so reset out requestPacs check
  540. requestPacs = true;
  541. SeaderWorker* seader_worker = seader->worker;
  542. SeaderUartBridge* seader_uart = seader_worker->uart;
  543. CardDetails_t* cardDetails = 0;
  544. cardDetails = calloc(1, sizeof *cardDetails);
  545. assert(cardDetails);
  546. OCTET_STRING_fromBuf(&cardDetails->csn, (const char*)uid, uid_len);
  547. OCTET_STRING_t sak_string = {.buf = &sak, .size = 1};
  548. OCTET_STRING_t atqa_string = {.buf = atqa, .size = 2};
  549. uint8_t protocol_bytes[] = {0x00, 0x00};
  550. if(sak == 0 && atqa == NULL) {
  551. protocol_bytes[1] = FrameProtocol_iclass;
  552. OCTET_STRING_fromBuf(
  553. &cardDetails->protocol, (const char*)protocol_bytes, sizeof(protocol_bytes));
  554. } else {
  555. protocol_bytes[1] = FrameProtocol_nfc;
  556. OCTET_STRING_fromBuf(
  557. &cardDetails->protocol, (const char*)protocol_bytes, sizeof(protocol_bytes));
  558. cardDetails->sak = &sak_string;
  559. cardDetails->atqa = &atqa_string;
  560. }
  561. seader_send_card_detected(seader_uart, cardDetails);
  562. ASN_STRUCT_FREE(asn_DEF_CardDetails, cardDetails);
  563. return NfcCommandContinue;
  564. }