sam_api.c 31 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917
  1. #include "sam_api.h"
  2. #include <toolbox/path.h>
  3. #define TAG "SAMAPI"
  4. #define APDU_HEADER_LEN 5
  5. #define ASN1_PREFIX 6
  6. #define ASN1_DEBUG true
  7. #define SEADER_ICLASS_SR_SIO_BASE_BLOCK 10
  8. #define SEADER_SERIAL_FILE_NAME "sam_serial"
  9. const uint8_t picopass_iclass_key[] = {0xaf, 0xa7, 0x85, 0xa7, 0xda, 0xb3, 0x33, 0x78};
  10. static char display[SEADER_UART_RX_BUF_SIZE * 2 + 1] = {0};
  11. char asn1_log[SEADER_UART_RX_BUF_SIZE] = {0};
  12. bool requestPacs = true;
  13. uint8_t read4Block6[] = {RFAL_PICOPASS_CMD_READ4, 0x06, 0x45, 0x56};
  14. uint8_t read4Block9[] = {RFAL_PICOPASS_CMD_READ4, 0x09, 0xB2, 0xAE};
  15. uint8_t read4Block10[] = {RFAL_PICOPASS_CMD_READ4, 0x0A, 0x29, 0x9C};
  16. uint8_t read4Block13[] = {RFAL_PICOPASS_CMD_READ4, 0x0D, 0x96, 0xE8};
  17. //uint8_t read4Block14[] = {RFAL_PICOPASS_CMD_READ4, 0x0E, 0x0d, 0xda};
  18. uint8_t updateBlock2[] = {RFAL_PICOPASS_CMD_UPDATE, 0x02};
  19. uint8_t ev2_request[] =
  20. {0x00, 0xa4, 0x04, 0x00, 0x0a, 0xa0, 0x00, 0x00, 0x04, 0x40, 0x00, 0x01, 0x01, 0x00, 0x01, 0x00};
  21. uint8_t FILE_NOT_FOUND[] = {0x6a, 0x82};
  22. void* calloc(size_t count, size_t size) {
  23. return malloc(count * size);
  24. }
  25. // Forward declarations
  26. void seader_send_nfc_rx(SeaderUartBridge* seader_uart, uint8_t* buffer, size_t len);
  27. PicopassError seader_worker_fake_epurse_update(BitBuffer* tx_buffer, BitBuffer* rx_buffer) {
  28. const uint8_t* buffer = bit_buffer_get_data(tx_buffer);
  29. uint8_t fake_response[8];
  30. memset(fake_response, 0, sizeof(fake_response));
  31. memcpy(fake_response + 0, buffer + 6, 4);
  32. memcpy(fake_response + 4, buffer + 2, 4);
  33. bit_buffer_append_bytes(rx_buffer, fake_response, sizeof(fake_response));
  34. iso13239_crc_append(Iso13239CrcTypePicopass, rx_buffer);
  35. memset(display, 0, sizeof(display));
  36. for(uint8_t i = 0; i < bit_buffer_get_size_bytes(rx_buffer); i++) {
  37. snprintf(display + (i * 2), sizeof(display), "%02x", bit_buffer_get_data(rx_buffer)[i]);
  38. }
  39. FURI_LOG_I(TAG, "Fake update E-Purse response: %s", display);
  40. return PicopassErrorNone;
  41. }
  42. void seader_picopass_state_machine(Seader* seader, uint8_t* buffer, size_t len) {
  43. SeaderWorker* seader_worker = seader->worker;
  44. SeaderUartBridge* seader_uart = seader_worker->uart;
  45. BitBuffer* tx_buffer = bit_buffer_alloc(len);
  46. bit_buffer_append_bytes(tx_buffer, buffer, len);
  47. BitBuffer* rx_buffer = bit_buffer_alloc(SEADER_POLLER_MAX_BUFFER_SIZE);
  48. uint8_t config[PICOPASS_BLOCK_LEN] = {0x12, 0xff, 0xff, 0xff, 0x7f, 0x1f, 0xff, 0x3c};
  49. uint8_t sr_aia[PICOPASS_BLOCK_LEN] = {0xFF, 0xff, 0xff, 0xff, 0xFF, 0xFf, 0xff, 0xFF};
  50. uint8_t epurse[PICOPASS_BLOCK_LEN] = {0xff, 0xff, 0xff, 0xff, 0xe3, 0xff, 0xff, 0xff};
  51. uint8_t pacs_sr_cfg[PICOPASS_BLOCK_LEN] = {0xA3, 0x03, 0x03, 0x03, 0x00, 0x03, 0xe0, 0x14};
  52. uint8_t zeroes[PICOPASS_BLOCK_LEN] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
  53. uint8_t tmac[4] = {};
  54. uint8_t cc_p[12] = {};
  55. uint8_t div_key[PICOPASS_BLOCK_LEN] = {};
  56. uint8_t offset; // for READ4
  57. do {
  58. switch(buffer[0]) {
  59. case RFAL_PICOPASS_CMD_READ_OR_IDENTIFY:
  60. if(buffer[1] == AIA_INDEX) {
  61. bit_buffer_append_bytes(rx_buffer, sr_aia, sizeof(sr_aia));
  62. } else if(buffer[1] == PACS_CFG_INDEX) {
  63. bit_buffer_append_bytes(rx_buffer, pacs_sr_cfg, sizeof(pacs_sr_cfg));
  64. } else { // What i've seen is 0c 12
  65. offset = buffer[1] - SEADER_ICLASS_SR_SIO_BASE_BLOCK;
  66. bit_buffer_append_bytes(
  67. rx_buffer,
  68. seader->credential->sio + (PICOPASS_BLOCK_LEN * offset),
  69. PICOPASS_BLOCK_LEN);
  70. }
  71. iso13239_crc_append(Iso13239CrcTypePicopass, rx_buffer);
  72. break;
  73. case RFAL_PICOPASS_CMD_UPDATE:
  74. seader_worker_fake_epurse_update(tx_buffer, rx_buffer);
  75. break;
  76. case RFAL_PICOPASS_CMD_READCHECK_KD:
  77. if(buffer[1] == EPURSE_INDEX) {
  78. bit_buffer_append_bytes(rx_buffer, epurse, sizeof(epurse));
  79. }
  80. break;
  81. case RFAL_PICOPASS_CMD_CHECK:
  82. loclass_iclass_calc_div_key(
  83. seader->credential->diversifier, picopass_iclass_key, div_key, false);
  84. memcpy(cc_p, epurse, PICOPASS_BLOCK_LEN);
  85. memcpy(cc_p + 8, buffer + 1, PICOPASS_MAC_LEN);
  86. loclass_opt_doTagMAC(cc_p, div_key, tmac);
  87. bit_buffer_append_bytes(rx_buffer, tmac, sizeof(tmac));
  88. break;
  89. case RFAL_PICOPASS_CMD_READ4:
  90. if(buffer[1] < SEADER_ICLASS_SR_SIO_BASE_BLOCK) {
  91. if(buffer[1] == PACS_CFG_INDEX) {
  92. bit_buffer_append_bytes(rx_buffer, pacs_sr_cfg, sizeof(pacs_sr_cfg));
  93. bit_buffer_append_bytes(rx_buffer, zeroes, sizeof(zeroes));
  94. bit_buffer_append_bytes(rx_buffer, zeroes, sizeof(zeroes));
  95. bit_buffer_append_bytes(rx_buffer, zeroes, sizeof(zeroes));
  96. }
  97. } else {
  98. offset = buffer[1] - SEADER_ICLASS_SR_SIO_BASE_BLOCK;
  99. bit_buffer_append_bytes(
  100. rx_buffer,
  101. seader->credential->sio + (PICOPASS_BLOCK_LEN * offset),
  102. PICOPASS_BLOCK_LEN * 4);
  103. }
  104. iso13239_crc_append(Iso13239CrcTypePicopass, rx_buffer);
  105. break;
  106. case RFAL_PICOPASS_CMD_PAGESEL:
  107. // this should be considered an attempt, but realisticly not working
  108. bit_buffer_append_bytes(rx_buffer, config, sizeof(config));
  109. iso13239_crc_append(Iso13239CrcTypePicopass, rx_buffer);
  110. break;
  111. }
  112. seader_send_nfc_rx(
  113. seader_uart,
  114. (uint8_t*)bit_buffer_get_data(rx_buffer),
  115. bit_buffer_get_size_bytes(rx_buffer));
  116. } while(false);
  117. bit_buffer_free(tx_buffer);
  118. bit_buffer_free(rx_buffer);
  119. }
  120. bool seader_send_apdu(
  121. SeaderUartBridge* seader_uart,
  122. uint8_t CLA,
  123. uint8_t INS,
  124. uint8_t P1,
  125. uint8_t P2,
  126. uint8_t* payload,
  127. uint8_t length) {
  128. if(APDU_HEADER_LEN + length > SEADER_UART_RX_BUF_SIZE) {
  129. FURI_LOG_E(TAG, "Cannot send message, too long: %d", APDU_HEADER_LEN + length);
  130. return false;
  131. }
  132. uint8_t apdu[SEADER_UART_RX_BUF_SIZE];
  133. apdu[0] = CLA;
  134. apdu[1] = INS;
  135. apdu[2] = P1;
  136. apdu[3] = P2;
  137. apdu[4] = length;
  138. memcpy(apdu + APDU_HEADER_LEN, payload, length);
  139. memset(display, 0, sizeof(display));
  140. for(uint8_t i = 0; i < APDU_HEADER_LEN + length; i++) {
  141. snprintf(display + (i * 2), sizeof(display), "%02x", apdu[i]);
  142. }
  143. FURI_LOG_D(TAG, "seader_send_apdu %s", display);
  144. seader_ccid_XfrBlock(seader_uart, apdu, APDU_HEADER_LEN + length);
  145. return true;
  146. }
  147. static int seader_print_struct_callback(const void* buffer, size_t size, void* app_key) {
  148. if(app_key) {
  149. char* str = (char*)app_key;
  150. size_t next = strlen(str);
  151. strncpy(str + next, buffer, size);
  152. } else {
  153. uint8_t next = strlen(asn1_log);
  154. strncpy(asn1_log + next, buffer, size);
  155. }
  156. return 0;
  157. }
  158. void seader_send_payload(
  159. SeaderUartBridge* seader_uart,
  160. Payload_t* payload,
  161. uint8_t to,
  162. uint8_t from,
  163. uint8_t replyTo) {
  164. uint8_t rBuffer[SEADER_UART_RX_BUF_SIZE] = {0};
  165. asn_enc_rval_t er = der_encode_to_buffer(
  166. &asn_DEF_Payload, payload, rBuffer + ASN1_PREFIX, sizeof(rBuffer) - ASN1_PREFIX);
  167. #ifdef ASN1_DEBUG
  168. if(er.encoded > -1) {
  169. char payloadDebug[384] = {0};
  170. memset(payloadDebug, 0, sizeof(payloadDebug));
  171. (&asn_DEF_Payload)
  172. ->op->print_struct(
  173. &asn_DEF_Payload, payload, 1, seader_print_struct_callback, payloadDebug);
  174. if(strlen(payloadDebug) > 0) {
  175. FURI_LOG_D(TAG, "Sending payload[%d %d %d]: %s", to, from, replyTo, payloadDebug);
  176. }
  177. }
  178. #endif
  179. //0xa0, 0xda, 0x02, 0x63, 0x00, 0x00, 0x0a,
  180. //0x44, 0x0a, 0x44, 0x00, 0x00, 0x00, 0xa0, 0x02, 0x96, 0x00
  181. rBuffer[0] = to;
  182. rBuffer[1] = from;
  183. rBuffer[2] = replyTo;
  184. seader_send_apdu(seader_uart, 0xA0, 0xDA, 0x02, 0x63, rBuffer, 6 + er.encoded);
  185. }
  186. void seader_send_response(
  187. SeaderUartBridge* seader_uart,
  188. Response_t* response,
  189. uint8_t to,
  190. uint8_t from,
  191. uint8_t replyTo) {
  192. Payload_t* payload = 0;
  193. payload = calloc(1, sizeof *payload);
  194. assert(payload);
  195. payload->present = Payload_PR_response;
  196. payload->choice.response = *response;
  197. seader_send_payload(seader_uart, payload, to, from, replyTo);
  198. ASN_STRUCT_FREE(asn_DEF_Payload, payload);
  199. }
  200. void sendRequestPacs(SeaderUartBridge* seader_uart) {
  201. RequestPacs_t* requestPacs = 0;
  202. requestPacs = calloc(1, sizeof *requestPacs);
  203. assert(requestPacs);
  204. requestPacs->contentElementTag = ContentElementTag_implicitFormatPhysicalAccessBits;
  205. SamCommand_t* samCommand = 0;
  206. samCommand = calloc(1, sizeof *samCommand);
  207. assert(samCommand);
  208. samCommand->present = SamCommand_PR_requestPacs;
  209. samCommand->choice.requestPacs = *requestPacs;
  210. Payload_t* payload = 0;
  211. payload = calloc(1, sizeof *payload);
  212. assert(payload);
  213. payload->present = Payload_PR_samCommand;
  214. payload->choice.samCommand = *samCommand;
  215. seader_send_payload(seader_uart, payload, 0x44, 0x0a, 0x44);
  216. ASN_STRUCT_FREE(asn_DEF_RequestPacs, requestPacs);
  217. ASN_STRUCT_FREE(asn_DEF_SamCommand, samCommand);
  218. ASN_STRUCT_FREE(asn_DEF_Payload, payload);
  219. }
  220. void seader_worker_send_serial_number(SeaderWorker* seader_worker) {
  221. SeaderUartBridge* seader_uart = seader_worker->uart;
  222. SamCommand_t* samCommand = 0;
  223. samCommand = calloc(1, sizeof *samCommand);
  224. assert(samCommand);
  225. samCommand->present = SamCommand_PR_serialNumber;
  226. Payload_t* payload = 0;
  227. payload = calloc(1, sizeof *payload);
  228. assert(payload);
  229. payload->present = Payload_PR_samCommand;
  230. payload->choice.samCommand = *samCommand;
  231. seader_send_payload(seader_uart, payload, 0x44, 0x0a, 0x44);
  232. ASN_STRUCT_FREE(asn_DEF_SamCommand, samCommand);
  233. ASN_STRUCT_FREE(asn_DEF_Payload, payload);
  234. }
  235. void seader_worker_send_version(SeaderWorker* seader_worker) {
  236. SeaderUartBridge* seader_uart = seader_worker->uart;
  237. SamCommand_t* samCommand = 0;
  238. samCommand = calloc(1, sizeof *samCommand);
  239. assert(samCommand);
  240. samCommand->present = SamCommand_PR_version;
  241. Payload_t* payload = 0;
  242. payload = calloc(1, sizeof *payload);
  243. assert(payload);
  244. payload->present = Payload_PR_samCommand;
  245. payload->choice.samCommand = *samCommand;
  246. seader_send_payload(seader_uart, payload, 0x44, 0x0a, 0x44);
  247. ASN_STRUCT_FREE(asn_DEF_SamCommand, samCommand);
  248. ASN_STRUCT_FREE(asn_DEF_Payload, payload);
  249. }
  250. void seader_send_card_detected(SeaderUartBridge* seader_uart, CardDetails_t* cardDetails) {
  251. CardDetected_t* cardDetected = 0;
  252. cardDetected = calloc(1, sizeof *cardDetected);
  253. assert(cardDetected);
  254. cardDetected->detectedCardDetails = *cardDetails;
  255. SamCommand_t* samCommand = 0;
  256. samCommand = calloc(1, sizeof *samCommand);
  257. assert(samCommand);
  258. samCommand->present = SamCommand_PR_cardDetected;
  259. samCommand->choice.cardDetected = *cardDetected;
  260. Payload_t* payload = 0;
  261. payload = calloc(1, sizeof *payload);
  262. assert(payload);
  263. payload->present = Payload_PR_samCommand;
  264. payload->choice.samCommand = *samCommand;
  265. seader_send_payload(seader_uart, payload, 0x44, 0x0a, 0x44);
  266. ASN_STRUCT_FREE(asn_DEF_Payload, payload);
  267. ASN_STRUCT_FREE(asn_DEF_SamCommand, samCommand);
  268. ASN_STRUCT_FREE(asn_DEF_CardDetected, cardDetected);
  269. }
  270. bool seader_unpack_pacs(Seader* seader, uint8_t* buf, size_t size) {
  271. SeaderCredential* seader_credential = seader->credential;
  272. PAC_t* pac = 0;
  273. pac = calloc(1, sizeof *pac);
  274. assert(pac);
  275. bool rtn = false;
  276. asn_dec_rval_t rval = asn_decode(0, ATS_DER, &asn_DEF_PAC, (void**)&pac, buf, size);
  277. if(rval.code == RC_OK) {
  278. char pacDebug[384] = {0};
  279. (&asn_DEF_PAC)
  280. ->op->print_struct(&asn_DEF_PAC, pac, 1, seader_print_struct_callback, pacDebug);
  281. if(strlen(pacDebug) > 0) {
  282. FURI_LOG_D(TAG, "Received pac: %s", pacDebug);
  283. memset(display, 0, sizeof(display));
  284. if(seader_credential->sio[0] == 0x30) {
  285. for(uint8_t i = 0; i < seader_credential->sio_len; i++) {
  286. snprintf(
  287. display + (i * 2), sizeof(display), "%02x", seader_credential->sio[i]);
  288. }
  289. FURI_LOG_D(TAG, "SIO %s", display);
  290. }
  291. }
  292. if(pac->size <= sizeof(seader_credential->credential)) {
  293. // TODO: make credential into a 12 byte array
  294. seader_credential->bit_length = pac->size * 8 - pac->bits_unused;
  295. memcpy(&seader_credential->credential, pac->buf, pac->size);
  296. seader_credential->credential = __builtin_bswap64(seader_credential->credential);
  297. seader_credential->credential = seader_credential->credential >>
  298. (64 - seader_credential->bit_length);
  299. FURI_LOG_D(
  300. TAG,
  301. "credential (%d) %016llx",
  302. seader_credential->bit_length,
  303. seader_credential->credential);
  304. rtn = true;
  305. } else {
  306. // PACS too big (probably bad data)
  307. view_dispatcher_send_custom_event(
  308. seader->view_dispatcher, SeaderCustomEventWorkerExit);
  309. }
  310. }
  311. ASN_STRUCT_FREE(asn_DEF_PAC, pac);
  312. return rtn;
  313. }
  314. // 800201298106683d052026b6820101
  315. //300F800201298106683D052026B6820101
  316. bool seader_parse_version(SeaderWorker* seader_worker, uint8_t* buf, size_t size) {
  317. SamVersion_t* version = 0;
  318. version = calloc(1, sizeof *version);
  319. assert(version);
  320. bool rtn = false;
  321. if(size > 30) {
  322. // Too large to handle now
  323. FURI_LOG_W(TAG, "Version of %d is to long to parse", size);
  324. return false;
  325. }
  326. // Add sequence prefix
  327. uint8_t seq[32] = {0x30};
  328. seq[1] = (uint8_t)size;
  329. memcpy(seq + 2, buf, size);
  330. asn_dec_rval_t rval =
  331. asn_decode(0, ATS_DER, &asn_DEF_SamVersion, (void**)&version, seq, size + 2);
  332. if(rval.code == RC_OK) {
  333. char versionDebug[128] = {0};
  334. (&asn_DEF_SamVersion)
  335. ->op->print_struct(
  336. &asn_DEF_SamVersion, version, 1, seader_print_struct_callback, versionDebug);
  337. if(strlen(versionDebug) > 0) {
  338. FURI_LOG_D(TAG, "Received version: %s", versionDebug);
  339. }
  340. if(version->version.size == 2) {
  341. memcpy(seader_worker->sam_version, version->version.buf, version->version.size);
  342. }
  343. rtn = true;
  344. }
  345. ASN_STRUCT_FREE(asn_DEF_SamVersion, version);
  346. return rtn;
  347. }
  348. bool seader_sam_save_serial(Seader* seader, uint8_t* buf, size_t size) {
  349. SeaderCredential* cred = seader->credential;
  350. const char* file_header = "SAM Serial Number";
  351. const uint32_t file_version = 1;
  352. bool use_load_path = true;
  353. bool saved = false;
  354. FlipperFormat* file = flipper_format_file_alloc(cred->storage);
  355. FuriString* temp_str;
  356. temp_str = furi_string_alloc();
  357. do {
  358. if(use_load_path && !furi_string_empty(cred->load_path)) {
  359. // Get directory name
  360. path_extract_dirname(furi_string_get_cstr(cred->load_path), temp_str);
  361. // Make path to file to save
  362. furi_string_cat_printf(temp_str, "/%s%s", SEADER_SERIAL_FILE_NAME, ".txt");
  363. } else {
  364. furi_string_printf(
  365. temp_str, "%s/%s%s", STORAGE_APP_DATA_PATH_PREFIX, SEADER_SERIAL_FILE_NAME, ".txt");
  366. }
  367. // Open file
  368. if(!flipper_format_file_open_always(file, furi_string_get_cstr(temp_str))) break;
  369. if(!flipper_format_write_header_cstr(file, file_header, file_version)) break;
  370. if(!flipper_format_write_hex(file, "Chip Serial Number", buf, size)) break;
  371. saved = true;
  372. } while(false);
  373. if(!saved) {
  374. dialog_message_show_storage_error(cred->dialogs, "Can not save\nserial file");
  375. }
  376. furi_string_free(temp_str);
  377. flipper_format_free(file);
  378. return saved;
  379. }
  380. bool seader_sam_save_serial_QR(Seader* seader, char* serial) {
  381. SeaderCredential* cred = seader->credential;
  382. const char* file_header = "QRCode";
  383. const uint32_t file_version = 0;
  384. bool saved = false;
  385. FlipperFormat* file = flipper_format_file_alloc(cred->storage);
  386. FuriString* temp_str;
  387. temp_str = furi_string_alloc();
  388. do {
  389. storage_simply_mkdir(cred->storage, EXT_PATH("qrcodes"));
  390. furi_string_printf(
  391. temp_str, "%s/%s%s", EXT_PATH("qrcodes"), "seader_sam_serial", ".qrcode");
  392. // Open file
  393. if(!flipper_format_file_open_always(file, furi_string_get_cstr(temp_str))) break;
  394. if(!flipper_format_write_header_cstr(file, file_header, file_version)) break;
  395. if(!flipper_format_write_string_cstr(file, "Message", serial)) break;
  396. saved = true;
  397. } while(false);
  398. if(!saved) {
  399. dialog_message_show_storage_error(cred->dialogs, "Can not save\nQR file");
  400. }
  401. furi_string_free(temp_str);
  402. flipper_format_free(file);
  403. return saved;
  404. }
  405. bool seader_parse_serial_number(Seader* seader, uint8_t* buf, size_t size) {
  406. memset(display, 0, sizeof(display));
  407. for(uint8_t i = 0; i < size; i++) {
  408. snprintf(display + (i * 2), sizeof(display), "%02x", buf[i]);
  409. }
  410. FURI_LOG_D(TAG, "Received serial: %s", display);
  411. seader_sam_save_serial_QR(seader, display);
  412. return seader_sam_save_serial(seader, buf, size);
  413. }
  414. bool seader_parse_sam_response(Seader* seader, SamResponse_t* samResponse) {
  415. SeaderWorker* seader_worker = seader->worker;
  416. SeaderUartBridge* seader_uart = seader_worker->uart;
  417. if(samResponse->size == 0) {
  418. if(requestPacs) {
  419. FURI_LOG_D(TAG, "samResponse %d => requesting PACS", samResponse->size);
  420. sendRequestPacs(seader_uart);
  421. requestPacs = false;
  422. } else {
  423. FURI_LOG_D(
  424. TAG, "samResponse %d, PACS already requested, pushing view", samResponse->size);
  425. view_dispatcher_send_custom_event(
  426. seader->view_dispatcher, SeaderCustomEventWorkerExit);
  427. }
  428. } else if(seader_parse_version(seader_worker, samResponse->buf, samResponse->size)) {
  429. seader_worker_send_serial_number(seader_worker);
  430. } else if(seader_parse_serial_number(seader, samResponse->buf, samResponse->size)) {
  431. // no-op
  432. } else if(seader_unpack_pacs(seader, samResponse->buf, samResponse->size)) {
  433. view_dispatcher_send_custom_event(seader->view_dispatcher, SeaderCustomEventPollerSuccess);
  434. } else {
  435. memset(display, 0, sizeof(display));
  436. for(uint8_t i = 0; i < samResponse->size; i++) {
  437. snprintf(display + (i * 2), sizeof(display), "%02x", samResponse->buf[i]);
  438. }
  439. FURI_LOG_D(TAG, "Unknown samResponse %d: %s", samResponse->size, display);
  440. }
  441. return false;
  442. }
  443. bool seader_parse_response(Seader* seader, Response_t* response) {
  444. switch(response->present) {
  445. case Response_PR_samResponse:
  446. seader_parse_sam_response(seader, &response->choice.samResponse);
  447. break;
  448. default:
  449. FURI_LOG_D(TAG, "non-sam response");
  450. break;
  451. };
  452. return false;
  453. }
  454. void seader_send_nfc_rx(SeaderUartBridge* seader_uart, uint8_t* buffer, size_t len) {
  455. OCTET_STRING_t rxData = {.buf = buffer, .size = len};
  456. uint8_t status[] = {0x00, 0x00};
  457. RfStatus_t rfStatus = {.buf = status, .size = 2};
  458. NFCRx_t* nfcRx = 0;
  459. nfcRx = calloc(1, sizeof *nfcRx);
  460. assert(nfcRx);
  461. nfcRx->rfStatus = rfStatus;
  462. nfcRx->data = &rxData;
  463. NFCResponse_t* nfcResponse = 0;
  464. nfcResponse = calloc(1, sizeof *nfcResponse);
  465. assert(nfcResponse);
  466. nfcResponse->present = NFCResponse_PR_nfcRx;
  467. nfcResponse->choice.nfcRx = *nfcRx;
  468. Response_t* response = 0;
  469. response = calloc(1, sizeof *response);
  470. assert(response);
  471. response->present = Response_PR_nfcResponse;
  472. response->choice.nfcResponse = *nfcResponse;
  473. seader_send_response(seader_uart, response, 0x14, 0x0a, 0x0);
  474. ASN_STRUCT_FREE(asn_DEF_NFCRx, nfcRx);
  475. ASN_STRUCT_FREE(asn_DEF_NFCResponse, nfcResponse);
  476. ASN_STRUCT_FREE(asn_DEF_Response, response);
  477. }
  478. void seader_capture_sio(BitBuffer* tx_buffer, BitBuffer* rx_buffer, SeaderCredential* credential) {
  479. const uint8_t* buffer = bit_buffer_get_data(tx_buffer);
  480. size_t len = bit_buffer_get_size_bytes(tx_buffer);
  481. const uint8_t* rxBuffer = bit_buffer_get_data(rx_buffer);
  482. if(credential->type == SeaderCredentialTypePicopass) {
  483. if(memcmp(buffer, read4Block6, len) == 0 && rxBuffer[0] == 0x30) {
  484. memcpy(credential->sio, rxBuffer, 32);
  485. credential->sio_len += 32;
  486. } else if(memcmp(buffer, read4Block10, len) == 0 && rxBuffer[0] == 0x30) {
  487. memcpy(credential->sio, rxBuffer, 32);
  488. credential->sio_len += 32;
  489. } else if(memcmp(buffer, read4Block9, len) == 0) {
  490. memcpy(credential->sio + 32, rxBuffer + 8, 24);
  491. credential->sio_len += 24;
  492. } else if(memcmp(buffer, read4Block13, len) == 0) {
  493. memcpy(credential->sio + 32, rxBuffer + 8, 24);
  494. credential->sio_len += 24;
  495. }
  496. } else if(credential->type == SeaderCredentialType14A) {
  497. // Desfire EV1 passes SIO in the clear
  498. uint8_t desfire_read[] = {
  499. 0x90, 0xbd, 0x00, 0x00, 0x07, 0x0f, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
  500. if(memcmp(buffer, desfire_read, len) == 0 && rxBuffer[0] == 0x30) {
  501. credential->sio_len =
  502. bit_buffer_get_size_bytes(rx_buffer) - 2; // -2 for the APDU response bytes
  503. memcpy(credential->sio, rxBuffer, credential->sio_len);
  504. }
  505. }
  506. }
  507. void seader_iso15693_transmit(
  508. Seader* seader,
  509. PicopassPoller* picopass_poller,
  510. uint8_t* buffer,
  511. size_t len) {
  512. UNUSED(seader);
  513. UNUSED(buffer);
  514. UNUSED(len);
  515. SeaderWorker* seader_worker = seader->worker;
  516. SeaderUartBridge* seader_uart = seader_worker->uart;
  517. BitBuffer* tx_buffer = bit_buffer_alloc(len);
  518. BitBuffer* rx_buffer = bit_buffer_alloc(SEADER_POLLER_MAX_BUFFER_SIZE);
  519. PicopassError error = PicopassErrorNone;
  520. do {
  521. bit_buffer_append_bytes(tx_buffer, buffer, len);
  522. if(memcmp(buffer, updateBlock2, sizeof(updateBlock2)) == 0) {
  523. error = seader_worker_fake_epurse_update(tx_buffer, rx_buffer);
  524. } else {
  525. error = picopass_poller_send_frame(
  526. picopass_poller, tx_buffer, rx_buffer, SEADER_POLLER_MAX_FWT);
  527. }
  528. if(error == PicopassErrorIncorrectCrc) {
  529. error = PicopassErrorNone;
  530. }
  531. if(error != PicopassErrorNone) {
  532. seader_worker->stage = SeaderPollerEventTypeFail;
  533. break;
  534. }
  535. seader_capture_sio(tx_buffer, rx_buffer, seader->credential);
  536. seader_send_nfc_rx(
  537. seader_uart,
  538. (uint8_t*)bit_buffer_get_data(rx_buffer),
  539. bit_buffer_get_size_bytes(rx_buffer));
  540. } while(false);
  541. bit_buffer_free(tx_buffer);
  542. bit_buffer_free(rx_buffer);
  543. }
  544. /* Assumes this is called in the context of the NFC API callback */
  545. void seader_iso14443a_transmit(
  546. Seader* seader,
  547. Iso14443_4aPoller* iso14443_4a_poller,
  548. uint8_t* buffer,
  549. size_t len,
  550. uint16_t timeout,
  551. uint8_t format[3]) {
  552. UNUSED(timeout);
  553. UNUSED(format);
  554. furi_assert(seader);
  555. furi_assert(buffer);
  556. furi_assert(iso14443_4a_poller);
  557. SeaderWorker* seader_worker = seader->worker;
  558. SeaderUartBridge* seader_uart = seader_worker->uart;
  559. SeaderCredential* credential = seader->credential;
  560. BitBuffer* tx_buffer = bit_buffer_alloc(len);
  561. BitBuffer* rx_buffer = bit_buffer_alloc(SEADER_POLLER_MAX_BUFFER_SIZE);
  562. do {
  563. if(credential->isDesfire && memcmp(buffer, ev2_request, len) == 0) {
  564. FURI_LOG_I(TAG, "Intercept Desfire EV2 response and return File Not Found");
  565. bit_buffer_append_bytes(rx_buffer, FILE_NOT_FOUND, sizeof(FILE_NOT_FOUND));
  566. } else {
  567. bit_buffer_append_bytes(tx_buffer, buffer, len);
  568. Iso14443_4aError error =
  569. iso14443_4a_poller_send_block(iso14443_4a_poller, tx_buffer, rx_buffer);
  570. if(error != Iso14443_4aErrorNone) {
  571. FURI_LOG_W(TAG, "iso14443_4a_poller_send_block error %d", error);
  572. seader_worker->stage = SeaderPollerEventTypeFail;
  573. break;
  574. }
  575. }
  576. seader_capture_sio(tx_buffer, rx_buffer, credential);
  577. seader_send_nfc_rx(
  578. seader_uart,
  579. (uint8_t*)bit_buffer_get_data(rx_buffer),
  580. bit_buffer_get_size_bytes(rx_buffer));
  581. } while(false);
  582. bit_buffer_free(tx_buffer);
  583. bit_buffer_free(rx_buffer);
  584. }
  585. void seader_parse_nfc_command_transmit(
  586. Seader* seader,
  587. NFCSend_t* nfcSend,
  588. SeaderPollerContainer* spc) {
  589. long timeOut = nfcSend->timeOut;
  590. Protocol_t protocol = nfcSend->protocol;
  591. FrameProtocol_t frameProtocol = protocol.buf[1];
  592. #ifdef ASN1_DEBUG
  593. memset(display, 0, sizeof(display));
  594. for(uint8_t i = 0; i < nfcSend->data.size; i++) {
  595. snprintf(display + (i * 2), sizeof(display), "%02x", nfcSend->data.buf[i]);
  596. }
  597. FURI_LOG_D(
  598. TAG,
  599. "Transmit (%ld timeout) %d bytes [%s] via %lx",
  600. timeOut,
  601. nfcSend->data.size,
  602. display,
  603. frameProtocol);
  604. #endif
  605. if(seader->credential->type == SeaderCredentialTypeVirtual) {
  606. seader_picopass_state_machine(seader, nfcSend->data.buf, nfcSend->data.size);
  607. } else if(frameProtocol == FrameProtocol_iclass) {
  608. seader_iso15693_transmit(
  609. seader, spc->picopass_poller, nfcSend->data.buf, nfcSend->data.size);
  610. } else if(frameProtocol == FrameProtocol_nfc) {
  611. seader_iso14443a_transmit(
  612. seader,
  613. spc->iso14443_4a_poller,
  614. nfcSend->data.buf,
  615. nfcSend->data.size,
  616. (uint16_t)timeOut,
  617. nfcSend->format->buf);
  618. } else {
  619. FURI_LOG_W(TAG, "unknown frame protocol %lx", frameProtocol);
  620. }
  621. }
  622. void seader_parse_nfc_off(SeaderUartBridge* seader_uart) {
  623. FURI_LOG_D(TAG, "Set Field Off");
  624. NFCResponse_t* nfcResponse = 0;
  625. nfcResponse = calloc(1, sizeof *nfcResponse);
  626. assert(nfcResponse);
  627. nfcResponse->present = NFCResponse_PR_nfcAck;
  628. Response_t* response = 0;
  629. response = calloc(1, sizeof *response);
  630. assert(response);
  631. response->present = Response_PR_nfcResponse;
  632. response->choice.nfcResponse = *nfcResponse;
  633. seader_send_response(seader_uart, response, 0x44, 0x0a, 0);
  634. ASN_STRUCT_FREE(asn_DEF_Response, response);
  635. ASN_STRUCT_FREE(asn_DEF_NFCResponse, nfcResponse);
  636. }
  637. void seader_parse_nfc_command(Seader* seader, NFCCommand_t* nfcCommand, SeaderPollerContainer* spc) {
  638. SeaderWorker* seader_worker = seader->worker;
  639. SeaderUartBridge* seader_uart = seader_worker->uart;
  640. switch(nfcCommand->present) {
  641. case NFCCommand_PR_nfcSend:
  642. seader_parse_nfc_command_transmit(seader, &nfcCommand->choice.nfcSend, spc);
  643. break;
  644. case NFCCommand_PR_nfcOff:
  645. seader_parse_nfc_off(seader_uart);
  646. seader->worker->stage = SeaderPollerEventTypeComplete;
  647. break;
  648. default:
  649. FURI_LOG_W(TAG, "unparsed NFCCommand");
  650. break;
  651. };
  652. }
  653. bool seader_worker_state_machine(
  654. Seader* seader,
  655. Payload_t* payload,
  656. bool online,
  657. SeaderPollerContainer* spc) {
  658. bool processed = false;
  659. switch(payload->present) {
  660. case Payload_PR_response:
  661. seader_parse_response(seader, &payload->choice.response);
  662. processed = true;
  663. break;
  664. case Payload_PR_nfcCommand:
  665. if(online) {
  666. seader_parse_nfc_command(seader, &payload->choice.nfcCommand, spc);
  667. processed = true;
  668. }
  669. break;
  670. case Payload_PR_errorResponse:
  671. FURI_LOG_W(TAG, "Error Response");
  672. processed = true;
  673. view_dispatcher_send_custom_event(seader->view_dispatcher, SeaderCustomEventWorkerExit);
  674. break;
  675. default:
  676. FURI_LOG_W(TAG, "unhandled payload");
  677. break;
  678. };
  679. return processed;
  680. }
  681. bool seader_process_success_response_i(
  682. Seader* seader,
  683. uint8_t* apdu,
  684. size_t len,
  685. bool online,
  686. SeaderPollerContainer* spc) {
  687. Payload_t* payload = 0;
  688. payload = calloc(1, sizeof *payload);
  689. assert(payload);
  690. bool processed = false;
  691. asn_dec_rval_t rval =
  692. asn_decode(0, ATS_DER, &asn_DEF_Payload, (void**)&payload, apdu + 6, len - 6);
  693. if(rval.code == RC_OK) {
  694. #ifdef ASN1_DEBUG
  695. if(online == false) {
  696. char payloadDebug[384] = {0};
  697. memset(payloadDebug, 0, sizeof(payloadDebug));
  698. (&asn_DEF_Payload)
  699. ->op->print_struct(
  700. &asn_DEF_Payload, payload, 1, seader_print_struct_callback, payloadDebug);
  701. if(strlen(payloadDebug) > 0) {
  702. FURI_LOG_D(TAG, "Payload: %s", payloadDebug);
  703. }
  704. }
  705. #endif
  706. processed = seader_worker_state_machine(seader, payload, online, spc);
  707. } else {
  708. memset(display, 0, sizeof(display));
  709. for(uint8_t i = 0; i < len; i++) {
  710. snprintf(display + (i * 2), sizeof(display), "%02x", apdu[i]);
  711. }
  712. FURI_LOG_D(TAG, "Failed to decode APDU payload: [%s]", display);
  713. }
  714. ASN_STRUCT_FREE(asn_DEF_Payload, payload);
  715. return processed;
  716. }
  717. bool seader_mf_df_check_card_type(uint8_t ATQA0, uint8_t ATQA1, uint8_t SAK) {
  718. return ATQA0 == 0x44 && ATQA1 == 0x03 && SAK == 0x20;
  719. }
  720. NfcCommand seader_worker_card_detect(
  721. Seader* seader,
  722. uint8_t sak,
  723. uint8_t* atqa,
  724. const uint8_t* uid,
  725. uint8_t uid_len,
  726. uint8_t* ats,
  727. uint8_t ats_len) {
  728. UNUSED(ats);
  729. UNUSED(ats_len);
  730. // We're telling the SAM we've seen a new card, so reset out requestPacs check
  731. requestPacs = true;
  732. SeaderWorker* seader_worker = seader->worker;
  733. SeaderUartBridge* seader_uart = seader_worker->uart;
  734. SeaderCredential* credential = seader->credential;
  735. CardDetails_t* cardDetails = 0;
  736. cardDetails = calloc(1, sizeof *cardDetails);
  737. assert(cardDetails);
  738. OCTET_STRING_fromBuf(&cardDetails->csn, (const char*)uid, uid_len);
  739. OCTET_STRING_t sak_string = {.buf = &sak, .size = 1};
  740. OCTET_STRING_t atqa_string = {.buf = atqa, .size = 2};
  741. uint8_t protocol_bytes[] = {0x00, 0x00};
  742. if(sak == 0 && atqa == NULL) {
  743. protocol_bytes[1] = FrameProtocol_iclass;
  744. OCTET_STRING_fromBuf(
  745. &cardDetails->protocol, (const char*)protocol_bytes, sizeof(protocol_bytes));
  746. memcpy(credential->diversifier, uid, uid_len);
  747. credential->diversifier_len = uid_len;
  748. credential->isDesfire = false;
  749. } else {
  750. protocol_bytes[1] = FrameProtocol_nfc;
  751. OCTET_STRING_fromBuf(
  752. &cardDetails->protocol, (const char*)protocol_bytes, sizeof(protocol_bytes));
  753. cardDetails->sak = &sak_string;
  754. cardDetails->atqa = &atqa_string;
  755. credential->isDesfire = seader_mf_df_check_card_type(atqa[0], atqa[1], sak);
  756. if(credential->isDesfire) {
  757. memcpy(credential->diversifier, uid, uid_len);
  758. credential->diversifier_len = uid_len;
  759. }
  760. }
  761. seader_send_card_detected(seader_uart, cardDetails);
  762. ASN_STRUCT_FREE(asn_DEF_CardDetails, cardDetails);
  763. return NfcCommandContinue;
  764. }