[FL-2529][FL-1628] New LF-RFID subsystem (#1601)
* Makefile: unit tests pack * RFID: pulse joiner and its unit test * Move pulse protocol helpers to appropriate place * Drop pulse_joiner tests * Generic protocol, protocols dictionary, unit test * Protocol dict unit test * iButton: protocols dictionary * Lib: varint * Lib: profiler * Unit test: varint * rfid: worker mockup * LFRFID: em4100 unit test * Storage: file_exist function * rfid: fsk osc * rfid: generic fsk demodulator * rfid: protocol em4100 * rfid: protocol h10301 * rfid: protocol io prox xsf * Unit test: rfid protocols * rfid: new hal * rfid: raw worker * Unit test: fix error output * rfid: worker * rfid: plain c cli * fw: migrate to scons * lfrfid: full io prox support * unit test: io prox protocol * SubGHZ: move bit defines to source * FSK oscillator: level duration compability * libs: bit manipulation library * lfrfid: ioprox protocol, use bit library and new level duration method of FSK ocillator * bit lib: unit tests * Bit lib: parity tests, remove every nth bit, copy bits * Lfrfid: awid protocol * bit lib: uint16 and uint32 getters, unit tests * lfrfid: FDX-B read, draft version * Minunit: better memeq assert * bit lib: reverse, print, print regions * Protocol dict: get protocol features, get protocol validate count * lfrfid worker: improved read * lfrfid raw worker: psk support * Cli: rfid plain C cli * protocol AWID: render * protocol em4100: render * protocol h10301: render * protocol indala26: support every indala 26 scramble * Protocol IO Prox: render * Protocol FDX-B: advanced read * lfrfid: remove unused test function * lfrfid: fix os primitives * bit lib: crc16 and unit tests * FDX-B: save data * lfrfid worker: increase stream size. Alloc raw worker only when needed. * lfrfid: indala26 emulation * lfrfid: prepare to write * lfrfid: fdx-b emulation * lfrfid: awid, ioprox write * lfrfid: write t55xx w\o validation * lfrfid: better t55xx block0 handling * lfrfid: use new t5577 functions in worker * lfrfid: improve protocol description * lfrfid: write and verify * lfrfid: delete cpp cli * lfrfid: improve worker usage * lfrfid-app: step to new worker * lfrfid: old indala (I40134) load fallback * lfrfid: indala26, recover wrong synced data * lfrfid: remove old worker * lfrfid app: dummy read screen * lfrfid app: less dummy read screen * lfrfid: generic 96-bit HID protocol (covers up to HID 37-bit) * rename * lfrfid: improve indala26 read * lfrfid: generic 192-bit HID protocol (covers all HID extended) * lfrfid: TODO about HID render * lfrfid: new protocol FDX-A * lfrfid-app: correct worker stop on exit * misc fixes * lfrfid: FDX-A and HID distinguishability has been fixed. * lfrfid: decode HID size header and render it (#1612) * lfrfid: rename HID96 and HID192 to HIDProx and HIDExt * lfrfid: extra actions scene * lfrfid: decode generic HID Proximity size lazily (#1618) * lib: stream of data buffers concept * lfrfid: raw file helper * lfrfid: changed raw worker api * lfrfid: packed varint pair * lfrfid: read stream speedup * lfrfid app: show read mode * Documentation * lfrfid app: raw read gui * lfrfid app: storage check for raw read * memleak fix * review fixes * lfrfid app: read blink color * lfrfid app: reset key name after read * review fixes * lfrfid app: fix copypasted text * review fixes * lfrfid: disable debug gpio * lfrfid: card detection events * lfrfid: change validation color from magenta to green * Update core_defines. * lfrfid: prefix fdx-b id by zeroes * lfrfid: parse up to 43-bit HID Proximity keys (#1640) * Fbt: downgrade toolchain and fix PS1 * lfrfid: fix unit tests * lfrfid app: remove printf * lfrfid: indala26, use bit 55 as data * lfrfid: indala26, better brief format * lfrfid: indala26, loading fallback * lfrfid: read timing tuning Co-authored-by: James Ide <ide@users.noreply.github.com> Co-authored-by: あく <alleteam@gmail.com>
This commit is contained in:
8
lib/one_wire/ibutton/protocols/ibutton_protocols.c
Normal file
8
lib/one_wire/ibutton/protocols/ibutton_protocols.c
Normal file
@@ -0,0 +1,8 @@
|
||||
#include "ibutton_protocols.h"
|
||||
#include "protocol_cyfral.h"
|
||||
#include "protocol_metakom.h"
|
||||
|
||||
const ProtocolBase* ibutton_protocols[] = {
|
||||
[iButtonProtocolCyfral] = &protocol_cyfral,
|
||||
[iButtonProtocolMetakom] = &protocol_metakom,
|
||||
};
|
11
lib/one_wire/ibutton/protocols/ibutton_protocols.h
Normal file
11
lib/one_wire/ibutton/protocols/ibutton_protocols.h
Normal file
@@ -0,0 +1,11 @@
|
||||
#pragma once
|
||||
#include "toolbox/protocols/protocol.h"
|
||||
|
||||
typedef enum {
|
||||
iButtonProtocolCyfral,
|
||||
iButtonProtocolMetakom,
|
||||
|
||||
iButtonProtocolMax,
|
||||
} iButtonProtocol;
|
||||
|
||||
extern const ProtocolBase* ibutton_protocols[];
|
344
lib/one_wire/ibutton/protocols/protocol_cyfral.c
Normal file
344
lib/one_wire/ibutton/protocols/protocol_cyfral.c
Normal file
@@ -0,0 +1,344 @@
|
||||
#include <furi.h>
|
||||
#include <furi_hal.h>
|
||||
#include "protocol_cyfral.h"
|
||||
|
||||
#define CYFRAL_DATA_SIZE sizeof(uint16_t)
|
||||
#define CYFRAL_PERIOD (125 * furi_hal_cortex_instructions_per_microsecond())
|
||||
#define CYFRAL_0_LOW (CYFRAL_PERIOD * 0.66f)
|
||||
#define CYFRAL_0_HI (CYFRAL_PERIOD * 0.33f)
|
||||
#define CYFRAL_1_LOW (CYFRAL_PERIOD * 0.33f)
|
||||
#define CYFRAL_1_HI (CYFRAL_PERIOD * 0.66f)
|
||||
|
||||
#define CYFRAL_MAX_PERIOD_US 230
|
||||
|
||||
typedef enum {
|
||||
CYFRAL_BIT_WAIT_FRONT_HIGH,
|
||||
CYFRAL_BIT_WAIT_FRONT_LOW,
|
||||
} CyfralBitState;
|
||||
|
||||
typedef enum {
|
||||
CYFRAL_WAIT_START_NIBBLE,
|
||||
CYFRAL_READ_NIBBLE,
|
||||
CYFRAL_READ_STOP_NIBBLE,
|
||||
} CyfralState;
|
||||
|
||||
typedef struct {
|
||||
CyfralState state;
|
||||
CyfralBitState bit_state;
|
||||
|
||||
// high + low period time
|
||||
uint32_t period_time;
|
||||
// temporary nibble storage
|
||||
uint8_t nibble;
|
||||
// data valid flag
|
||||
// MUST be checked only in READ_STOP_NIBBLE state
|
||||
bool data_valid;
|
||||
// nibble index, we expect 8 nibbles
|
||||
uint8_t index;
|
||||
// bit index in nibble, 4 bit per nibble
|
||||
uint8_t bit_index;
|
||||
// max period, 230us x clock per us
|
||||
uint32_t max_period;
|
||||
} ProtocolCyfralDecoder;
|
||||
|
||||
typedef struct {
|
||||
uint32_t data;
|
||||
uint32_t index;
|
||||
} ProtocolCyfralEncoder;
|
||||
|
||||
typedef struct {
|
||||
uint16_t data;
|
||||
|
||||
ProtocolCyfralDecoder decoder;
|
||||
ProtocolCyfralEncoder encoder;
|
||||
} ProtocolCyfral;
|
||||
|
||||
static void* protocol_cyfral_alloc(void) {
|
||||
ProtocolCyfral* proto = malloc(sizeof(ProtocolCyfral));
|
||||
return (void*)proto;
|
||||
}
|
||||
|
||||
static void protocol_cyfral_free(ProtocolCyfral* proto) {
|
||||
free(proto);
|
||||
}
|
||||
|
||||
static uint8_t* protocol_cyfral_get_data(ProtocolCyfral* proto) {
|
||||
return (uint8_t*)&proto->data;
|
||||
}
|
||||
|
||||
static void protocol_cyfral_decoder_start(ProtocolCyfral* proto) {
|
||||
ProtocolCyfralDecoder* cyfral = &proto->decoder;
|
||||
|
||||
cyfral->state = CYFRAL_WAIT_START_NIBBLE;
|
||||
cyfral->bit_state = CYFRAL_BIT_WAIT_FRONT_LOW;
|
||||
cyfral->period_time = 0;
|
||||
cyfral->bit_index = 0;
|
||||
cyfral->index = 0;
|
||||
cyfral->nibble = 0;
|
||||
cyfral->data_valid = true;
|
||||
cyfral->max_period = CYFRAL_MAX_PERIOD_US * furi_hal_cortex_instructions_per_microsecond();
|
||||
|
||||
proto->data = 0;
|
||||
}
|
||||
|
||||
static bool protocol_cyfral_decoder_process_bit(
|
||||
ProtocolCyfralDecoder* cyfral,
|
||||
bool polarity,
|
||||
uint32_t length,
|
||||
bool* bit_ready,
|
||||
bool* bit_value) {
|
||||
bool result = true;
|
||||
*bit_ready = false;
|
||||
|
||||
// bit start from low
|
||||
switch(cyfral->bit_state) {
|
||||
case CYFRAL_BIT_WAIT_FRONT_LOW:
|
||||
if(polarity == true) {
|
||||
cyfral->period_time += length;
|
||||
|
||||
*bit_ready = true;
|
||||
if(cyfral->period_time <= cyfral->max_period) {
|
||||
if((cyfral->period_time / 2) > length) {
|
||||
*bit_value = false;
|
||||
} else {
|
||||
*bit_value = true;
|
||||
}
|
||||
} else {
|
||||
result = false;
|
||||
}
|
||||
|
||||
cyfral->bit_state = CYFRAL_BIT_WAIT_FRONT_HIGH;
|
||||
} else {
|
||||
result = false;
|
||||
}
|
||||
break;
|
||||
case CYFRAL_BIT_WAIT_FRONT_HIGH:
|
||||
if(polarity == false) {
|
||||
cyfral->period_time = length;
|
||||
cyfral->bit_state = CYFRAL_BIT_WAIT_FRONT_LOW;
|
||||
} else {
|
||||
result = false;
|
||||
}
|
||||
break;
|
||||
}
|
||||
|
||||
return result;
|
||||
}
|
||||
|
||||
static bool protocol_cyfral_decoder_feed(ProtocolCyfral* proto, bool level, uint32_t duration) {
|
||||
ProtocolCyfralDecoder* cyfral = &proto->decoder;
|
||||
|
||||
bool bit_ready;
|
||||
bool bit_value;
|
||||
bool decoded = false;
|
||||
|
||||
switch(cyfral->state) {
|
||||
case CYFRAL_WAIT_START_NIBBLE:
|
||||
// wait for start word
|
||||
if(protocol_cyfral_decoder_process_bit(cyfral, level, duration, &bit_ready, &bit_value)) {
|
||||
if(bit_ready) {
|
||||
cyfral->nibble = ((cyfral->nibble << 1) | bit_value) & 0x0F;
|
||||
if(cyfral->nibble == 0b0001) {
|
||||
cyfral->nibble = 0;
|
||||
cyfral->state = CYFRAL_READ_NIBBLE;
|
||||
}
|
||||
}
|
||||
} else {
|
||||
protocol_cyfral_decoder_start(proto);
|
||||
}
|
||||
|
||||
break;
|
||||
case CYFRAL_READ_NIBBLE:
|
||||
// read nibbles
|
||||
if(protocol_cyfral_decoder_process_bit(cyfral, level, duration, &bit_ready, &bit_value)) {
|
||||
if(bit_ready) {
|
||||
cyfral->nibble = (cyfral->nibble << 1) | bit_value;
|
||||
|
||||
cyfral->bit_index++;
|
||||
|
||||
//convert every nibble to 2-bit index
|
||||
if(cyfral->bit_index == 4) {
|
||||
switch(cyfral->nibble) {
|
||||
case 0b1110:
|
||||
proto->data = (proto->data << 2) | 0b11;
|
||||
break;
|
||||
case 0b1101:
|
||||
proto->data = (proto->data << 2) | 0b10;
|
||||
break;
|
||||
case 0b1011:
|
||||
proto->data = (proto->data << 2) | 0b01;
|
||||
break;
|
||||
case 0b0111:
|
||||
proto->data = (proto->data << 2) | 0b00;
|
||||
break;
|
||||
default:
|
||||
cyfral->data_valid = false;
|
||||
break;
|
||||
}
|
||||
|
||||
cyfral->nibble = 0;
|
||||
cyfral->bit_index = 0;
|
||||
cyfral->index++;
|
||||
}
|
||||
|
||||
// succefully read 8 nibbles
|
||||
if(cyfral->index == 8) {
|
||||
cyfral->state = CYFRAL_READ_STOP_NIBBLE;
|
||||
}
|
||||
}
|
||||
} else {
|
||||
protocol_cyfral_decoder_start(proto);
|
||||
}
|
||||
break;
|
||||
case CYFRAL_READ_STOP_NIBBLE:
|
||||
// read stop nibble
|
||||
if(protocol_cyfral_decoder_process_bit(cyfral, level, duration, &bit_ready, &bit_value)) {
|
||||
if(bit_ready) {
|
||||
cyfral->nibble = ((cyfral->nibble << 1) | bit_value) & 0x0F;
|
||||
cyfral->bit_index++;
|
||||
|
||||
switch(cyfral->bit_index) {
|
||||
case 0:
|
||||
case 1:
|
||||
case 2:
|
||||
case 3:
|
||||
break;
|
||||
case 4:
|
||||
if(cyfral->nibble == 0b0001) {
|
||||
// validate data
|
||||
if(cyfral->data_valid) {
|
||||
decoded = true;
|
||||
} else {
|
||||
protocol_cyfral_decoder_start(proto);
|
||||
}
|
||||
} else {
|
||||
protocol_cyfral_decoder_start(proto);
|
||||
}
|
||||
break;
|
||||
default:
|
||||
protocol_cyfral_decoder_start(proto);
|
||||
break;
|
||||
}
|
||||
}
|
||||
} else {
|
||||
protocol_cyfral_decoder_start(proto);
|
||||
}
|
||||
break;
|
||||
}
|
||||
|
||||
return decoded;
|
||||
}
|
||||
|
||||
static uint32_t protocol_cyfral_encoder_encode(const uint16_t data) {
|
||||
uint32_t value = 0;
|
||||
for(int8_t i = 0; i <= 7; i++) {
|
||||
switch((data >> (i * 2)) & 0b00000011) {
|
||||
case 0b11:
|
||||
value = value << 4;
|
||||
value += 0b00000111;
|
||||
break;
|
||||
case 0b10:
|
||||
value = value << 4;
|
||||
value += 0b00001011;
|
||||
break;
|
||||
case 0b01:
|
||||
value = value << 4;
|
||||
value += 0b00001101;
|
||||
break;
|
||||
case 0b00:
|
||||
value = value << 4;
|
||||
value += 0b00001110;
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
return value;
|
||||
}
|
||||
|
||||
static bool protocol_cyfral_encoder_start(ProtocolCyfral* proto) {
|
||||
proto->encoder.index = 0;
|
||||
proto->encoder.data = protocol_cyfral_encoder_encode(proto->data);
|
||||
return true;
|
||||
}
|
||||
|
||||
static LevelDuration protocol_cyfral_encoder_yield(ProtocolCyfral* proto) {
|
||||
LevelDuration result;
|
||||
|
||||
if(proto->encoder.index < 8) {
|
||||
// start word (0b0001)
|
||||
switch(proto->encoder.index) {
|
||||
case 0:
|
||||
result = level_duration_make(false, CYFRAL_0_LOW);
|
||||
break;
|
||||
case 1:
|
||||
result = level_duration_make(true, CYFRAL_0_HI);
|
||||
break;
|
||||
case 2:
|
||||
result = level_duration_make(false, CYFRAL_0_LOW);
|
||||
break;
|
||||
case 3:
|
||||
result = level_duration_make(true, CYFRAL_0_HI);
|
||||
break;
|
||||
case 4:
|
||||
result = level_duration_make(false, CYFRAL_0_LOW);
|
||||
break;
|
||||
case 5:
|
||||
result = level_duration_make(true, CYFRAL_0_HI);
|
||||
break;
|
||||
case 6:
|
||||
result = level_duration_make(false, CYFRAL_1_LOW);
|
||||
break;
|
||||
case 7:
|
||||
result = level_duration_make(true, CYFRAL_1_HI);
|
||||
break;
|
||||
}
|
||||
} else {
|
||||
// data
|
||||
uint8_t data_start_index = proto->encoder.index - 8;
|
||||
bool clock_polarity = (data_start_index) % 2;
|
||||
uint8_t bit_index = (data_start_index) / 2;
|
||||
bool bit_value = ((proto->encoder.data >> bit_index) & 1);
|
||||
|
||||
if(!clock_polarity) {
|
||||
if(bit_value) {
|
||||
result = level_duration_make(false, CYFRAL_1_LOW);
|
||||
} else {
|
||||
result = level_duration_make(false, CYFRAL_0_LOW);
|
||||
}
|
||||
} else {
|
||||
if(bit_value) {
|
||||
result = level_duration_make(true, CYFRAL_1_HI);
|
||||
} else {
|
||||
result = level_duration_make(true, CYFRAL_0_HI);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
proto->encoder.index++;
|
||||
if(proto->encoder.index >= (9 * 4 * 2)) {
|
||||
proto->encoder.index = 0;
|
||||
}
|
||||
|
||||
return result;
|
||||
}
|
||||
|
||||
const ProtocolBase protocol_cyfral = {
|
||||
.name = "Cyfral",
|
||||
.manufacturer = "Cyfral",
|
||||
.data_size = CYFRAL_DATA_SIZE,
|
||||
.alloc = (ProtocolAlloc)protocol_cyfral_alloc,
|
||||
.free = (ProtocolFree)protocol_cyfral_free,
|
||||
.get_data = (ProtocolGetData)protocol_cyfral_get_data,
|
||||
.decoder =
|
||||
{
|
||||
.start = (ProtocolDecoderStart)protocol_cyfral_decoder_start,
|
||||
.feed = (ProtocolDecoderFeed)protocol_cyfral_decoder_feed,
|
||||
},
|
||||
.encoder =
|
||||
{
|
||||
.start = (ProtocolEncoderStart)protocol_cyfral_encoder_start,
|
||||
.yield = (ProtocolEncoderYield)protocol_cyfral_encoder_yield,
|
||||
},
|
||||
};
|
4
lib/one_wire/ibutton/protocols/protocol_cyfral.h
Normal file
4
lib/one_wire/ibutton/protocols/protocol_cyfral.h
Normal file
@@ -0,0 +1,4 @@
|
||||
#pragma once
|
||||
#include "toolbox/protocols/protocol.h"
|
||||
|
||||
extern const ProtocolBase protocol_cyfral;
|
320
lib/one_wire/ibutton/protocols/protocol_metakom.c
Normal file
320
lib/one_wire/ibutton/protocols/protocol_metakom.c
Normal file
@@ -0,0 +1,320 @@
|
||||
#include <furi.h>
|
||||
#include <furi_hal.h>
|
||||
#include "protocol_metakom.h"
|
||||
|
||||
#define METAKOM_DATA_SIZE sizeof(uint32_t)
|
||||
#define METAKOM_PERIOD (125 * furi_hal_cortex_instructions_per_microsecond())
|
||||
#define METAKOM_0_LOW (METAKOM_PERIOD * 0.33f)
|
||||
#define METAKOM_0_HI (METAKOM_PERIOD * 0.66f)
|
||||
#define METAKOM_1_LOW (METAKOM_PERIOD * 0.66f)
|
||||
#define METAKOM_1_HI (METAKOM_PERIOD * 0.33f)
|
||||
|
||||
#define METAKOM_PERIOD_SAMPLE_COUNT 10
|
||||
|
||||
typedef enum {
|
||||
METAKOM_WAIT_PERIOD_SYNC,
|
||||
METAKOM_WAIT_START_BIT,
|
||||
METAKOM_WAIT_START_WORD,
|
||||
METAKOM_READ_WORD,
|
||||
METAKOM_READ_STOP_WORD,
|
||||
} MetakomState;
|
||||
|
||||
typedef enum {
|
||||
METAKOM_BIT_WAIT_FRONT_HIGH,
|
||||
METAKOM_BIT_WAIT_FRONT_LOW,
|
||||
} MetakomBitState;
|
||||
|
||||
typedef struct {
|
||||
// high + low period time
|
||||
uint32_t period_time;
|
||||
uint32_t low_time_storage;
|
||||
uint8_t period_sample_index;
|
||||
uint32_t period_sample_data[METAKOM_PERIOD_SAMPLE_COUNT];
|
||||
|
||||
uint8_t tmp_data;
|
||||
uint8_t tmp_counter;
|
||||
|
||||
uint8_t key_data_index;
|
||||
|
||||
MetakomBitState bit_state;
|
||||
MetakomState state;
|
||||
} ProtocolMetakomDecoder;
|
||||
|
||||
typedef struct {
|
||||
uint32_t index;
|
||||
} ProtocolMetakomEncoder;
|
||||
|
||||
typedef struct {
|
||||
uint32_t data;
|
||||
|
||||
ProtocolMetakomDecoder decoder;
|
||||
ProtocolMetakomEncoder encoder;
|
||||
} ProtocolMetakom;
|
||||
|
||||
static ProtocolMetakom* protocol_metakom_alloc(void) {
|
||||
ProtocolMetakom* proto = malloc(sizeof(ProtocolMetakom));
|
||||
return (void*)proto;
|
||||
}
|
||||
|
||||
static void protocol_metakom_free(ProtocolMetakom* proto) {
|
||||
free(proto);
|
||||
}
|
||||
|
||||
static uint8_t* protocol_metakom_get_data(ProtocolMetakom* proto) {
|
||||
return (uint8_t*)&proto->data;
|
||||
}
|
||||
|
||||
static void protocol_metakom_decoder_start(ProtocolMetakom* proto) {
|
||||
ProtocolMetakomDecoder* metakom = &proto->decoder;
|
||||
|
||||
metakom->period_sample_index = 0;
|
||||
metakom->period_time = 0;
|
||||
metakom->tmp_counter = 0;
|
||||
metakom->tmp_data = 0;
|
||||
for(uint8_t i = 0; i < METAKOM_PERIOD_SAMPLE_COUNT; i++) {
|
||||
metakom->period_sample_data[i] = 0;
|
||||
};
|
||||
metakom->state = METAKOM_WAIT_PERIOD_SYNC;
|
||||
metakom->bit_state = METAKOM_BIT_WAIT_FRONT_LOW;
|
||||
metakom->key_data_index = 0;
|
||||
metakom->low_time_storage = 0;
|
||||
|
||||
proto->data = 0;
|
||||
}
|
||||
|
||||
static bool metakom_parity_check(uint8_t data) {
|
||||
uint8_t ones_count = 0;
|
||||
bool result;
|
||||
|
||||
for(uint8_t i = 0; i < 8; i++) {
|
||||
if((data >> i) & 0b00000001) {
|
||||
ones_count++;
|
||||
}
|
||||
}
|
||||
|
||||
result = (ones_count % 2 == 0);
|
||||
|
||||
return result;
|
||||
}
|
||||
|
||||
static bool metakom_process_bit(
|
||||
ProtocolMetakomDecoder* metakom,
|
||||
bool polarity,
|
||||
uint32_t time,
|
||||
uint32_t* high_time,
|
||||
uint32_t* low_time) {
|
||||
bool result = false;
|
||||
|
||||
switch(metakom->bit_state) {
|
||||
case METAKOM_BIT_WAIT_FRONT_LOW:
|
||||
if(polarity == false) {
|
||||
*low_time = metakom->low_time_storage;
|
||||
*high_time = time;
|
||||
result = true;
|
||||
metakom->bit_state = METAKOM_BIT_WAIT_FRONT_HIGH;
|
||||
}
|
||||
break;
|
||||
case METAKOM_BIT_WAIT_FRONT_HIGH:
|
||||
if(polarity == true) {
|
||||
metakom->low_time_storage = time;
|
||||
metakom->bit_state = METAKOM_BIT_WAIT_FRONT_LOW;
|
||||
}
|
||||
break;
|
||||
}
|
||||
|
||||
return result;
|
||||
}
|
||||
|
||||
static bool protocol_metakom_decoder_feed(ProtocolMetakom* proto, bool level, uint32_t duration) {
|
||||
ProtocolMetakomDecoder* metakom = &proto->decoder;
|
||||
|
||||
bool ready = false;
|
||||
|
||||
uint32_t high_time = 0;
|
||||
uint32_t low_time = 0;
|
||||
|
||||
switch(metakom->state) {
|
||||
case METAKOM_WAIT_PERIOD_SYNC:
|
||||
if(metakom_process_bit(metakom, level, duration, &high_time, &low_time)) {
|
||||
metakom->period_sample_data[metakom->period_sample_index] = high_time + low_time;
|
||||
metakom->period_sample_index++;
|
||||
|
||||
if(metakom->period_sample_index == METAKOM_PERIOD_SAMPLE_COUNT) {
|
||||
for(uint8_t i = 0; i < METAKOM_PERIOD_SAMPLE_COUNT; i++) {
|
||||
metakom->period_time += metakom->period_sample_data[i];
|
||||
};
|
||||
metakom->period_time /= METAKOM_PERIOD_SAMPLE_COUNT;
|
||||
|
||||
metakom->state = METAKOM_WAIT_START_BIT;
|
||||
}
|
||||
}
|
||||
|
||||
break;
|
||||
case METAKOM_WAIT_START_BIT:
|
||||
if(metakom_process_bit(metakom, level, duration, &high_time, &low_time)) {
|
||||
metakom->tmp_counter++;
|
||||
if(high_time > metakom->period_time) {
|
||||
metakom->tmp_counter = 0;
|
||||
metakom->state = METAKOM_WAIT_START_WORD;
|
||||
}
|
||||
|
||||
if(metakom->tmp_counter > 40) {
|
||||
protocol_metakom_decoder_start(proto);
|
||||
}
|
||||
}
|
||||
|
||||
break;
|
||||
case METAKOM_WAIT_START_WORD:
|
||||
if(metakom_process_bit(metakom, level, duration, &high_time, &low_time)) {
|
||||
if(low_time < (metakom->period_time / 2)) {
|
||||
metakom->tmp_data = (metakom->tmp_data << 1) | 0b0;
|
||||
} else {
|
||||
metakom->tmp_data = (metakom->tmp_data << 1) | 0b1;
|
||||
}
|
||||
metakom->tmp_counter++;
|
||||
|
||||
if(metakom->tmp_counter == 3) {
|
||||
if(metakom->tmp_data == 0b010) {
|
||||
metakom->tmp_counter = 0;
|
||||
metakom->tmp_data = 0;
|
||||
metakom->state = METAKOM_READ_WORD;
|
||||
} else {
|
||||
protocol_metakom_decoder_start(proto);
|
||||
}
|
||||
}
|
||||
}
|
||||
break;
|
||||
case METAKOM_READ_WORD:
|
||||
if(metakom_process_bit(metakom, level, duration, &high_time, &low_time)) {
|
||||
if(low_time < (metakom->period_time / 2)) {
|
||||
metakom->tmp_data = (metakom->tmp_data << 1) | 0b0;
|
||||
} else {
|
||||
metakom->tmp_data = (metakom->tmp_data << 1) | 0b1;
|
||||
}
|
||||
metakom->tmp_counter++;
|
||||
|
||||
if(metakom->tmp_counter == 8) {
|
||||
if(metakom_parity_check(metakom->tmp_data)) {
|
||||
proto->data = (proto->data << 8) | metakom->tmp_data;
|
||||
metakom->key_data_index++;
|
||||
metakom->tmp_data = 0;
|
||||
metakom->tmp_counter = 0;
|
||||
|
||||
if(metakom->key_data_index == 4) {
|
||||
// check for stop bit
|
||||
if(high_time > metakom->period_time) {
|
||||
metakom->state = METAKOM_READ_STOP_WORD;
|
||||
} else {
|
||||
protocol_metakom_decoder_start(proto);
|
||||
}
|
||||
}
|
||||
} else {
|
||||
protocol_metakom_decoder_start(proto);
|
||||
}
|
||||
}
|
||||
}
|
||||
break;
|
||||
case METAKOM_READ_STOP_WORD:
|
||||
if(metakom_process_bit(metakom, level, duration, &high_time, &low_time)) {
|
||||
if(low_time < (metakom->period_time / 2)) {
|
||||
metakom->tmp_data = (metakom->tmp_data << 1) | 0b0;
|
||||
} else {
|
||||
metakom->tmp_data = (metakom->tmp_data << 1) | 0b1;
|
||||
}
|
||||
metakom->tmp_counter++;
|
||||
|
||||
if(metakom->tmp_counter == 3) {
|
||||
if(metakom->tmp_data == 0b010) {
|
||||
ready = true;
|
||||
} else {
|
||||
protocol_metakom_decoder_start(proto);
|
||||
}
|
||||
}
|
||||
}
|
||||
break;
|
||||
}
|
||||
|
||||
return ready;
|
||||
}
|
||||
|
||||
static bool protocol_metakom_encoder_start(ProtocolMetakom* proto) {
|
||||
proto->encoder.index = 0;
|
||||
return true;
|
||||
}
|
||||
|
||||
static LevelDuration protocol_metakom_encoder_yield(ProtocolMetakom* proto) {
|
||||
LevelDuration result;
|
||||
|
||||
if(proto->encoder.index == 0) {
|
||||
// sync bit
|
||||
result = level_duration_make(false, METAKOM_PERIOD);
|
||||
} else if(proto->encoder.index >= 1 && proto->encoder.index <= 6) {
|
||||
// start word (0b010)
|
||||
switch(proto->encoder.index) {
|
||||
case 1:
|
||||
result = level_duration_make(true, METAKOM_0_LOW);
|
||||
break;
|
||||
case 2:
|
||||
result = level_duration_make(false, METAKOM_0_HI);
|
||||
break;
|
||||
case 3:
|
||||
result = level_duration_make(true, METAKOM_1_LOW);
|
||||
break;
|
||||
case 4:
|
||||
result = level_duration_make(false, METAKOM_1_HI);
|
||||
break;
|
||||
case 5:
|
||||
result = level_duration_make(true, METAKOM_0_LOW);
|
||||
break;
|
||||
case 6:
|
||||
result = level_duration_make(false, METAKOM_0_HI);
|
||||
break;
|
||||
}
|
||||
} else {
|
||||
// data
|
||||
uint8_t data_start_index = proto->encoder.index - 7;
|
||||
bool clock_polarity = (data_start_index) % 2;
|
||||
uint8_t bit_index = (data_start_index) / 2;
|
||||
bool bit_value = (proto->data >> (32 - 1 - bit_index)) & 1;
|
||||
|
||||
if(!clock_polarity) {
|
||||
if(bit_value) {
|
||||
result = level_duration_make(true, METAKOM_1_LOW);
|
||||
} else {
|
||||
result = level_duration_make(true, METAKOM_0_LOW);
|
||||
}
|
||||
} else {
|
||||
if(bit_value) {
|
||||
result = level_duration_make(false, METAKOM_1_HI);
|
||||
} else {
|
||||
result = level_duration_make(false, METAKOM_0_HI);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
proto->encoder.index++;
|
||||
if(proto->encoder.index >= (1 + 3 * 2 + 32 * 2)) {
|
||||
proto->encoder.index = 0;
|
||||
}
|
||||
|
||||
return result;
|
||||
}
|
||||
|
||||
const ProtocolBase protocol_metakom = {
|
||||
.name = "Metakom",
|
||||
.manufacturer = "Metakom",
|
||||
.data_size = METAKOM_DATA_SIZE,
|
||||
.alloc = (ProtocolAlloc)protocol_metakom_alloc,
|
||||
.free = (ProtocolFree)protocol_metakom_free,
|
||||
.get_data = (ProtocolGetData)protocol_metakom_get_data,
|
||||
.decoder =
|
||||
{
|
||||
.start = (ProtocolDecoderStart)protocol_metakom_decoder_start,
|
||||
.feed = (ProtocolDecoderFeed)protocol_metakom_decoder_feed,
|
||||
},
|
||||
.encoder =
|
||||
{
|
||||
.start = (ProtocolEncoderStart)protocol_metakom_encoder_start,
|
||||
.yield = (ProtocolEncoderYield)protocol_metakom_encoder_yield,
|
||||
},
|
||||
};
|
4
lib/one_wire/ibutton/protocols/protocol_metakom.h
Normal file
4
lib/one_wire/ibutton/protocols/protocol_metakom.h
Normal file
@@ -0,0 +1,4 @@
|
||||
#pragma once
|
||||
#include "toolbox/protocols/protocol.h"
|
||||
|
||||
extern const ProtocolBase protocol_metakom;
|
Reference in New Issue
Block a user