mirror of
https://github.com/Next-Flip/Momentum-Firmware.git
synced 2026-07-08 23:08:10 -07:00
Merge branch 'ofw_dev' into dev [ci skip]
This commit is contained in:
@@ -21,7 +21,7 @@ bool elf_resolve_from_hashtable(
|
||||
auto find_res =
|
||||
std::lower_bound(hashtable_interface->table_cbegin, hashtable_interface->table_cend, key);
|
||||
if((find_res == hashtable_interface->table_cend || (find_res->hash != hash))) {
|
||||
FURI_LOG_W(
|
||||
FURI_LOG_T(
|
||||
TAG, "Can't find symbol with hash %lx @ %p!", hash, hashtable_interface->table_cbegin);
|
||||
result = false;
|
||||
} else {
|
||||
|
||||
@@ -35,26 +35,16 @@ static void nfc_generate_mf_ul_uid(uint8_t* uid) {
|
||||
}
|
||||
|
||||
static void nfc_generate_mf_ul_common(MfUltralightData* mfu_data) {
|
||||
uint8_t uid[7];
|
||||
mfu_data->iso14443_3a_data->uid_len = 7;
|
||||
nfc_generate_mf_ul_uid(mfu_data->iso14443_3a_data->uid);
|
||||
nfc_generate_mf_ul_uid(uid);
|
||||
mf_ultralight_set_uid(mfu_data, uid, 7);
|
||||
|
||||
mfu_data->iso14443_3a_data->atqa[0] = 0x44;
|
||||
mfu_data->iso14443_3a_data->atqa[1] = 0x00;
|
||||
mfu_data->iso14443_3a_data->sak = 0x00;
|
||||
}
|
||||
|
||||
static void nfc_generate_calc_bcc(uint8_t* uid, uint8_t* bcc0, uint8_t* bcc1) {
|
||||
*bcc0 = 0x88 ^ uid[0] ^ uid[1] ^ uid[2];
|
||||
*bcc1 = uid[3] ^ uid[4] ^ uid[5] ^ uid[6];
|
||||
}
|
||||
|
||||
static void nfc_generate_mf_ul_copy_uid_with_bcc(MfUltralightData* mfu_data) {
|
||||
memcpy(mfu_data->page[0].data, mfu_data->iso14443_3a_data->uid, 3);
|
||||
memcpy(mfu_data->page[1].data, &mfu_data->iso14443_3a_data->uid[3], 4);
|
||||
|
||||
nfc_generate_calc_bcc(
|
||||
mfu_data->iso14443_3a_data->uid, &mfu_data->page[0].data[3], &mfu_data->page[2].data[0]);
|
||||
}
|
||||
|
||||
static void nfc_generate_mf_ul_orig(NfcDevice* nfc_device) {
|
||||
MfUltralightData* mfu_data = mf_ultralight_alloc();
|
||||
nfc_generate_mf_ul_common(mfu_data);
|
||||
@@ -62,7 +52,6 @@ static void nfc_generate_mf_ul_orig(NfcDevice* nfc_device) {
|
||||
mfu_data->type = MfUltralightTypeUnknown;
|
||||
mfu_data->pages_total = 16;
|
||||
mfu_data->pages_read = 16;
|
||||
nfc_generate_mf_ul_copy_uid_with_bcc(mfu_data);
|
||||
memset(&mfu_data->page[4], 0xff, sizeof(MfUltralightPage));
|
||||
|
||||
nfc_device_set_data(nfc_device, NfcProtocolMfUltralight, mfu_data);
|
||||
@@ -74,7 +63,7 @@ static void nfc_generate_mf_ul_with_config_common(MfUltralightData* mfu_data, ui
|
||||
|
||||
mfu_data->pages_total = num_pages;
|
||||
mfu_data->pages_read = num_pages;
|
||||
nfc_generate_mf_ul_copy_uid_with_bcc(mfu_data);
|
||||
|
||||
uint16_t config_index = (num_pages - 4);
|
||||
mfu_data->page[config_index].data[0] = 0x04; // STRG_MOD_EN
|
||||
mfu_data->page[config_index].data[3] = 0xff; // AUTH0
|
||||
@@ -150,7 +139,6 @@ static void nfc_generate_ntag203(NfcDevice* nfc_device) {
|
||||
mfu_data->type = MfUltralightTypeNTAG203;
|
||||
mfu_data->pages_total = 42;
|
||||
mfu_data->pages_read = 42;
|
||||
nfc_generate_mf_ul_copy_uid_with_bcc(mfu_data);
|
||||
mfu_data->page[2].data[1] = 0x48; // Internal byte
|
||||
memcpy(&mfu_data->page[3], default_data_ntag203, sizeof(MfUltralightPage)); //-V1086
|
||||
|
||||
@@ -379,14 +367,7 @@ static void nfc_generate_mf_classic_block_0(
|
||||
furi_assert(uid_len == 4 || uid_len == 7);
|
||||
furi_assert(block);
|
||||
|
||||
if(uid_len == 4) {
|
||||
// Calculate BCC
|
||||
block[uid_len] = 0;
|
||||
|
||||
for(int i = 0; i < uid_len; i++) {
|
||||
block[uid_len] ^= block[i];
|
||||
}
|
||||
} else {
|
||||
if(uid_len == 7) {
|
||||
uid_len -= 1;
|
||||
}
|
||||
|
||||
@@ -402,14 +383,12 @@ static void nfc_generate_mf_classic_block_0(
|
||||
static void nfc_generate_mf_classic(NfcDevice* nfc_device, uint8_t uid_len, MfClassicType type) {
|
||||
MfClassicData* mfc_data = mf_classic_alloc();
|
||||
|
||||
nfc_generate_mf_classic_uid(mfc_data->block[0].data, uid_len);
|
||||
nfc_generate_mf_classic_common(mfc_data, uid_len, type);
|
||||
uint8_t uid[ISO14443_3A_MAX_UID_SIZE];
|
||||
|
||||
// Set the UID
|
||||
mfc_data->iso14443_3a_data->uid[0] = NXP_MANUFACTURER_ID;
|
||||
for(int i = 1; i < uid_len; i++) {
|
||||
mfc_data->iso14443_3a_data->uid[i] = mfc_data->block[0].data[i];
|
||||
}
|
||||
nfc_generate_mf_classic_uid(uid, uid_len);
|
||||
mf_classic_set_uid(mfc_data, uid, uid_len);
|
||||
|
||||
nfc_generate_mf_classic_common(mfc_data, uid_len, type);
|
||||
|
||||
mf_classic_set_block_read(mfc_data, 0, &mfc_data->block[0]);
|
||||
|
||||
|
||||
@@ -32,17 +32,7 @@ static Iso15693_3Error iso15693_3_poller_filter_error(Iso15693_3Error error) {
|
||||
}
|
||||
}
|
||||
|
||||
static Iso15693_3Error iso15693_3_poller_prepare_trx(Iso15693_3Poller* instance) {
|
||||
furi_assert(instance);
|
||||
|
||||
if(instance->state == Iso15693_3PollerStateIdle) {
|
||||
return iso15693_3_poller_activate(instance, NULL);
|
||||
}
|
||||
|
||||
return Iso15693_3ErrorNone;
|
||||
}
|
||||
|
||||
static Iso15693_3Error iso15693_3_poller_frame_exchange(
|
||||
Iso15693_3Error iso15693_3_poller_send_frame(
|
||||
Iso15693_3Poller* instance,
|
||||
const BitBuffer* tx_buffer,
|
||||
BitBuffer* rx_buffer,
|
||||
@@ -156,7 +146,7 @@ Iso15693_3Error iso15693_3_poller_inventory(Iso15693_3Poller* instance, uint8_t*
|
||||
Iso15693_3Error ret;
|
||||
|
||||
do {
|
||||
ret = iso15693_3_poller_frame_exchange(
|
||||
ret = iso15693_3_poller_send_frame(
|
||||
instance, instance->tx_buffer, instance->rx_buffer, ISO15693_3_FDT_POLL_FC);
|
||||
if(ret != Iso15693_3ErrorNone) break;
|
||||
|
||||
@@ -183,7 +173,7 @@ Iso15693_3Error
|
||||
Iso15693_3Error ret;
|
||||
|
||||
do {
|
||||
ret = iso15693_3_poller_frame_exchange(
|
||||
ret = iso15693_3_poller_send_frame(
|
||||
instance, instance->tx_buffer, instance->rx_buffer, ISO15693_3_FDT_POLL_FC);
|
||||
if(ret != Iso15693_3ErrorNone) break;
|
||||
|
||||
@@ -284,20 +274,3 @@ Iso15693_3Error iso15693_3_poller_get_blocks_security(
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
Iso15693_3Error iso15693_3_poller_send_frame(
|
||||
Iso15693_3Poller* instance,
|
||||
const BitBuffer* tx_buffer,
|
||||
BitBuffer* rx_buffer,
|
||||
uint32_t fwt) {
|
||||
Iso15693_3Error ret;
|
||||
|
||||
do {
|
||||
ret = iso15693_3_poller_prepare_trx(instance);
|
||||
if(ret != Iso15693_3ErrorNone) break;
|
||||
|
||||
ret = iso15693_3_poller_frame_exchange(instance, tx_buffer, rx_buffer, fwt);
|
||||
} while(false);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
@@ -346,7 +346,25 @@ const uint8_t* mf_classic_get_uid(const MfClassicData* data, size_t* uid_len) {
|
||||
bool mf_classic_set_uid(MfClassicData* data, const uint8_t* uid, size_t uid_len) {
|
||||
furi_assert(data);
|
||||
|
||||
return iso14443_3a_set_uid(data->iso14443_3a_data, uid, uid_len);
|
||||
bool uid_valid = iso14443_3a_set_uid(data->iso14443_3a_data, uid, uid_len);
|
||||
|
||||
if(uid_valid) {
|
||||
uint8_t* block = data->block[0].data;
|
||||
|
||||
// Copy UID to block 0
|
||||
memcpy(block, data->iso14443_3a_data->uid, uid_len);
|
||||
|
||||
if(uid_len == 4) {
|
||||
// Calculate BCC byte
|
||||
block[uid_len] = 0;
|
||||
|
||||
for(size_t i = 0; i < uid_len; i++) {
|
||||
block[uid_len] ^= block[i];
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
return uid_valid;
|
||||
}
|
||||
|
||||
Iso14443_3aData* mf_classic_get_base_data(const MfClassicData* data) {
|
||||
|
||||
@@ -482,7 +482,19 @@ const uint8_t* mf_ultralight_get_uid(const MfUltralightData* data, size_t* uid_l
|
||||
bool mf_ultralight_set_uid(MfUltralightData* data, const uint8_t* uid, size_t uid_len) {
|
||||
furi_assert(data);
|
||||
|
||||
return iso14443_3a_set_uid(data->iso14443_3a_data, uid, uid_len);
|
||||
bool uid_valid = iso14443_3a_set_uid(data->iso14443_3a_data, uid, uid_len);
|
||||
|
||||
if(uid_valid) {
|
||||
// Copy UID across first 2 pages
|
||||
memcpy(data->page[0].data, data->iso14443_3a_data->uid, 3);
|
||||
memcpy(data->page[1].data, &data->iso14443_3a_data->uid[3], 4);
|
||||
|
||||
// Calculate BCC bytes
|
||||
data->page[0].data[3] = 0x88 ^ uid[0] ^ uid[1] ^ uid[2];
|
||||
data->page[2].data[0] = uid[3] ^ uid[4] ^ uid[5] ^ uid[6];
|
||||
}
|
||||
|
||||
return uid_valid;
|
||||
}
|
||||
|
||||
Iso14443_3aData* mf_ultralight_get_base_data(const MfUltralightData* data) {
|
||||
|
||||
@@ -338,7 +338,7 @@ const Iso15693_3Data* slix_get_base_data(const SlixData* data) {
|
||||
}
|
||||
|
||||
SlixType slix_get_type(const SlixData* data) {
|
||||
SlixType type = SlixTypeCount;
|
||||
SlixType type = SlixTypeUnknown;
|
||||
|
||||
do {
|
||||
if(iso15693_3_get_manufacturer_id(data->iso15693_3_data) != SLIX_NXP_MANUFACTURER_CODE)
|
||||
|
||||
@@ -37,6 +37,7 @@ extern "C" {
|
||||
#define SLIX_TYPE_FEATURE_EAS (1U << 4)
|
||||
#define SLIX_TYPE_FEATURE_SIGNATURE (1U << 5)
|
||||
#define SLIX_TYPE_FEATURE_PROTECTION (1U << 6)
|
||||
#define SLIX_TYPE_FEATURE_NFC_SYSTEM_INFO (1U << 7)
|
||||
|
||||
typedef uint32_t SlixTypeFeatures;
|
||||
|
||||
@@ -56,7 +57,9 @@ typedef enum {
|
||||
SlixTypeSlixS,
|
||||
SlixTypeSlixL,
|
||||
SlixTypeSlix2,
|
||||
|
||||
SlixTypeCount,
|
||||
SlixTypeUnknown,
|
||||
} SlixType;
|
||||
|
||||
typedef enum {
|
||||
@@ -71,6 +74,7 @@ typedef enum {
|
||||
typedef uint32_t SlixPassword;
|
||||
typedef uint8_t SlixSignature[SLIX_SIGNATURE_SIZE];
|
||||
typedef bool SlixPrivacy;
|
||||
typedef uint16_t SlixRandomNumber;
|
||||
|
||||
typedef struct {
|
||||
uint8_t pointer;
|
||||
|
||||
@@ -99,6 +99,33 @@ SlixError slix_read_signature_response_parse(SlixSignature data, const BitBuffer
|
||||
return error;
|
||||
}
|
||||
|
||||
SlixError slix_get_random_number_response_parse(SlixRandomNumber* data, const BitBuffer* buf) {
|
||||
SlixError error = SlixErrorNone;
|
||||
|
||||
do {
|
||||
if(slix_error_response_parse(&error, buf)) break;
|
||||
|
||||
typedef struct {
|
||||
uint8_t flags;
|
||||
uint8_t random_number[2];
|
||||
} SlixGetRandomNumberResponseLayout;
|
||||
|
||||
const size_t size_received = bit_buffer_get_size_bytes(buf);
|
||||
const size_t size_required = sizeof(SlixGetRandomNumberResponseLayout);
|
||||
|
||||
if(size_received != size_required) {
|
||||
error = SlixErrorFormat;
|
||||
break;
|
||||
}
|
||||
|
||||
const SlixGetRandomNumberResponseLayout* response =
|
||||
(const SlixGetRandomNumberResponseLayout*)bit_buffer_get_data(buf);
|
||||
*data = (response->random_number[1] << 8) | response->random_number[0];
|
||||
} while(false);
|
||||
|
||||
return error;
|
||||
}
|
||||
|
||||
void slix_set_password(SlixData* data, SlixPasswordType password_type, SlixPassword password) {
|
||||
furi_assert(data);
|
||||
furi_assert(password_type < SlixPasswordTypeCount);
|
||||
|
||||
@@ -48,7 +48,7 @@ extern "C" {
|
||||
#define SLIX_TYPE_FEATURES_SLIX2 \
|
||||
(SLIX_TYPE_FEATURE_READ | SLIX_TYPE_FEATURE_WRITE | SLIX_TYPE_FEATURE_PRIVACY | \
|
||||
SLIX_TYPE_FEATURE_DESTROY | SLIX_TYPE_FEATURE_EAS | SLIX_TYPE_FEATURE_SIGNATURE | \
|
||||
SLIX_TYPE_FEATURE_PROTECTION)
|
||||
SLIX_TYPE_FEATURE_PROTECTION | SLIX_TYPE_FEATURE_NFC_SYSTEM_INFO)
|
||||
|
||||
#define SLIX2_FEATURE_FLAGS \
|
||||
(SLIX_FEATURE_FLAG_UM_PP | SLIX_FEATURE_FLAG_COUNTER | SLIX_FEATURE_FLAG_EAS_ID | \
|
||||
@@ -74,6 +74,8 @@ SlixError slix_get_nxp_system_info_response_parse(SlixData* data, const BitBuffe
|
||||
|
||||
SlixError slix_read_signature_response_parse(SlixSignature data, const BitBuffer* buf);
|
||||
|
||||
SlixError slix_get_random_number_response_parse(SlixRandomNumber* data, const BitBuffer* buf);
|
||||
|
||||
// Setters
|
||||
void slix_set_password(SlixData* data, SlixPasswordType password_type, SlixPassword password);
|
||||
|
||||
|
||||
@@ -63,7 +63,7 @@ static NfcCommand slix_listener_run(NfcGenericEvent event, void* context) {
|
||||
if(iso15693_3_event->type == Iso15693_3ListenerEventTypeCustomCommand) {
|
||||
const SlixError error = slix_listener_process_request(instance, rx_buffer);
|
||||
if(error == SlixErrorWrongPassword) {
|
||||
command = NfcCommandStop;
|
||||
command = NfcCommandSleep;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
@@ -31,7 +31,7 @@ static SlixPasswordType slix_listener_get_password_type_by_id(uint8_t id) {
|
||||
|
||||
static SlixPassword
|
||||
slix_listener_unxor_password(const SlixPassword password_xored, uint16_t random) {
|
||||
return password_xored ^ ((SlixPassword)random << 16 | random);
|
||||
return REVERSE_BYTES_U32(password_xored ^ ((SlixPassword)random << 16 | random));
|
||||
}
|
||||
|
||||
static SlixError slix_listener_set_password(
|
||||
|
||||
@@ -44,33 +44,83 @@ static void slix_poller_free(SlixPoller* instance) {
|
||||
static NfcCommand slix_poller_handler_idle(SlixPoller* instance) {
|
||||
iso15693_3_copy(
|
||||
instance->data->iso15693_3_data, iso15693_3_poller_get_data(instance->iso15693_3_poller));
|
||||
|
||||
instance->poller_state = SlixPollerStateGetNxpSysInfo;
|
||||
instance->type = slix_get_type(instance->data);
|
||||
if(instance->type >= SlixTypeCount) {
|
||||
instance->error = SlixErrorNotSupported;
|
||||
instance->poller_state = SlixPollerStateError;
|
||||
} else {
|
||||
instance->poller_state = SlixPollerStateGetNxpSysInfo;
|
||||
}
|
||||
return NfcCommandContinue;
|
||||
}
|
||||
|
||||
static NfcCommand slix_poller_handler_get_nfc_system_info(SlixPoller* instance) {
|
||||
instance->error = slix_poller_get_nxp_system_info(instance, &instance->data->system_info);
|
||||
if(instance->error == SlixErrorNone) {
|
||||
instance->poller_state = SlixPollerStateReadSignature;
|
||||
if(slix_type_has_features(instance->type, SLIX_TYPE_FEATURE_NFC_SYSTEM_INFO)) {
|
||||
instance->error = slix_poller_get_nxp_system_info(instance, &instance->data->system_info);
|
||||
if(instance->error == SlixErrorNone) {
|
||||
instance->poller_state = SlixPollerStateReadSignature;
|
||||
} else {
|
||||
instance->poller_state = SlixPollerStateError;
|
||||
}
|
||||
} else {
|
||||
instance->poller_state = SlixPollerStateError;
|
||||
instance->poller_state = SlixPollerStateReadSignature;
|
||||
}
|
||||
|
||||
return NfcCommandContinue;
|
||||
}
|
||||
|
||||
static NfcCommand slix_poller_handler_read_signature(SlixPoller* instance) {
|
||||
instance->error = slix_poller_read_signature(instance, &instance->data->signature);
|
||||
if(instance->error == SlixErrorNone) {
|
||||
instance->poller_state = SlixPollerStateReady;
|
||||
if(slix_type_has_features(instance->type, SLIX_TYPE_FEATURE_SIGNATURE)) {
|
||||
instance->error = slix_poller_read_signature(instance, &instance->data->signature);
|
||||
if(instance->error == SlixErrorNone) {
|
||||
instance->poller_state = SlixPollerStateReady;
|
||||
} else {
|
||||
instance->poller_state = SlixPollerStateError;
|
||||
}
|
||||
} else {
|
||||
instance->poller_state = SlixPollerStateError;
|
||||
instance->poller_state = SlixPollerStateReady;
|
||||
}
|
||||
|
||||
return NfcCommandContinue;
|
||||
}
|
||||
|
||||
static NfcCommand slix_poller_handler_privacy_unlock(SlixPoller* instance) {
|
||||
NfcCommand command = NfcCommandContinue;
|
||||
instance->poller_state = SlixPollerStateError;
|
||||
|
||||
instance->slix_event.type = SlixPollerEventTypePrivacyUnlockRequest;
|
||||
command = instance->callback(instance->general_event, instance->context);
|
||||
|
||||
bool slix_unlocked = false;
|
||||
do {
|
||||
if(!instance->slix_event_data.privacy_password.password_set) break;
|
||||
SlixPassword pwd = instance->slix_event_data.privacy_password.password;
|
||||
FURI_LOG_I(TAG, "Trying to disable privacy mode with password: %08lX", pwd);
|
||||
|
||||
instance->error = slix_poller_get_random_number(instance, &instance->random_number);
|
||||
if(instance->error != SlixErrorNone) break;
|
||||
|
||||
instance->error = slix_poller_set_password(instance, SlixPasswordTypePrivacy, pwd);
|
||||
if(instance->error != SlixErrorNone) {
|
||||
command = NfcCommandReset;
|
||||
break;
|
||||
}
|
||||
|
||||
FURI_LOG_I(TAG, "Privacy mode disabled");
|
||||
instance->data->passwords[SlixPasswordTypePrivacy] = pwd;
|
||||
instance->poller_state = SlixPollerStateIdle;
|
||||
slix_unlocked = true;
|
||||
} while(false);
|
||||
|
||||
if(!slix_unlocked) {
|
||||
instance->error = SlixErrorTimeout;
|
||||
instance->poller_state = SlixPollerStateError;
|
||||
furi_delay_ms(100);
|
||||
}
|
||||
|
||||
return command;
|
||||
}
|
||||
|
||||
static NfcCommand slix_poller_handler_error(SlixPoller* instance) {
|
||||
instance->slix_event_data.error = instance->error;
|
||||
instance->slix_event.type = SlixPollerEventTypeError;
|
||||
@@ -90,6 +140,7 @@ static const SlixPollerStateHandler slix_poller_state_handler[SlixPollerStateNum
|
||||
[SlixPollerStateError] = slix_poller_handler_error,
|
||||
[SlixPollerStateGetNxpSysInfo] = slix_poller_handler_get_nfc_system_info,
|
||||
[SlixPollerStateReadSignature] = slix_poller_handler_read_signature,
|
||||
[SlixPollerStatePrivacyUnlock] = slix_poller_handler_privacy_unlock,
|
||||
[SlixPollerStateReady] = slix_poller_handler_ready,
|
||||
};
|
||||
|
||||
@@ -117,8 +168,8 @@ static NfcCommand slix_poller_run(NfcGenericEvent event, void* context) {
|
||||
if(iso15693_3_event->type == Iso15693_3PollerEventTypeReady) {
|
||||
command = slix_poller_state_handler[instance->poller_state](instance);
|
||||
} else if(iso15693_3_event->type == Iso15693_3PollerEventTypeError) {
|
||||
instance->slix_event.type = SlixPollerEventTypeError;
|
||||
command = instance->callback(instance->general_event, instance->context);
|
||||
instance->poller_state = SlixPollerStatePrivacyUnlock;
|
||||
command = slix_poller_state_handler[instance->poller_state](instance);
|
||||
}
|
||||
|
||||
return command;
|
||||
@@ -138,11 +189,7 @@ static bool slix_poller_detect(NfcGenericEvent event, void* context) {
|
||||
bool protocol_detected = false;
|
||||
|
||||
if(iso15693_3_event->type == Iso15693_3PollerEventTypeReady) {
|
||||
if(slix_get_type(instance->data) < SlixTypeCount) {
|
||||
SlixSystemInfo system_info = {};
|
||||
SlixError error = slix_poller_get_nxp_system_info(instance, &system_info);
|
||||
protocol_detected = (error == SlixErrorNone);
|
||||
}
|
||||
protocol_detected = (slix_get_type(instance->data) < SlixTypeCount);
|
||||
}
|
||||
|
||||
return protocol_detected;
|
||||
|
||||
@@ -18,14 +18,24 @@ typedef struct SlixPoller SlixPoller;
|
||||
*/
|
||||
typedef enum {
|
||||
SlixPollerEventTypeError, /**< An error occured while reading card. */
|
||||
SlixPollerEventTypePrivacyUnlockRequest, /**< Poller requests password to disable privacy mode. */
|
||||
SlixPollerEventTypeReady, /**< The card was successfully read by the poller. */
|
||||
} SlixPollerEventType;
|
||||
|
||||
/**
|
||||
* @brief Slix poller privacy unlock context data.
|
||||
*/
|
||||
typedef struct {
|
||||
SlixPassword password; /**< Privacy password. */
|
||||
bool password_set; /**< Filed to indicate that password was set or not. */
|
||||
} SlixPollerEventDataPrivacyUnlockContext;
|
||||
|
||||
/**
|
||||
* @brief Slixs poller event data.
|
||||
*/
|
||||
typedef union {
|
||||
SlixError error; /**< Error code indicating card reaing fail reason. */
|
||||
SlixPollerEventDataPrivacyUnlockContext privacy_password; /**< Privacy unlock event context. */
|
||||
} SlixPollerEventData;
|
||||
|
||||
/**
|
||||
@@ -80,6 +90,30 @@ SlixError slix_poller_get_nxp_system_info(SlixPoller* instance, SlixSystemInfo*
|
||||
*/
|
||||
SlixError slix_poller_read_signature(SlixPoller* instance, SlixSignature* data);
|
||||
|
||||
/**
|
||||
* @brief Get random number from card.
|
||||
*
|
||||
* Must ONLY be used inside the callback function.
|
||||
*
|
||||
* @param[in, out] instance pointer to the instance to be used in the transaction.
|
||||
* @param[out] data pointer to the SlixRandomNumber structure to be filled.
|
||||
* @return SlixErrorNone on success, an error code on failure.
|
||||
*/
|
||||
SlixError slix_poller_get_random_number(SlixPoller* instance, SlixRandomNumber* data);
|
||||
|
||||
/**
|
||||
* @brief Set password to card.
|
||||
*
|
||||
* Must ONLY be used inside the callback function.
|
||||
*
|
||||
* @param[in, out] instance pointer to the instance to be used in the transaction.
|
||||
* @param[out] type SlixPasswordType instance.
|
||||
* @param[out] password SlixPassword instance.
|
||||
* @return SlixErrorNone on success, an error code on failure.
|
||||
*/
|
||||
SlixError
|
||||
slix_poller_set_password(SlixPoller* instance, SlixPasswordType type, SlixPassword password);
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
@@ -1,4 +1,5 @@
|
||||
#include "slix_poller_i.h"
|
||||
#include <nfc/helpers/nfc_util.h>
|
||||
|
||||
#include <furi.h>
|
||||
|
||||
@@ -6,18 +7,22 @@
|
||||
|
||||
#define TAG "SlixPoller"
|
||||
|
||||
static void slix_poller_prepare_request(SlixPoller* instance, uint8_t command) {
|
||||
static void slix_poller_prepare_request(SlixPoller* instance, uint8_t command, bool skip_uid) {
|
||||
bit_buffer_reset(instance->tx_buffer);
|
||||
bit_buffer_reset(instance->rx_buffer);
|
||||
|
||||
bit_buffer_append_byte(
|
||||
instance->tx_buffer,
|
||||
ISO15693_3_REQ_FLAG_SUBCARRIER_1 | ISO15693_3_REQ_FLAG_DATA_RATE_HI |
|
||||
ISO15693_3_REQ_FLAG_T4_ADDRESSED);
|
||||
uint8_t flags = ISO15693_3_REQ_FLAG_SUBCARRIER_1 | ISO15693_3_REQ_FLAG_DATA_RATE_HI;
|
||||
if(!skip_uid) {
|
||||
flags |= ISO15693_3_REQ_FLAG_T4_ADDRESSED;
|
||||
}
|
||||
|
||||
bit_buffer_append_byte(instance->tx_buffer, flags);
|
||||
bit_buffer_append_byte(instance->tx_buffer, command);
|
||||
bit_buffer_append_byte(instance->tx_buffer, SLIX_NXP_MANUFACTURER_CODE);
|
||||
|
||||
iso15693_3_append_uid(instance->data->iso15693_3_data, instance->tx_buffer);
|
||||
if(!skip_uid) {
|
||||
iso15693_3_append_uid(instance->data->iso15693_3_data, instance->tx_buffer);
|
||||
}
|
||||
}
|
||||
|
||||
SlixError slix_poller_send_frame(
|
||||
@@ -36,7 +41,7 @@ SlixError slix_poller_get_nxp_system_info(SlixPoller* instance, SlixSystemInfo*
|
||||
furi_assert(instance);
|
||||
furi_assert(data);
|
||||
|
||||
slix_poller_prepare_request(instance, SLIX_CMD_GET_NXP_SYSTEM_INFORMATION);
|
||||
slix_poller_prepare_request(instance, SLIX_CMD_GET_NXP_SYSTEM_INFORMATION, false);
|
||||
|
||||
SlixError error = SlixErrorNone;
|
||||
|
||||
@@ -54,7 +59,7 @@ SlixError slix_poller_read_signature(SlixPoller* instance, SlixSignature* data)
|
||||
furi_assert(instance);
|
||||
furi_assert(data);
|
||||
|
||||
slix_poller_prepare_request(instance, SLIX_CMD_READ_SIGNATURE);
|
||||
slix_poller_prepare_request(instance, SLIX_CMD_READ_SIGNATURE, false);
|
||||
|
||||
SlixError error = SlixErrorNone;
|
||||
|
||||
@@ -67,3 +72,56 @@ SlixError slix_poller_read_signature(SlixPoller* instance, SlixSignature* data)
|
||||
|
||||
return error;
|
||||
}
|
||||
|
||||
SlixError slix_poller_get_random_number(SlixPoller* instance, SlixRandomNumber* data) {
|
||||
furi_assert(instance);
|
||||
furi_assert(data);
|
||||
|
||||
slix_poller_prepare_request(instance, SLIX_CMD_GET_RANDOM_NUMBER, true);
|
||||
|
||||
SlixError error = SlixErrorNone;
|
||||
|
||||
do {
|
||||
error = slix_poller_send_frame(
|
||||
instance, instance->tx_buffer, instance->rx_buffer, ISO15693_3_FDT_POLL_FC);
|
||||
if(error != SlixErrorNone) break;
|
||||
|
||||
error = slix_get_random_number_response_parse(data, instance->rx_buffer);
|
||||
} while(false);
|
||||
|
||||
return error;
|
||||
}
|
||||
|
||||
SlixError
|
||||
slix_poller_set_password(SlixPoller* instance, SlixPasswordType type, SlixPassword password) {
|
||||
furi_assert(instance);
|
||||
|
||||
bool skip_uid = (type == SlixPasswordTypePrivacy);
|
||||
slix_poller_prepare_request(instance, SLIX_CMD_SET_PASSWORD, skip_uid);
|
||||
|
||||
uint8_t password_type = (0x01 << type);
|
||||
bit_buffer_append_byte(instance->tx_buffer, password_type);
|
||||
|
||||
uint8_t rn_l = instance->random_number >> 8;
|
||||
uint8_t rn_h = instance->random_number;
|
||||
uint32_t double_rand_num = (rn_h << 24) | (rn_l << 16) | (rn_h << 8) | rn_l;
|
||||
uint32_t xored_password = double_rand_num ^ password;
|
||||
uint8_t xored_password_arr[4] = {};
|
||||
nfc_util_num2bytes(xored_password, 4, xored_password_arr);
|
||||
bit_buffer_append_bytes(instance->tx_buffer, xored_password_arr, 4);
|
||||
|
||||
SlixError error = SlixErrorNone;
|
||||
|
||||
do {
|
||||
error = slix_poller_send_frame(
|
||||
instance, instance->tx_buffer, instance->rx_buffer, SLIX_POLLER_SET_PASSWORD_FWT);
|
||||
if(error != SlixErrorNone) break;
|
||||
|
||||
size_t rx_len = bit_buffer_get_size_bytes(instance->rx_buffer);
|
||||
if(rx_len != 1) {
|
||||
error = SlixErrorWrongPassword;
|
||||
}
|
||||
} while(false);
|
||||
|
||||
return error;
|
||||
}
|
||||
|
||||
@@ -4,6 +4,8 @@
|
||||
|
||||
#include "slix_poller.h"
|
||||
|
||||
#define SLIX_POLLER_SET_PASSWORD_FWT (100000)
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
@@ -12,6 +14,7 @@ typedef enum {
|
||||
SlixPollerStateIdle,
|
||||
SlixPollerStateGetNxpSysInfo,
|
||||
SlixPollerStateReadSignature,
|
||||
SlixPollerStatePrivacyUnlock,
|
||||
SlixPollerStateReady,
|
||||
SlixPollerStateError,
|
||||
SlixPollerStateNum,
|
||||
@@ -19,9 +22,11 @@ typedef enum {
|
||||
|
||||
struct SlixPoller {
|
||||
Iso15693_3Poller* iso15693_3_poller;
|
||||
SlixType type;
|
||||
SlixData* data;
|
||||
SlixPollerState poller_state;
|
||||
SlixError error;
|
||||
SlixRandomNumber random_number;
|
||||
|
||||
BitBuffer* tx_buffer;
|
||||
BitBuffer* rx_buffer;
|
||||
|
||||
Reference in New Issue
Block a user