sam_api.c 24 KB

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