sam_api.c 23 KB

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