| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605 |
- #include "passy_reader.h"
- #define ASN_EMIT_DEBUG 0
- #include <lib/asn1/COM.h>
- #define TAG "PassyReader"
- #define PASSY_READER_DG1_CHUNK_SIZE 0x20
- #define PASSY_READER_DG2_CHUNK_SIZE 0x20
- #define PASSY_DG2_LOOKAHEAD 120
- static uint8_t passport_aid[] = {0xA0, 0x00, 0x00, 0x02, 0x47, 0x10, 0x01};
- static uint8_t select_header[] = {0x00, 0xA4, 0x04, 0x0C};
- static uint8_t get_challenge[] = {0x00, 0x84, 0x00, 0x00, 0x08};
- static uint8_t SW_success[] = {0x90, 0x00};
- static const uint8_t jpeg_header[4] = {0xFF, 0xD8, 0xFF, 0xE0};
- static const uint8_t jpeg2k_header[6] = {0x00, 0x00, 0x00, 0x0C, 0x6A, 0x50};
- static const uint8_t jpeg2k_cs_header[4] = {0xFF, 0x4F, 0xFF, 0x51};
- static bool print_logs = true;
- size_t asn1_length(uint8_t data[3]) {
- if(data[0] <= 0x7F) {
- return data[0];
- } else if(data[0] == 0x81) {
- return data[1];
- } else if(data[0] == 0x82) {
- return (data[1] << 8) | data[2];
- }
- return 0;
- }
- size_t asn1_length_length(uint8_t data[3]) {
- if(data[0] <= 0x7F) {
- return 1;
- } else if(data[0] == 0x81) {
- return 2;
- } else if(data[0] == 0x82) {
- return 3;
- }
- return 0;
- }
- PassyReader* passy_reader_alloc(Passy* passy) {
- PassyReader* passy_reader = malloc(sizeof(PassyReader));
- memset(passy_reader, 0, sizeof(PassyReader));
- furi_assert(passy);
- passy_reader->passy = passy;
- passy_reader->DG1 = passy->DG1;
- passy_reader->COM = passy->COM;
- passy_reader->dg_header = passy->dg_header;
- passy_reader->tx_buffer = bit_buffer_alloc(PASSY_READER_MAX_BUFFER_SIZE);
- passy_reader->rx_buffer = bit_buffer_alloc(PASSY_READER_MAX_BUFFER_SIZE);
- char passport_number[11];
- memset(passport_number, 0, sizeof(passport_number));
- memcpy(passport_number, passy->passport_number, strlen(passy->passport_number));
- passport_number[strlen(passy->passport_number)] = passy_checksum(passy->passport_number);
- FURI_LOG_I(TAG, "Passport number: %s", passport_number);
- char date_of_birth[8];
- memset(date_of_birth, 0, sizeof(date_of_birth));
- memcpy(date_of_birth, passy->date_of_birth, strlen(passy->date_of_birth));
- date_of_birth[strlen(passy->date_of_birth)] = passy_checksum(passy->date_of_birth);
- FURI_LOG_I(TAG, "Date of birth: %s", date_of_birth);
- char date_of_expiry[8];
- memset(date_of_expiry, 0, sizeof(date_of_expiry));
- memcpy(date_of_expiry, passy->date_of_expiry, strlen(passy->date_of_expiry));
- date_of_expiry[strlen(passy->date_of_expiry)] = passy_checksum(passy->date_of_expiry);
- FURI_LOG_I(TAG, "Date of expiry: %s", date_of_expiry);
- passy_reader->secure_messaging = secure_messaging_alloc(
- (uint8_t*)passport_number, (uint8_t*)date_of_birth, (uint8_t*)date_of_expiry);
- return passy_reader;
- }
- void passy_reader_free(PassyReader* passy_reader) {
- furi_assert(passy_reader);
- bit_buffer_free(passy_reader->tx_buffer);
- bit_buffer_free(passy_reader->rx_buffer);
- if(passy_reader->secure_messaging) {
- secure_messaging_free(passy_reader->secure_messaging);
- }
- free(passy_reader);
- }
- NfcCommand passy_reader_send(PassyReader* passy_reader) {
- NfcCommand ret = NfcCommandContinue;
- Passy* passy = passy_reader->passy;
- BitBuffer* tx_buffer = passy_reader->tx_buffer;
- BitBuffer* rx_buffer = passy_reader->rx_buffer;
- if(strcmp(passy->proto, "4a") == 0) {
- Iso14443_4aPoller* iso14443_4a_poller = passy_reader->iso14443_4a_poller;
- Iso14443_4aError error;
- if(print_logs) {
- passy_log_bitbuffer(TAG, "NFC transmit", tx_buffer);
- }
- error = iso14443_4a_poller_send_block(iso14443_4a_poller, tx_buffer, rx_buffer);
- if(error != Iso14443_4aErrorNone) {
- FURI_LOG_W(TAG, "iso14443_4a_poller_send_block error %d", error);
- return NfcCommandStop;
- }
- } else if(strcmp(passy->proto, "4b") == 0) {
- Iso14443_4bPoller* iso14443_4b_poller = passy_reader->iso14443_4b_poller;
- Iso14443_4bError error;
- if(print_logs) {
- passy_log_bitbuffer(TAG, "NFC transmit", tx_buffer);
- }
- error = iso14443_4b_poller_send_block(iso14443_4b_poller, tx_buffer, rx_buffer);
- if(error != Iso14443_4bErrorNone) {
- FURI_LOG_W(TAG, "iso14443_4b_poller_send_block error %d", error);
- return NfcCommandStop;
- }
- } else {
- FURI_LOG_W(TAG, "Unknown protocol %s", passy->proto);
- return NfcCommandStop;
- }
- bit_buffer_reset(tx_buffer);
- if(print_logs) {
- passy_log_bitbuffer(TAG, "NFC response", rx_buffer);
- }
- // Check SW
- size_t length = bit_buffer_get_size_bytes(rx_buffer);
- const uint8_t* data = bit_buffer_get_data(rx_buffer);
- if(length < 2) {
- FURI_LOG_W(TAG, "Invalid response length %d", length);
- return NfcCommandStop;
- }
- passy_reader->last_sw = (data[length - 2] << 8) | data[length - 1];
- if(memcmp(data + length - 2, SW_success, sizeof(SW_success)) != 0) {
- FURI_LOG_W(TAG, "Invalid SW %02x %02x", data[length - 2], data[length - 1]);
- return NfcCommandStop;
- }
- return ret;
- }
- NfcCommand passy_reader_select_application(PassyReader* passy_reader) {
- NfcCommand ret = NfcCommandContinue;
- BitBuffer* tx_buffer = passy_reader->tx_buffer;
- bit_buffer_append_bytes(tx_buffer, select_header, sizeof(select_header));
- bit_buffer_append_byte(tx_buffer, sizeof(passport_aid));
- bit_buffer_append_bytes(tx_buffer, passport_aid, sizeof(passport_aid));
- ret = passy_reader_send(passy_reader);
- if(ret != NfcCommandContinue) {
- return ret;
- }
- return ret;
- }
- NfcCommand passy_reader_get_challenge(PassyReader* passy_reader) {
- NfcCommand ret = NfcCommandContinue;
- bit_buffer_append_bytes(passy_reader->tx_buffer, get_challenge, sizeof(get_challenge));
- ret = passy_reader_send(passy_reader);
- if(ret != NfcCommandContinue) {
- return ret;
- }
- const uint8_t* data = bit_buffer_get_data(passy_reader->rx_buffer);
- SecureMessaging* secure_messaging = passy_reader->secure_messaging;
- const uint8_t* rnd_icc = data;
- memcpy(secure_messaging->rndICC, rnd_icc, 8);
- return ret;
- }
- NfcCommand passy_reader_authenticate(PassyReader* passy_reader) {
- NfcCommand ret = NfcCommandContinue;
- BitBuffer* tx_buffer = passy_reader->tx_buffer;
- // TODO: move into secure_messaging
- SecureMessaging* secure_messaging = passy_reader->secure_messaging;
- uint8_t S[32];
- memset(S, 0, sizeof(S));
- uint8_t eifd[32];
- memcpy(S, secure_messaging->rndIFD, sizeof(secure_messaging->rndIFD));
- memcpy(
- S + sizeof(secure_messaging->rndIFD),
- secure_messaging->rndICC,
- sizeof(secure_messaging->rndICC));
- memcpy(
- S + sizeof(secure_messaging->rndIFD) + sizeof(secure_messaging->rndICC),
- secure_messaging->Kifd,
- sizeof(secure_messaging->Kifd));
- uint8_t iv[8];
- memset(iv, 0, sizeof(iv));
- mbedtls_des3_context ctx;
- mbedtls_des3_init(&ctx);
- mbedtls_des3_set2key_enc(&ctx, secure_messaging->KENC);
- mbedtls_des3_crypt_cbc(&ctx, MBEDTLS_DES_ENCRYPT, sizeof(S), iv, S, eifd);
- mbedtls_des3_free(&ctx);
- passy_log_buffer(TAG, "S", S, sizeof(S));
- passy_log_buffer(TAG, "eifd", eifd, sizeof(eifd));
- uint8_t mifd[8];
- passy_mac(secure_messaging->KMAC, eifd, sizeof(eifd), mifd, false);
- passy_log_buffer(TAG, "mifd", mifd, sizeof(mifd));
- uint8_t authenticate_header[] = {0x00, 0x82, 0x00, 0x00};
- bit_buffer_append_bytes(tx_buffer, authenticate_header, sizeof(authenticate_header));
- bit_buffer_append_byte(tx_buffer, sizeof(eifd) + sizeof(mifd));
- bit_buffer_append_bytes(tx_buffer, eifd, sizeof(eifd));
- bit_buffer_append_bytes(tx_buffer, mifd, sizeof(mifd));
- bit_buffer_append_byte(tx_buffer, 0); // Le
- ret = passy_reader_send(passy_reader);
- if(ret != NfcCommandContinue) {
- return ret;
- }
- const uint8_t* data = bit_buffer_get_data(passy_reader->rx_buffer);
- size_t length = bit_buffer_get_size_bytes(passy_reader->rx_buffer);
- const uint8_t* mac = data + length - 2 - 8;
- uint8_t calculated_mac[8];
- passy_mac(secure_messaging->KMAC, (uint8_t*)data, length - 8 - 2, calculated_mac, false);
- if(memcmp(mac, calculated_mac, sizeof(calculated_mac)) != 0) {
- FURI_LOG_W(TAG, "Invalid MAC");
- return NfcCommandStop;
- }
- uint8_t decrypted[32];
- do {
- uint8_t iv[8];
- memset(iv, 0, sizeof(iv));
- mbedtls_des3_context ctx;
- mbedtls_des3_init(&ctx);
- mbedtls_des3_set2key_dec(&ctx, secure_messaging->KENC);
- mbedtls_des3_crypt_cbc(&ctx, MBEDTLS_DES_DECRYPT, length - 2 - 8, iv, data, decrypted);
- mbedtls_des3_free(&ctx);
- } while(false);
- if(print_logs) {
- passy_log_buffer(TAG, "decrypted", decrypted, sizeof(decrypted));
- }
- uint8_t* rnd_icc = decrypted;
- uint8_t* rnd_ifd = decrypted + 8;
- uint8_t* Kicc = decrypted + 16;
- if(memcmp(rnd_icc, secure_messaging->rndICC, sizeof(secure_messaging->rndICC)) != 0) {
- FURI_LOG_W(TAG, "Invalid rndICC");
- return NfcCommandStop;
- }
- memcpy(secure_messaging->Kicc, Kicc, sizeof(secure_messaging->Kicc));
- memcpy(secure_messaging->SSC + 0, rnd_icc + 4, 4);
- memcpy(secure_messaging->SSC + 4, rnd_ifd + 4, 4);
- return ret;
- }
- NfcCommand passy_reader_select_file(PassyReader* passy_reader, uint16_t file_id) {
- NfcCommand ret = NfcCommandContinue;
- uint8_t select_0101[] = {0x00, 0xa4, 0x02, 0x0c, 0x02, 0x00, 0x00};
- select_0101[5] = (file_id >> 8) & 0xFF;
- select_0101[6] = file_id & 0xFF;
- secure_messaging_wrap_apdu(
- passy_reader->secure_messaging, select_0101, sizeof(select_0101), passy_reader->tx_buffer);
- ret = passy_reader_send(passy_reader);
- if(ret != NfcCommandContinue) {
- return ret;
- }
- secure_messaging_unwrap_rapdu(passy_reader->secure_messaging, passy_reader->rx_buffer);
- if(print_logs) {
- passy_log_bitbuffer(TAG, "NFC response (decrypted)", passy_reader->rx_buffer);
- }
- return ret;
- }
- NfcCommand passy_reader_read_binary(
- PassyReader* passy_reader,
- uint16_t offset,
- uint8_t Le,
- uint8_t* output_buffer) {
- NfcCommand ret = NfcCommandContinue;
- if(offset & 0x8000) {
- FURI_LOG_W(TAG, "Invalid offset %04x", offset);
- }
- uint8_t read_binary[] = {0x00, 0xB0, (offset >> 8) & 0xff, (offset >> 0) & 0xff, Le};
- secure_messaging_wrap_apdu(
- passy_reader->secure_messaging, read_binary, sizeof(read_binary), passy_reader->tx_buffer);
- ret = passy_reader_send(passy_reader);
- if(ret != NfcCommandContinue) {
- return ret;
- }
- secure_messaging_unwrap_rapdu(passy_reader->secure_messaging, passy_reader->rx_buffer);
- if(print_logs) {
- passy_log_bitbuffer(TAG, "NFC response (decrypted)", passy_reader->rx_buffer);
- }
- const uint8_t* decrypted_data = bit_buffer_get_data(passy_reader->rx_buffer);
- memcpy(output_buffer, decrypted_data, Le);
- return ret;
- }
- NfcCommand passy_reader_read_com(PassyReader* passy_reader) {
- NfcCommand ret = NfcCommandContinue;
- Passy* passy = passy_reader->passy;
- bit_buffer_reset(passy_reader->COM);
- uint8_t header[4];
- ret = passy_reader_read_binary(passy_reader, 0x00, sizeof(header), header);
- if(ret != NfcCommandContinue) {
- view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
- return ret;
- }
- size_t body_size = 1 + asn1_length_length(header + 1) + asn1_length(header + 1);
- uint8_t body_offset = sizeof(header);
- bit_buffer_append_bytes(passy_reader->COM, header, sizeof(header));
- do {
- view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderReading);
- uint8_t chunk[PASSY_READER_DG1_CHUNK_SIZE];
- uint8_t Le = MIN(sizeof(chunk), (size_t)(body_size - body_offset));
- ret = passy_reader_read_binary(passy_reader, body_offset, Le, chunk);
- if(ret != NfcCommandContinue) {
- view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
- break;
- }
- bit_buffer_append_bytes(passy_reader->COM, chunk, Le);
- body_offset += Le;
- } while(body_offset < body_size);
- return ret;
- }
- NfcCommand passy_reader_read_dg1(PassyReader* passy_reader) {
- NfcCommand ret = NfcCommandContinue;
- Passy* passy = passy_reader->passy;
- bit_buffer_reset(passy->DG1);
- uint8_t header[4];
- ret = passy_reader_read_binary(passy_reader, 0x00, sizeof(header), header);
- if(ret != NfcCommandContinue) {
- view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
- return ret;
- }
- size_t body_size = 1 + asn1_length_length(header + 1) + asn1_length(header + 1);
- uint8_t body_offset = sizeof(header);
- bit_buffer_append_bytes(passy_reader->DG1, header, sizeof(header));
- do {
- view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderReading);
- uint8_t chunk[PASSY_READER_DG1_CHUNK_SIZE];
- uint8_t Le = MIN(sizeof(chunk), (size_t)(body_size - body_offset));
- ret = passy_reader_read_binary(passy_reader, body_offset, Le, chunk);
- if(ret != NfcCommandContinue) {
- view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
- break;
- }
- bit_buffer_append_bytes(passy_reader->DG1, chunk, Le);
- body_offset += Le;
- } while(body_offset < body_size);
- passy_log_bitbuffer(TAG, "DG1", passy_reader->DG1);
- return ret;
- }
- NfcCommand passy_reader_read_dg2_or_dg7(PassyReader* passy_reader) {
- NfcCommand ret = NfcCommandContinue;
- Passy* passy = passy_reader->passy;
- uint8_t header[PASSY_DG2_LOOKAHEAD];
- ret = passy_reader_read_binary(passy_reader, 0x00, sizeof(header) / 2, header);
- if(ret != NfcCommandContinue) {
- view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
- return ret;
- }
- // Issue with reading whole 120 bytes at once, so we read 60 bytes and then
- ret = passy_reader_read_binary(
- passy_reader, sizeof(header) / 2, sizeof(header) / 2, header + sizeof(header) / 2);
- if(ret != NfcCommandContinue) {
- view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
- return ret;
- }
- view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderReading);
- size_t body_size = 1 + asn1_length_length(header + 1) + asn1_length(header + 1);
- FURI_LOG_I(TAG, "%s length: %d", passy->read_type == PassyReadDG2 ? "DG2" : "DG7", body_size);
- void* jpeg = memmem(header, sizeof(header), jpeg_header, sizeof(jpeg_header));
- void* jpeg2k = memmem(header, sizeof(header), jpeg2k_header, sizeof(jpeg2k_header));
- void* jpeg2k_cs = memmem(header, sizeof(header), jpeg2k_cs_header, sizeof(jpeg2k_cs_header));
- FuriString* path = furi_string_alloc();
- uint8_t start = 0;
- const char* dg_type = passy->read_type == PassyReadDG2 ? "DG2" : "DG7";
- char* dg_ext = ".bin";
- if(jpeg) {
- dg_ext = ".jpeg";
- start = (uint8_t*)jpeg - header;
- } else if(jpeg2k) {
- dg_ext = ".jp2";
- start = (uint8_t*)jpeg2k - header;
- } else if(jpeg2k_cs) {
- dg_ext = ".jpc";
- start = (uint8_t*)jpeg2k_cs - header;
- } else {
- furi_string_printf(path, "%s/%s%s", STORAGE_APP_DATA_PATH_PREFIX, dg_type, ".bin");
- start = 0;
- passy_log_buffer(TAG, "header", header, sizeof(header));
- }
- furi_string_printf(path, "%s/%s%s", STORAGE_APP_DATA_PATH_PREFIX, dg_type, dg_ext);
- FURI_LOG_I(TAG, "Writing offset %d to %s", start, furi_string_get_cstr(path));
- Storage* storage = furi_record_open(RECORD_STORAGE);
- Stream* stream = file_stream_alloc(storage);
- file_stream_open(stream, furi_string_get_cstr(path), FSAM_WRITE, FSOM_OPEN_ALWAYS);
- uint8_t chunk[PASSY_READER_DG2_CHUNK_SIZE];
- passy->offset = start;
- passy->bytes_total = body_size;
- do {
- memset(chunk, 0, sizeof(chunk));
- uint8_t Le = MIN(sizeof(chunk), (size_t)(body_size - passy->offset));
- ret = passy_reader_read_binary(passy_reader, passy->offset, Le, chunk);
- if(ret != NfcCommandContinue) {
- view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
- break;
- }
- passy->offset += Le;
- // passy_log_buffer(TAG, "chunk", chunk, sizeof(chunk));
- stream_write(stream, chunk, Le);
- view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderReading);
- } while(passy->offset < body_size);
- file_stream_close(stream);
- furi_record_close(RECORD_STORAGE);
- furi_string_free(path);
- return ret;
- }
- NfcCommand passy_reader_state_machine(PassyReader* passy_reader) {
- furi_assert(passy_reader);
- Passy* passy = passy_reader->passy;
- NfcCommand ret = NfcCommandContinue;
- do {
- ret = passy_reader_select_application(passy_reader);
- if(ret != NfcCommandContinue) {
- view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
- break;
- }
- ret = passy_reader_get_challenge(passy_reader);
- if(ret != NfcCommandContinue) {
- view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
- break;
- }
- ret = passy_reader_authenticate(passy_reader);
- if(ret != NfcCommandContinue) {
- view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
- break;
- }
- FURI_LOG_I(TAG, "Mututal authentication success");
- secure_messaging_calculate_session_keys(passy_reader->secure_messaging);
- view_dispatcher_send_custom_event(
- passy->view_dispatcher, PassyCustomEventReaderAuthenticated);
- ret = passy_reader_select_file(passy_reader, passy->read_type);
- if(ret != NfcCommandContinue) {
- view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
- break;
- }
- if(passy->read_type == PassyReadCOM) {
- ret = passy_reader_read_com(passy_reader);
- } else if(passy->read_type == PassyReadDG1) {
- ret = passy_reader_read_dg1(passy_reader);
- } else if(passy->read_type == PassyReadDG2) {
- print_logs = false;
- ret = passy_reader_read_dg2_or_dg7(passy_reader);
- print_logs = true;
- } else if(passy->read_type == PassyReadDG7) {
- print_logs = false;
- ret = passy_reader_read_dg2_or_dg7(passy_reader);
- print_logs = true;
- } else {
- // Until file specific handling is implemented, we just read the header
- bit_buffer_reset(passy_reader->dg_header);
- uint8_t header[4];
- ret = passy_reader_read_binary(passy_reader, 0x00, sizeof(header), header);
- if(ret != NfcCommandContinue) {
- view_dispatcher_send_custom_event(
- passy->view_dispatcher, PassyCustomEventReaderError);
- break;
- }
- bit_buffer_append_bytes(passy_reader->dg_header, header, sizeof(header));
- }
- // Everything done
- ret = NfcCommandStop;
- view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderSuccess);
- } while(false);
- return ret;
- }
- NfcCommand passy_reader_poller_callback(NfcGenericEvent event, void* context) {
- PassyReader* passy_reader = context;
- NfcCommand ret = NfcCommandContinue;
- Passy* passy = passy_reader->passy;
- if(strcmp(passy->proto, "4a") == 0) {
- furi_assert(event.protocol == NfcProtocolIso14443_4a);
- const Iso14443_4aPollerEvent* iso14443_4a_event = event.event_data;
- Iso14443_4aPoller* iso14443_4a_poller = event.instance;
- FURI_LOG_D(TAG, "iso14443_4a_event->type %i", iso14443_4a_event->type);
- passy_reader->iso14443_4a_poller = iso14443_4a_poller;
- if(iso14443_4a_event->type == Iso14443_4aPollerEventTypeReady) {
- nfc_device_set_data(
- passy_reader->passy->nfc_device,
- NfcProtocolIso14443_4a,
- nfc_poller_get_data(passy_reader->passy->poller));
- ret = passy_reader_state_machine(passy_reader);
- furi_thread_set_current_priority(FuriThreadPriorityLowest);
- } else if(iso14443_4a_event->type == Iso14443_4aPollerEventTypeError) {
- Iso14443_4aPollerEventData* data = iso14443_4a_event->data;
- Iso14443_4aError error = data->error;
- FURI_LOG_W(TAG, "Iso14443_4aError %i", error);
- switch(error) {
- case Iso14443_4aErrorNone:
- break;
- case Iso14443_4aErrorNotPresent:
- break;
- case Iso14443_4aErrorProtocol:
- ret = NfcCommandStop;
- break;
- case Iso14443_4aErrorTimeout:
- break;
- }
- }
- } else if(strcmp(passy->proto, "4b") == 0) {
- furi_assert(event.protocol == NfcProtocolIso14443_4b);
- const Iso14443_4bPollerEvent* iso14443_4b_event = event.event_data;
- Iso14443_4bPoller* iso14443_4b_poller = event.instance;
- FURI_LOG_D(TAG, "iso14443_4b_event->type %i", iso14443_4b_event->type);
- passy_reader->iso14443_4b_poller = iso14443_4b_poller;
- if(iso14443_4b_event->type == Iso14443_4bPollerEventTypeReady) {
- nfc_device_set_data(
- passy_reader->passy->nfc_device,
- NfcProtocolIso14443_4b,
- nfc_poller_get_data(passy_reader->passy->poller));
- ret = passy_reader_state_machine(passy_reader);
- furi_thread_set_current_priority(FuriThreadPriorityLowest);
- } else if(iso14443_4b_event->type == Iso14443_4bPollerEventTypeError) {
- Iso14443_4bPollerEventData* data = iso14443_4b_event->data;
- Iso14443_4bError error = data->error;
- FURI_LOG_W(TAG, "Iso14443_4bError %i", error);
- switch(error) {
- case Iso14443_4bErrorNone:
- break;
- case Iso14443_4bErrorNotPresent:
- break;
- case Iso14443_4bErrorProtocol:
- ret = NfcCommandStop;
- break;
- case Iso14443_4bErrorTimeout:
- break;
- }
- }
- } else {
- view_dispatcher_send_custom_event(passy->view_dispatcher, PassyCustomEventReaderError);
- }
- return ret;
- }
|