mirror of
https://github.com/DarkFlippers/unleashed-firmware.git
synced 2024-11-28 02:45:45 +03:00
RFID: add support for Kantech IOProx cards (#1261)
This commit is contained in:
parent
8a81b79e00
commit
522420ec70
107
applications/lfrfid/helpers/decoder_ioprox.cpp
Normal file
107
applications/lfrfid/helpers/decoder_ioprox.cpp
Normal file
@ -0,0 +1,107 @@
|
||||
#include "decoder_ioprox.h"
|
||||
#include <furi_hal.h>
|
||||
#include <cli/cli.h>
|
||||
#include <utility>
|
||||
|
||||
constexpr uint32_t clocks_in_us = 64;
|
||||
|
||||
constexpr uint32_t jitter_time_us = 20;
|
||||
constexpr uint32_t min_time_us = 64;
|
||||
constexpr uint32_t max_time_us = 80;
|
||||
constexpr uint32_t baud_time_us = 500;
|
||||
|
||||
constexpr uint32_t min_time = (min_time_us - jitter_time_us) * clocks_in_us;
|
||||
constexpr uint32_t mid_time = ((max_time_us - min_time_us) / 2 + min_time_us) * clocks_in_us;
|
||||
constexpr uint32_t max_time = (max_time_us + jitter_time_us) * clocks_in_us;
|
||||
constexpr uint32_t baud_time = baud_time_us * clocks_in_us;
|
||||
|
||||
bool DecoderIoProx::read(uint8_t* data, uint8_t data_size) {
|
||||
bool result = false;
|
||||
furi_assert(data_size >= 4);
|
||||
|
||||
if(ready) {
|
||||
result = true;
|
||||
ioprox.decode(raw_data, sizeof(raw_data), data, data_size);
|
||||
ready = false;
|
||||
}
|
||||
|
||||
return result;
|
||||
}
|
||||
|
||||
void DecoderIoProx::process_front(bool is_rising_edge, uint32_t time) {
|
||||
if(ready) {
|
||||
return;
|
||||
}
|
||||
|
||||
// Always track the time that's gone by.
|
||||
current_period_duration += time;
|
||||
demodulation_sample_duration += time;
|
||||
|
||||
// If a baud time has elapsed, we're at a sample point.
|
||||
if(demodulation_sample_duration >= baud_time) {
|
||||
// Start a new baud period...
|
||||
demodulation_sample_duration = 0;
|
||||
demodulated_value_invalid = false;
|
||||
|
||||
// ... and if we didn't have any baud errors, capture a sample.
|
||||
if(!demodulated_value_invalid) {
|
||||
store_data(current_demodulated_value);
|
||||
}
|
||||
}
|
||||
|
||||
//
|
||||
// FSK demodulator.
|
||||
//
|
||||
|
||||
// If this isn't a rising edge, this isn't a pulse of interest.
|
||||
// We're done.
|
||||
if(!is_rising_edge) {
|
||||
return;
|
||||
}
|
||||
|
||||
bool is_valid_low = (current_period_duration > min_time) &&
|
||||
(current_period_duration <= mid_time);
|
||||
bool is_valid_high = (current_period_duration > mid_time) &&
|
||||
(current_period_duration < max_time);
|
||||
|
||||
// If this is between the minimum and our threshold, this is a logical 0.
|
||||
if(is_valid_low) {
|
||||
current_demodulated_value = false;
|
||||
}
|
||||
// Otherwise, if between our threshold and the max time, it's a logical 1.
|
||||
else if(is_valid_high) {
|
||||
current_demodulated_value = true;
|
||||
}
|
||||
// Otherwise, invalidate this sample.
|
||||
else {
|
||||
demodulated_value_invalid = true;
|
||||
}
|
||||
|
||||
// We're starting a new period; track that.
|
||||
current_period_duration = 0;
|
||||
}
|
||||
|
||||
DecoderIoProx::DecoderIoProx() {
|
||||
reset_state();
|
||||
}
|
||||
|
||||
void DecoderIoProx::store_data(bool data) {
|
||||
for(int i = 0; i < 7; ++i) {
|
||||
raw_data[i] = (raw_data[i] << 1) | ((raw_data[i + 1] >> 7) & 1);
|
||||
}
|
||||
raw_data[7] = (raw_data[7] << 1) | data;
|
||||
|
||||
if(ioprox.can_be_decoded(raw_data, sizeof(raw_data))) {
|
||||
ready = true;
|
||||
}
|
||||
}
|
||||
|
||||
void DecoderIoProx::reset_state() {
|
||||
current_demodulated_value = false;
|
||||
demodulated_value_invalid = false;
|
||||
|
||||
current_period_duration = 0;
|
||||
demodulation_sample_duration = 0;
|
||||
|
||||
ready = false;
|
||||
}
|
26
applications/lfrfid/helpers/decoder_ioprox.h
Normal file
26
applications/lfrfid/helpers/decoder_ioprox.h
Normal file
@ -0,0 +1,26 @@
|
||||
#pragma once
|
||||
#include <stdint.h>
|
||||
#include <atomic>
|
||||
#include "protocols/protocol_ioprox.h"
|
||||
|
||||
class DecoderIoProx {
|
||||
public:
|
||||
bool read(uint8_t* data, uint8_t data_size);
|
||||
void process_front(bool polarity, uint32_t time);
|
||||
DecoderIoProx();
|
||||
|
||||
private:
|
||||
uint32_t current_period_duration = 0;
|
||||
uint32_t demodulation_sample_duration = 0;
|
||||
|
||||
bool current_demodulated_value = false;
|
||||
bool demodulated_value_invalid = false;
|
||||
|
||||
uint8_t raw_data[8] = {0};
|
||||
void store_data(bool data);
|
||||
|
||||
std::atomic<bool> ready;
|
||||
|
||||
void reset_state();
|
||||
ProtocolIoProx ioprox;
|
||||
};
|
32
applications/lfrfid/helpers/encoder_ioprox.cpp
Normal file
32
applications/lfrfid/helpers/encoder_ioprox.cpp
Normal file
@ -0,0 +1,32 @@
|
||||
#include "encoder_ioprox.h"
|
||||
#include "protocols/protocol_ioprox.h"
|
||||
#include <furi.h>
|
||||
|
||||
void EncoderIoProx::init(const uint8_t* data, const uint8_t data_size) {
|
||||
ProtocolIoProx ioprox;
|
||||
ioprox.encode(data, data_size, card_data, sizeof(card_data));
|
||||
card_data_index = 0;
|
||||
}
|
||||
|
||||
void EncoderIoProx::get_next(bool* polarity, uint16_t* period, uint16_t* pulse) {
|
||||
uint8_t bit = (card_data[card_data_index / 8] >> (7 - (card_data_index % 8))) & 1;
|
||||
|
||||
bool advance = fsk->next(bit, period);
|
||||
if(advance) {
|
||||
card_data_index++;
|
||||
if(card_data_index >= (8 * card_data_max)) {
|
||||
card_data_index = 0;
|
||||
}
|
||||
}
|
||||
|
||||
*polarity = true;
|
||||
*pulse = *period / 2;
|
||||
}
|
||||
|
||||
EncoderIoProx::EncoderIoProx() {
|
||||
fsk = new OscFSK(8, 10, 64);
|
||||
}
|
||||
|
||||
EncoderIoProx::~EncoderIoProx() {
|
||||
delete fsk;
|
||||
}
|
25
applications/lfrfid/helpers/encoder_ioprox.h
Normal file
25
applications/lfrfid/helpers/encoder_ioprox.h
Normal file
@ -0,0 +1,25 @@
|
||||
#pragma once
|
||||
#include "encoder_generic.h"
|
||||
#include "osc_fsk.h"
|
||||
|
||||
class EncoderIoProx : public EncoderGeneric {
|
||||
public:
|
||||
/**
|
||||
* @brief init data to emulate
|
||||
*
|
||||
* @param data 1 byte FC, 1 byte Version, 2 bytes code
|
||||
* @param data_size must be 4
|
||||
*/
|
||||
void init(const uint8_t* data, const uint8_t data_size) final;
|
||||
void get_next(bool* polarity, uint16_t* period, uint16_t* pulse) final;
|
||||
EncoderIoProx();
|
||||
~EncoderIoProx();
|
||||
|
||||
private:
|
||||
static const uint8_t card_data_max = 8;
|
||||
|
||||
uint8_t card_data[card_data_max];
|
||||
uint8_t card_data_index;
|
||||
|
||||
OscFSK* fsk;
|
||||
};
|
@ -12,6 +12,9 @@ const char* lfrfid_key_get_type_string(LfrfidKeyType type) {
|
||||
case LfrfidKeyType::KeyI40134:
|
||||
return "I40134";
|
||||
break;
|
||||
case LfrfidKeyType::KeyIoProxXSF:
|
||||
return "IoProxXSF";
|
||||
break;
|
||||
}
|
||||
|
||||
return "Unknown";
|
||||
@ -28,6 +31,8 @@ const char* lfrfid_key_get_manufacturer_string(LfrfidKeyType type) {
|
||||
case LfrfidKeyType::KeyI40134:
|
||||
return "Indala";
|
||||
break;
|
||||
case LfrfidKeyType::KeyIoProxXSF:
|
||||
return "Kantech";
|
||||
}
|
||||
|
||||
return "Unknown";
|
||||
@ -42,6 +47,8 @@ bool lfrfid_key_get_string_type(const char* string, LfrfidKeyType* type) {
|
||||
*type = LfrfidKeyType::KeyH10301;
|
||||
} else if(strcmp("I40134", string) == 0) {
|
||||
*type = LfrfidKeyType::KeyI40134;
|
||||
} else if(strcmp("IoProxXSF", string) == 0) {
|
||||
*type = LfrfidKeyType::KeyIoProxXSF;
|
||||
} else {
|
||||
result = false;
|
||||
}
|
||||
@ -60,6 +67,9 @@ uint8_t lfrfid_key_get_type_data_count(LfrfidKeyType type) {
|
||||
case LfrfidKeyType::KeyI40134:
|
||||
return 3;
|
||||
break;
|
||||
case LfrfidKeyType::KeyIoProxXSF:
|
||||
return 4;
|
||||
break;
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
@ -8,6 +8,7 @@ enum class LfrfidKeyType : uint8_t {
|
||||
KeyEM4100,
|
||||
KeyH10301,
|
||||
KeyI40134,
|
||||
KeyIoProxXSF,
|
||||
};
|
||||
|
||||
const char* lfrfid_key_get_type_string(LfrfidKeyType type);
|
||||
|
193
applications/lfrfid/helpers/protocols/protocol_ioprox.cpp
Normal file
193
applications/lfrfid/helpers/protocols/protocol_ioprox.cpp
Normal file
@ -0,0 +1,193 @@
|
||||
#include "protocol_ioprox.h"
|
||||
#include <furi.h>
|
||||
#include <cli/cli.h>
|
||||
|
||||
/**
|
||||
* Writes a bit into the output buffer.
|
||||
*/
|
||||
static void write_bit(bool bit, uint8_t position, uint8_t* data) {
|
||||
if(bit) {
|
||||
data[position / 8] |= 1UL << (7 - (position % 8));
|
||||
} else {
|
||||
data[position / 8] &= ~(1UL << (7 - (position % 8)));
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* Writes up to eight contiguous bits into the output buffer.
|
||||
*/
|
||||
static void write_bits(uint8_t byte, uint8_t position, uint8_t* data, uint8_t length) {
|
||||
furi_check(length <= 8);
|
||||
furi_check(length > 0);
|
||||
|
||||
for(uint8_t i = 0; i < length; ++i) {
|
||||
uint8_t shift = 7 - i;
|
||||
write_bit((byte >> shift) & 1, position + i, data);
|
||||
}
|
||||
}
|
||||
|
||||
uint8_t ProtocolIoProx::get_encoded_data_size() {
|
||||
return 8;
|
||||
}
|
||||
|
||||
uint8_t ProtocolIoProx::get_decoded_data_size() {
|
||||
return 4;
|
||||
}
|
||||
|
||||
void ProtocolIoProx::encode(
|
||||
const uint8_t* decoded_data,
|
||||
const uint8_t decoded_data_size,
|
||||
uint8_t* encoded_data,
|
||||
const uint8_t encoded_data_size) {
|
||||
furi_check(decoded_data_size >= get_decoded_data_size());
|
||||
furi_check(encoded_data_size >= get_encoded_data_size());
|
||||
|
||||
// Packet to transmit:
|
||||
//
|
||||
// 0 10 20 30 40 50 60
|
||||
// v v v v v v v
|
||||
// 01234567 8 90123456 7 89012345 6 78901234 5 67890123 4 56789012 3 45678901 23
|
||||
// -----------------------------------------------------------------------------
|
||||
// 00000000 0 11110000 1 facility 1 version_ 1 code-one 1 code-two 1 checksum 11
|
||||
|
||||
// Preamble.
|
||||
write_bits(0b00000000, 0, encoded_data, 8);
|
||||
write_bit(0, 8, encoded_data);
|
||||
|
||||
write_bits(0b11110000, 9, encoded_data, 8);
|
||||
write_bit(1, 17, encoded_data);
|
||||
|
||||
// Facility code.
|
||||
write_bits(decoded_data[0], 18, encoded_data, 8);
|
||||
write_bit(1, 26, encoded_data);
|
||||
|
||||
// Version
|
||||
write_bits(decoded_data[1], 27, encoded_data, 8);
|
||||
write_bit(1, 35, encoded_data);
|
||||
|
||||
// Code one
|
||||
write_bits(decoded_data[2], 36, encoded_data, 8);
|
||||
write_bit(1, 44, encoded_data);
|
||||
|
||||
// Code two
|
||||
write_bits(decoded_data[3], 45, encoded_data, 8);
|
||||
write_bit(1, 53, encoded_data);
|
||||
|
||||
// Checksum
|
||||
write_bits(compute_checksum(encoded_data, 8), 54, encoded_data, 8);
|
||||
write_bit(1, 62, encoded_data);
|
||||
write_bit(1, 63, encoded_data);
|
||||
}
|
||||
|
||||
void ProtocolIoProx::decode(
|
||||
const uint8_t* encoded_data,
|
||||
const uint8_t encoded_data_size,
|
||||
uint8_t* decoded_data,
|
||||
const uint8_t decoded_data_size) {
|
||||
furi_check(decoded_data_size >= get_decoded_data_size());
|
||||
furi_check(encoded_data_size >= get_encoded_data_size());
|
||||
|
||||
// Packet structure:
|
||||
// (Note: the second word seems fixed; but this may not be a guarantee;
|
||||
// it currently has no meaning.)
|
||||
//
|
||||
//0 1 2 3 4 5 6 7
|
||||
//v v v v v v v v
|
||||
//01234567 89ABCDEF 01234567 89ABCDEF 01234567 89ABCDEF 01234567 89ABCDEF
|
||||
//-----------------------------------------------------------------------
|
||||
//00000000 01111000 01FFFFFF FF1VVVVV VVV1CCCC CCCC1CCC CCCCC1XX XXXXXX11
|
||||
//
|
||||
// F = facility code
|
||||
// V = version
|
||||
// C = code
|
||||
// X = checksum
|
||||
|
||||
// Facility code
|
||||
decoded_data[0] = (encoded_data[2] << 2) | (encoded_data[3] >> 6);
|
||||
|
||||
// Version code.
|
||||
decoded_data[1] = (encoded_data[3] << 3) | (encoded_data[4] >> 5);
|
||||
|
||||
// Code bytes.
|
||||
decoded_data[2] = (encoded_data[4] << 4) | (encoded_data[5] >> 4);
|
||||
decoded_data[3] = (encoded_data[5] << 5) | (encoded_data[6] >> 3);
|
||||
}
|
||||
|
||||
bool ProtocolIoProx::can_be_decoded(const uint8_t* encoded_data, const uint8_t encoded_data_size) {
|
||||
furi_check(encoded_data_size >= get_encoded_data_size());
|
||||
|
||||
// Packet framing
|
||||
//
|
||||
//0 1 2 3 4 5 6 7
|
||||
//v v v v v v v v
|
||||
//01234567 89ABCDEF 01234567 89ABCDEF 01234567 89ABCDEF 01234567 89ABCDEF
|
||||
//-----------------------------------------------------------------------
|
||||
//00000000 01______ _1______ __1_____ ___1____ ____1___ _____1XX XXXXXX11
|
||||
//
|
||||
// _ = variable data
|
||||
// 0 = preamble 0
|
||||
// 1 = framing 1
|
||||
// X = checksum
|
||||
|
||||
// Validate the packet preamble is there...
|
||||
if(encoded_data[0] != 0b00000000) {
|
||||
return false;
|
||||
}
|
||||
if((encoded_data[1] >> 6) != 0b01) {
|
||||
return false;
|
||||
}
|
||||
|
||||
// ... check for known ones...
|
||||
if((encoded_data[2] & 0b01000000) == 0) {
|
||||
return false;
|
||||
}
|
||||
if((encoded_data[3] & 0b00100000) == 0) {
|
||||
return false;
|
||||
}
|
||||
if((encoded_data[4] & 0b00010000) == 0) {
|
||||
return false;
|
||||
}
|
||||
if((encoded_data[5] & 0b00001000) == 0) {
|
||||
return false;
|
||||
}
|
||||
if((encoded_data[6] & 0b00000100) == 0) {
|
||||
return false;
|
||||
}
|
||||
if((encoded_data[7] & 0b00000011) == 0) {
|
||||
return false;
|
||||
}
|
||||
|
||||
// ... and validate our checksums.
|
||||
uint8_t checksum = compute_checksum(encoded_data, 8);
|
||||
uint8_t checkval = (encoded_data[6] << 6) | (encoded_data[7] >> 2);
|
||||
|
||||
if(checksum != checkval) {
|
||||
return false;
|
||||
}
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
uint8_t ProtocolIoProx::compute_checksum(const uint8_t* data, const uint8_t data_size) {
|
||||
furi_check(data_size == get_encoded_data_size());
|
||||
|
||||
// Packet structure:
|
||||
//
|
||||
//0 1 2 3 4 5 6 7
|
||||
//v v v v v v v v
|
||||
//01234567 8 9ABCDEF0 1 23456789 A BCDEF012 3 456789AB C DEF01234 5 6789ABCD EF
|
||||
//00000000 0 VVVVVVVV 1 WWWWWWWW 1 XXXXXXXX 1 YYYYYYYY 1 ZZZZZZZZ 1 CHECKSUM 11
|
||||
//
|
||||
// algorithm as observed by the proxmark3 folks
|
||||
// CHECKSUM == 0xFF - (V + W + X + Y + Z)
|
||||
|
||||
uint8_t checksum = 0;
|
||||
|
||||
checksum += (data[1] << 1) | (data[2] >> 7); // VVVVVVVVV
|
||||
checksum += (data[2] << 2) | (data[3] >> 6); // WWWWWWWWW
|
||||
checksum += (data[3] << 3) | (data[4] >> 5); // XXXXXXXXX
|
||||
checksum += (data[4] << 4) | (data[5] >> 4); // YYYYYYYYY
|
||||
checksum += (data[5] << 5) | (data[6] >> 3); // ZZZZZZZZZ
|
||||
|
||||
return 0xFF - checksum;
|
||||
}
|
26
applications/lfrfid/helpers/protocols/protocol_ioprox.h
Normal file
26
applications/lfrfid/helpers/protocols/protocol_ioprox.h
Normal file
@ -0,0 +1,26 @@
|
||||
#pragma once
|
||||
#include "protocol_generic.h"
|
||||
|
||||
class ProtocolIoProx : public ProtocolGeneric {
|
||||
public:
|
||||
uint8_t get_encoded_data_size() final;
|
||||
uint8_t get_decoded_data_size() final;
|
||||
|
||||
void encode(
|
||||
const uint8_t* decoded_data,
|
||||
const uint8_t decoded_data_size,
|
||||
uint8_t* encoded_data,
|
||||
const uint8_t encoded_data_size) final;
|
||||
|
||||
void decode(
|
||||
const uint8_t* encoded_data,
|
||||
const uint8_t encoded_data_size,
|
||||
uint8_t* decoded_data,
|
||||
const uint8_t decoded_data_size) final;
|
||||
|
||||
bool can_be_decoded(const uint8_t* encoded_data, const uint8_t encoded_data_size) final;
|
||||
|
||||
private:
|
||||
/** Computes the IoProx checksum of the provided (decoded) data. */
|
||||
uint8_t compute_checksum(const uint8_t* data, const uint8_t data_size);
|
||||
};
|
@ -25,10 +25,12 @@ void RfidReader::decode(bool polarity) {
|
||||
case Type::Normal:
|
||||
decoder_em.process_front(polarity, period);
|
||||
decoder_hid26.process_front(polarity, period);
|
||||
decoder_ioprox.process_front(polarity, period);
|
||||
break;
|
||||
case Type::Indala:
|
||||
decoder_em.process_front(polarity, period);
|
||||
decoder_hid26.process_front(polarity, period);
|
||||
decoder_ioprox.process_front(polarity, period);
|
||||
decoder_indala.process_front(polarity, period);
|
||||
break;
|
||||
}
|
||||
@ -110,6 +112,11 @@ bool RfidReader::read(LfrfidKeyType* _type, uint8_t* data, uint8_t data_size, bo
|
||||
something_read = true;
|
||||
}
|
||||
|
||||
if(decoder_ioprox.read(data, data_size)) {
|
||||
*_type = LfrfidKeyType::KeyIoProxXSF;
|
||||
something_read = true;
|
||||
}
|
||||
|
||||
if(decoder_indala.read(data, data_size)) {
|
||||
*_type = LfrfidKeyType::KeyI40134;
|
||||
something_read = true;
|
||||
|
@ -4,6 +4,7 @@
|
||||
#include "decoder_emmarin.h"
|
||||
#include "decoder_hid26.h"
|
||||
#include "decoder_indala.h"
|
||||
#include "decoder_ioprox.h"
|
||||
#include "key_info.h"
|
||||
|
||||
//#define RFID_GPIO_DEBUG 1
|
||||
@ -34,6 +35,7 @@ private:
|
||||
DecoderEMMarin decoder_em;
|
||||
DecoderHID26 decoder_hid26;
|
||||
DecoderIndala decoder_indala;
|
||||
DecoderIoProx decoder_ioprox;
|
||||
|
||||
uint32_t last_dwt_value;
|
||||
|
||||
|
@ -5,6 +5,7 @@
|
||||
#include "encoder_emmarin.h"
|
||||
#include "encoder_hid_h10301.h"
|
||||
#include "encoder_indala_40134.h"
|
||||
#include "encoder_ioprox.h"
|
||||
#include "pulse_joiner.h"
|
||||
#include <map>
|
||||
|
||||
@ -22,6 +23,7 @@ private:
|
||||
{LfrfidKeyType::KeyEM4100, new EncoderEM()},
|
||||
{LfrfidKeyType::KeyH10301, new EncoderHID_H10301()},
|
||||
{LfrfidKeyType::KeyI40134, new EncoderIndala_40134()},
|
||||
{LfrfidKeyType::KeyIoProxXSF, new EncoderIoProx()},
|
||||
};
|
||||
|
||||
PulseJoiner pulse_joiner;
|
||||
|
@ -84,6 +84,11 @@ void RfidWorker::sq_write() {
|
||||
writer.write_indala(key.get_data());
|
||||
writer.stop();
|
||||
break;
|
||||
case LfrfidKeyType::KeyIoProxXSF:
|
||||
writer.start();
|
||||
writer.write_ioprox(key.get_data());
|
||||
writer.stop();
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
@ -92,6 +97,7 @@ void RfidWorker::sq_write_start_validate() {
|
||||
switch(key.get_type()) {
|
||||
case LfrfidKeyType::KeyEM4100:
|
||||
case LfrfidKeyType::KeyH10301:
|
||||
case LfrfidKeyType::KeyIoProxXSF:
|
||||
reader.start_forced(RfidReader::Type::Normal);
|
||||
break;
|
||||
case LfrfidKeyType::KeyI40134:
|
||||
|
@ -1,4 +1,5 @@
|
||||
#include "rfid_writer.h"
|
||||
#include "protocols/protocol_ioprox.h"
|
||||
#include <furi_hal.h>
|
||||
#include "protocols/protocol_emmarin.h"
|
||||
#include "protocols/protocol_hid_h10301.h"
|
||||
@ -143,6 +144,28 @@ void RfidWriter::write_hid(const uint8_t hid_data[3]) {
|
||||
FURI_CRITICAL_EXIT();
|
||||
}
|
||||
|
||||
/** Endian fixup. Translates an ioprox block into a t5577 block */
|
||||
static uint32_t ioprox_encode_block(const uint8_t block_data[4]) {
|
||||
uint8_t raw_card_data[] = {block_data[3], block_data[2], block_data[1], block_data[0]};
|
||||
return *reinterpret_cast<uint32_t*>(&raw_card_data);
|
||||
}
|
||||
|
||||
void RfidWriter::write_ioprox(const uint8_t ioprox_data[4]) {
|
||||
ProtocolIoProx ioprox_card;
|
||||
|
||||
uint8_t encoded_data[8];
|
||||
ioprox_card.encode(ioprox_data, 4, encoded_data, sizeof(encoded_data));
|
||||
|
||||
const uint32_t ioprox_config_block_data = 0b00000000000101000111000001000000;
|
||||
|
||||
FURI_CRITICAL_ENTER();
|
||||
write_block(0, 0, false, ioprox_config_block_data);
|
||||
write_block(0, 1, false, ioprox_encode_block(&encoded_data[0]));
|
||||
write_block(0, 2, false, ioprox_encode_block(&encoded_data[4]));
|
||||
write_reset();
|
||||
FURI_CRITICAL_EXIT();
|
||||
}
|
||||
|
||||
void RfidWriter::write_indala(const uint8_t indala_data[3]) {
|
||||
ProtocolIndala40134 indala_card;
|
||||
uint32_t card_data[2];
|
||||
|
@ -9,6 +9,7 @@ public:
|
||||
void stop();
|
||||
void write_em(const uint8_t em_data[5]);
|
||||
void write_hid(const uint8_t hid_data[3]);
|
||||
void write_ioprox(const uint8_t ioprox_data[4]);
|
||||
void write_indala(const uint8_t indala_data[3]);
|
||||
|
||||
private:
|
||||
|
@ -28,6 +28,7 @@ void lfrfid_cli_print_usage() {
|
||||
printf("\tEM4100, EM-Marin (5 bytes key_data)\r\n");
|
||||
printf("\tH10301, HID26 (3 bytes key_data)\r\n");
|
||||
printf("\tI40134, Indala (3 bytes key_data)\r\n");
|
||||
printf("\tIoProxXSF, IoProx (4 bytes key_data)\r\n");
|
||||
printf("\t<key_data> are hex-formatted\r\n");
|
||||
};
|
||||
|
||||
@ -43,6 +44,9 @@ static bool lfrfid_cli_get_key_type(string_t data, LfrfidKeyType* type) {
|
||||
} else if(string_cmp_str(data, "I40134") == 0 || string_cmp_str(data, "Indala") == 0) {
|
||||
result = true;
|
||||
*type = LfrfidKeyType::KeyI40134;
|
||||
} else if(string_cmp_str(data, "IoProxXSF") == 0 || string_cmp_str(data, "IoProx") == 0) {
|
||||
result = true;
|
||||
*type = LfrfidKeyType::KeyIoProxXSF;
|
||||
}
|
||||
|
||||
return result;
|
||||
|
@ -50,6 +50,14 @@ void LfRfidAppSceneDeleteConfirm::on_enter(LfRfidApp* app, bool /* need_restore
|
||||
string_printf(
|
||||
string_decrypted, "FC: %u ID: %u", data[0], (uint16_t)((data[1] << 8) | (data[2])));
|
||||
break;
|
||||
case LfrfidKeyType::KeyIoProxXSF:
|
||||
string_printf(
|
||||
string_decrypted,
|
||||
"FC: %u VC: %u ID: %u",
|
||||
data[0],
|
||||
data[1],
|
||||
(uint16_t)((data[2] << 8) | (data[3])));
|
||||
break;
|
||||
}
|
||||
line_3->set_text(
|
||||
string_get_cstr(string_decrypted), 64, 39, 0, AlignCenter, AlignBottom, FontSecondary);
|
||||
|
@ -7,6 +7,7 @@ void LfRfidAppSceneReadSuccess::on_enter(LfRfidApp* app, bool /* need_restore */
|
||||
string_init(string[0]);
|
||||
string_init(string[1]);
|
||||
string_init(string[2]);
|
||||
string_init(string[3]);
|
||||
|
||||
auto container = app->view_controller.get<ContainerVM>();
|
||||
|
||||
@ -25,11 +26,13 @@ void LfRfidAppSceneReadSuccess::on_enter(LfRfidApp* app, bool /* need_restore */
|
||||
header->set_text(app->worker.key.get_type_text(), 89, 3, 0, AlignCenter);
|
||||
|
||||
auto line_1_text = container->add<StringElement>();
|
||||
auto line_2_text = container->add<StringElement>();
|
||||
auto line_2l_text = container->add<StringElement>();
|
||||
auto line_2r_text = container->add<StringElement>();
|
||||
auto line_3_text = container->add<StringElement>();
|
||||
|
||||
auto line_1_value = container->add<StringElement>();
|
||||
auto line_2_value = container->add<StringElement>();
|
||||
auto line_2l_value = container->add<StringElement>();
|
||||
auto line_2r_value = container->add<StringElement>();
|
||||
auto line_3_value = container->add<StringElement>();
|
||||
|
||||
const uint8_t* data = app->worker.key.get_data();
|
||||
@ -37,7 +40,7 @@ void LfRfidAppSceneReadSuccess::on_enter(LfRfidApp* app, bool /* need_restore */
|
||||
switch(app->worker.key.get_type()) {
|
||||
case LfrfidKeyType::KeyEM4100:
|
||||
line_1_text->set_text("HEX:", 65, 23, 0, AlignRight, AlignBottom, FontSecondary);
|
||||
line_2_text->set_text("Mod:", 65, 35, 0, AlignRight, AlignBottom, FontSecondary);
|
||||
line_2l_text->set_text("Mod:", 65, 35, 0, AlignRight, AlignBottom, FontSecondary);
|
||||
line_3_text->set_text("ID:", 65, 47, 0, AlignRight, AlignBottom, FontSecondary);
|
||||
|
||||
for(uint8_t i = 0; i < app->worker.key.get_type_data_count(); i++) {
|
||||
@ -49,7 +52,7 @@ void LfRfidAppSceneReadSuccess::on_enter(LfRfidApp* app, bool /* need_restore */
|
||||
|
||||
line_1_value->set_text(
|
||||
string_get_cstr(string[0]), 68, 23, 0, AlignLeft, AlignBottom, FontSecondary);
|
||||
line_2_value->set_text(
|
||||
line_2l_value->set_text(
|
||||
string_get_cstr(string[1]), 68, 35, 0, AlignLeft, AlignBottom, FontSecondary);
|
||||
line_3_value->set_text(
|
||||
string_get_cstr(string[2]), 68, 47, 0, AlignLeft, AlignBottom, FontSecondary);
|
||||
@ -57,7 +60,7 @@ void LfRfidAppSceneReadSuccess::on_enter(LfRfidApp* app, bool /* need_restore */
|
||||
case LfrfidKeyType::KeyH10301:
|
||||
case LfrfidKeyType::KeyI40134:
|
||||
line_1_text->set_text("HEX:", 65, 23, 0, AlignRight, AlignBottom, FontSecondary);
|
||||
line_2_text->set_text("FC:", 65, 35, 0, AlignRight, AlignBottom, FontSecondary);
|
||||
line_2l_text->set_text("FC:", 65, 35, 0, AlignRight, AlignBottom, FontSecondary);
|
||||
line_3_text->set_text("Card:", 65, 47, 0, AlignRight, AlignBottom, FontSecondary);
|
||||
|
||||
for(uint8_t i = 0; i < app->worker.key.get_type_data_count(); i++) {
|
||||
@ -69,11 +72,36 @@ void LfRfidAppSceneReadSuccess::on_enter(LfRfidApp* app, bool /* need_restore */
|
||||
|
||||
line_1_value->set_text(
|
||||
string_get_cstr(string[0]), 68, 23, 0, AlignLeft, AlignBottom, FontSecondary);
|
||||
line_2_value->set_text(
|
||||
line_2l_value->set_text(
|
||||
string_get_cstr(string[1]), 68, 35, 0, AlignLeft, AlignBottom, FontSecondary);
|
||||
line_3_value->set_text(
|
||||
string_get_cstr(string[2]), 68, 47, 0, AlignLeft, AlignBottom, FontSecondary);
|
||||
break;
|
||||
|
||||
case LfrfidKeyType::KeyIoProxXSF:
|
||||
line_1_text->set_text("HEX:", 65, 23, 0, AlignRight, AlignBottom, FontSecondary);
|
||||
line_2l_text->set_text("FC:", 65, 35, 0, AlignRight, AlignBottom, FontSecondary);
|
||||
line_2r_text->set_text("V:", 95, 35, 0, AlignRight, AlignBottom, FontSecondary);
|
||||
line_3_text->set_text("Card:", 65, 47, 0, AlignRight, AlignBottom, FontSecondary);
|
||||
|
||||
for(uint8_t i = 0; i < app->worker.key.get_type_data_count(); i++) {
|
||||
string_cat_printf(string[0], "%02X", data[i]);
|
||||
}
|
||||
|
||||
string_printf(string[1], "%u", data[0]);
|
||||
string_printf(string[2], "%u", (uint16_t)((data[2] << 8) | (data[3])));
|
||||
string_printf(string[3], "%u", data[1]);
|
||||
|
||||
line_1_value->set_text(
|
||||
string_get_cstr(string[0]), 68, 23, 0, AlignLeft, AlignBottom, FontSecondary);
|
||||
line_2l_value->set_text(
|
||||
string_get_cstr(string[1]), 68, 35, 0, AlignLeft, AlignBottom, FontSecondary);
|
||||
line_2r_value->set_text(
|
||||
string_get_cstr(string[3]), 98, 35, 0, AlignLeft, AlignBottom, FontSecondary);
|
||||
line_3_value->set_text(
|
||||
string_get_cstr(string[2]), 68, 47, 0, AlignLeft, AlignBottom, FontSecondary);
|
||||
|
||||
break;
|
||||
}
|
||||
|
||||
app->view_controller.switch_to<ContainerVM>();
|
||||
|
@ -10,6 +10,6 @@ public:
|
||||
private:
|
||||
static void submenu_callback(void* context, uint32_t index);
|
||||
uint32_t submenu_item_selected = 0;
|
||||
static const uint8_t keys_count = static_cast<uint8_t>(LfrfidKeyType::KeyI40134);
|
||||
static const uint8_t keys_count = static_cast<uint8_t>(LfrfidKeyType::KeyIoProxXSF);
|
||||
string_t submenu_name[keys_count + 1];
|
||||
};
|
||||
|
@ -43,6 +43,14 @@ void LfRfidAppSceneSavedInfo::on_enter(LfRfidApp* app, bool /* need_restore */)
|
||||
string_printf(
|
||||
string_decrypted, "FC: %u ID: %u", data[0], (uint16_t)((data[1] << 8) | (data[2])));
|
||||
break;
|
||||
case LfrfidKeyType::KeyIoProxXSF:
|
||||
string_printf(
|
||||
string_decrypted,
|
||||
"FC: %u VC: %u ID: %u",
|
||||
data[0],
|
||||
data[1],
|
||||
(uint16_t)((data[2] << 8) | (data[3])));
|
||||
break;
|
||||
}
|
||||
line_3->set_text(
|
||||
string_get_cstr(string_decrypted), 64, 39, 0, AlignCenter, AlignBottom, FontSecondary);
|
||||
|
Loading…
Reference in New Issue
Block a user