[FL-3810] Felica emulation

applications/debug/unit_tests/resources/unit_tests/nfc/Felica.nfc

@@ -0,0 +1,40 @@
+Filetype: Flipper NFC device
+Version: 4
+# Device type can be ISO14443-3A, ISO14443-3B, ISO14443-4A, ISO14443-4B, ISO15693-3, FeliCa, NTAG/Ultralight, Mifare Classic, Mifare DESFire, SLIX, ST25TB
+Device type: FeliCa
+# UID is common for all formats
+UID: 29 9F FA 53 AB 75 87 6E
+# FeliCa specific data
+Data format version: 1
+Manufacture id: 29 9F FA 53 AB 75 87 6E
+Manufacture parameter: 57 4E 10 2A 94 16 BC 8E
+Blocks total: 28
+Blocks read: 28
+Block 0: 00 00 DE AD BE AF 00 00 00 00 00 00 00 00 DE AD BE AF
+Block 1: 00 00 00 11 22 33 44 55 66 77 88 99 AA BB CC DD EE FF
+Block 2: 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00
+Block 3: 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00
+Block 4: 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00
+Block 5: 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00
+Block 6: 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00
+Block 7: 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00
+Block 8: 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00
+Block 9: 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00
+Block 10: 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00
+Block 11: 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00
+Block 12: 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00
+Block 13: 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00
+Block 14: 00 00 FF FF FF FF FF FF FF FF FF FF FF FF FF FF FF FF
+Block 15: 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00
+Block 16: 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00
+Block 17: 00 00 29 9F FA 53 AB 75 87 6E 57 4E 10 2A 94 16 BC 8E
+Block 18: 00 00 29 9F FA 53 AB 75 87 6E 00 F1 00 00 00 01 43 00
+Block 19: 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00
+Block 20: 00 00 88 B4 00 00 00 00 00 00 00 00 00 00 00 00 00 00
+Block 21: 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00
+Block 22: 00 00 FF FF FF FF FF FF FF FF FF FF FF FF FF FF FF FF
+Block 23: 00 00 FF FF FF 00 FF 00 10 00 00 00 00 00 00 00 00 00
+Block 24: 00 00 24 FE FF 00 00 00 00 00 00 00 00 00 00 00 00 00
+Block 25: 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00
+Block 26: 00 00 01 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00
+Block 27: 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 00

applications/debug/unit_tests/tests/nfc/nfc_test.c

@@ -12,6 +12,8 @@
 #include <nfc/protocols/mf_ultralight/mf_ultralight.h>
 #include <nfc/protocols/mf_ultralight/mf_ultralight_poller_sync.h>
 #include <nfc/protocols/mf_classic/mf_classic_poller_sync.h>
+#include <nfc/protocols/felica/felica.h>
+#include <nfc/protocols/felica/felica_poller_sync.h>
 #include <nfc/protocols/mf_classic/mf_classic_poller.h>
 #include <nfc/protocols/iso15693_3/iso15693_3_poller.h>
 #include <nfc/protocols/slix/slix.h>
@@ -646,6 +648,56 @@ MU_TEST(mf_classic_dict_test) {
         "Remove test dict failed");
 }
 
+static FelicaError
+    felica_do_request_response(FelicaData* felica_data, const FelicaCardKey* card_key) {
+    NfcDeviceData* nfc_device = nfc_device_alloc();
+
+    FelicaError error = FelicaErrorNone;
+    if(!nfc_device_load(nfc_device, EXT_PATH("unit_tests/nfc/Felica.nfc"))) {
+        error = FelicaErrorNotPresent;
+    } else {
+        Nfc* poller = nfc_alloc();
+        Nfc* listener = nfc_alloc();
+        NfcListener* felica_listener = nfc_listener_alloc(
+            listener, NfcProtocolFelica, nfc_device_get_data(nfc_device, NfcProtocolFelica));
+        nfc_listener_start(felica_listener, NULL, NULL);
+
+        error = felica_poller_sync_read(poller, felica_data, card_key);
+
+        nfc_listener_stop(felica_listener);
+        nfc_listener_free(felica_listener);
+
+        nfc_free(listener);
+        nfc_free(poller);
+    }
+
+    nfc_device_free(nfc_device);
+    return error;
+}
+
+MU_TEST(felica_read) {
+    FelicaData* felica_data = felica_alloc();
+    FelicaError error = felica_do_request_response(felica_data, NULL);
+    mu_assert(error == FelicaErrorNone, "felica_poller() failed");
+    mu_assert(felica_data->data.fs.spad[4].SF1 == 0x01, "block[4].SF1 != 0x01");
+    mu_assert(felica_data->data.fs.spad[4].SF2 == 0xB1, "block[4].SF2 != 0xB1");
+
+    felica_free(felica_data);
+}
+
+MU_TEST(felica_read_auth) {
+    FelicaData* felica_data = felica_alloc();
+    FelicaCardKey card_key;
+    memset(card_key.data, 0xFF, FELICA_DATA_BLOCK_SIZE);
+
+    FelicaError error = felica_do_request_response(felica_data, &card_key);
+    mu_assert(error == FelicaErrorNone, "felica_poller() failed");
+    mu_assert(felica_data->data.fs.spad[4].SF1 == 0x00, "block[4].SF1 != 0x00");
+    mu_assert(felica_data->data.fs.spad[4].SF2 == 0x00, "block[4].SF2 != 0x00");
+
+    felica_free(felica_data);
+}
+
 MU_TEST(slix_file_with_capabilities_test) {
     NfcDevice* nfc_device_missed_cap = nfc_device_alloc();
     mu_assert(
@@ -807,6 +859,8 @@ MU_TEST_SUITE(nfc) {
     MU_RUN_TEST(mf_classic_value_block);
     MU_RUN_TEST(mf_classic_send_frame_test);
     MU_RUN_TEST(mf_classic_dict_test);
+    MU_RUN_TEST(felica_read);
+    MU_RUN_TEST(felica_read_auth);
 
     MU_RUN_TEST(slix_file_with_capabilities_test);
     MU_RUN_TEST(slix_set_password_default_cap_correct_pass);

applications/main/nfc/helpers/protocol_support/felica/felica.c

@@ -26,12 +26,6 @@ static void nfc_scene_info_on_enter_felica(NfcApp* instance) {
     widget_add_text_scroll_element(
         instance->widget, 0, 0, 128, 48, furi_string_get_cstr(temp_str));
 
-    widget_add_button_element(
-        instance->widget,
-        GuiButtonTypeRight,
-        "More",
-        nfc_protocol_support_common_widget_callback,
-        instance);
     furi_string_free(temp_str);
 }
 
@@ -177,7 +171,7 @@ static bool nfc_scene_read_menu_on_event_felica(NfcApp* instance, SceneManagerEv
 }
 
 const NfcProtocolSupportBase nfc_protocol_support_felica = {
-    .features = NfcProtocolFeatureEmulateUid,
+    .features = NfcProtocolFeatureEmulateFull | NfcProtocolFeatureMoreInfo,
 
     .scene_info =
         {

lib/nfc/SConscript

@@ -41,11 +41,13 @@ env.Append(
         File("protocols/iso14443_4a/iso14443_4a_listener.h"),
         File("protocols/mf_ultralight/mf_ultralight_listener.h"),
         File("protocols/mf_classic/mf_classic_listener.h"),
+        File("protocols/felica/felica_listener.h"),
         # Sync API
         File("protocols/iso14443_3a/iso14443_3a_poller_sync.h"),
         File("protocols/mf_ultralight/mf_ultralight_poller_sync.h"),
         File("protocols/mf_classic/mf_classic_poller_sync.h"),
         File("protocols/st25tb/st25tb_poller_sync.h"),
+        File("protocols/felica/felica_poller_sync.h"),
         # Misc
         File("helpers/nfc_util.h"),
         File("helpers/iso14443_crc.h"),

lib/nfc/helpers/felica_crc.c

@@ -6,6 +6,8 @@
 #define FELICA_CRC_INIT (0x0000U)
 
 uint16_t felica_crc_calculate(const uint8_t* data, size_t length) {
+    furi_check(data);
+
     uint16_t crc = FELICA_CRC_INIT;
 
     for(size_t i = 0; i < length; i++) {
@@ -24,6 +26,7 @@ uint16_t felica_crc_calculate(const uint8_t* data, size_t length) {
 }
 
 void felica_crc_append(BitBuffer* buf) {
+    furi_check(buf);
     const uint8_t* data = bit_buffer_get_data(buf);
     const size_t data_size = bit_buffer_get_size_bytes(buf);
 
@@ -32,6 +35,7 @@ void felica_crc_append(BitBuffer* buf) {
 }
 
 bool felica_crc_check(const BitBuffer* buf) {
+    furi_check(buf);
     const size_t data_size = bit_buffer_get_size_bytes(buf);
     if(data_size <= FELICA_CRC_SIZE) return false;
 
@@ -45,6 +49,7 @@ bool felica_crc_check(const BitBuffer* buf) {
 }
 
 void felica_crc_trim(BitBuffer* buf) {
+    furi_check(buf);
     const size_t data_size = bit_buffer_get_size_bytes(buf);
     furi_assert(data_size > FELICA_CRC_SIZE);
 

lib/nfc/nfc_mock.c

@@ -3,6 +3,9 @@
 #include <lib/nfc/nfc.h>
 #include <lib/nfc/helpers/iso14443_crc.h>
 #include <lib/nfc/protocols/iso14443_3a/iso14443_3a.h>
+#include <lib/nfc/protocols/felica/felica.h>
+#include <lib/nfc/helpers/felica_crc.h>
+#include <lib/nfc/protocols/felica/felica_poller_sync.h>
 
 #include <furi/furi.h>
 
@@ -50,11 +53,31 @@ typedef struct {
     Iso14443_3aSelResp sel_resp[2];
 } Iso14443_3aColResData;
 
+typedef struct {
+    uint8_t length;
+    uint8_t polling_cmd;
+    uint16_t system_code;
+    uint8_t request_code;
+    uint8_t time_slot;
+} FelicaPollingRequest;
+
+typedef struct {
+    uint8_t code;
+    FelicaIDm idm;
+    FelicaPMm pmm;
+} FelicaSensfResData;
+
+typedef struct {
+    uint16_t system_code;
+    FelicaSensfResData sens_res;
+} FelicaPTMemory;
+
 struct Nfc {
     NfcState state;
 
     Iso14443_3aColResStatus col_res_status;
     Iso14443_3aColResData col_res_data;
+    FelicaPTMemory pt_memory;
     bool software_col_res_required;
 
     NfcEventCallback callback;
@@ -243,6 +266,21 @@ static void nfc_worker_listener_pass_col_res(Nfc* instance, uint8_t* rx_data, ui
             NfcEvent event = {.type = NfcEventTypeListenerActivated};
             instance->callback(event, instance->context);
 
+            processed = true;
+        }
+    } else if(rx_bits == 8 * 8) {
+        FelicaPollingRequest* request = (FelicaPollingRequest*)rx_data;
+        if(request->system_code == instance->pt_memory.system_code) {
+            uint8_t response_size = sizeof(FelicaSensfResData) + 1;
+            bit_buffer_reset(tx_buffer);
+            bit_buffer_append_byte(tx_buffer, response_size);
+            bit_buffer_append_bytes(
+                tx_buffer, (uint8_t*)&instance->pt_memory.sens_res, sizeof(FelicaSensfResData));
+            felica_crc_append(tx_buffer);
+            nfc_listener_tx(instance, tx_buffer);
+            instance->col_res_status = Iso14443_3aColResStatusDone;
+            NfcEvent event = {.type = NfcEventTypeListenerActivated};
+            instance->callback(event, instance->context);
             processed = true;
         }
     }
@@ -470,6 +508,12 @@ NfcError nfc_felica_listener_set_sensf_res_data(
     furi_assert(idm_len == 8);
     furi_assert(pmm_len == 8);
 
+    instance->pt_memory.system_code = 0xFFFF;
+    instance->pt_memory.sens_res.code = 0x01;
+    instance->software_col_res_required = true;
+    memcpy(instance->pt_memory.sens_res.idm.data, idm, idm_len);
+    memcpy(instance->pt_memory.sens_res.pmm.data, pmm, pmm_len);
+
     return NfcErrorNone;
 }
 

lib/nfc/protocols/felica/felica.c

@@ -298,15 +298,33 @@ bool felica_check_mac(
     furi_check(blocks);
     furi_check(data);
 
-    uint8_t first_block[8];
     uint8_t mac[8];
-    felica_prepare_first_block(FelicaMACTypeRead, blocks, block_count, first_block);
+    felica_calculate_mac_read(ctx, session_key, rc, blocks, block_count, data, mac);
+
+    uint8_t mac_offset = FELICA_DATA_BLOCK_SIZE * (block_count - 1);
+    uint8_t* mac_ptr = data + mac_offset;
+    return !memcmp(mac, mac_ptr, 8);
+}
 
+void felica_calculate_mac_read(
+    mbedtls_des3_context* ctx,
+    const uint8_t* session_key,
+    const uint8_t* rc,
+    const uint8_t* blocks,
+    const uint8_t block_count,
+    const uint8_t* data,
+    uint8_t* mac) {
+    furi_check(ctx);
+    furi_check(session_key);
+    furi_check(rc);
+    furi_check(blocks);
+    furi_check(data);
+    furi_check(mac);
+
+    uint8_t first_block[8];
+    felica_prepare_first_block(FelicaMACTypeRead, blocks, block_count, first_block);
     uint8_t data_size_without_mac = FELICA_DATA_BLOCK_SIZE * (block_count - 1);
     felica_calculate_mac(ctx, session_key, rc, first_block, data, data_size_without_mac, mac);
-
-    uint8_t* mac_ptr = data + data_size_without_mac;
-    return !memcmp(mac, mac_ptr, 8);
 }
 
 void felica_calculate_mac_write(