9bfb641d3e
* 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>
94 lines
2.1 KiB
C
94 lines
2.1 KiB
C
#include <furi.h>
|
|
#include "fsk_demod.h"
|
|
|
|
struct FSKDemod {
|
|
uint32_t low_time;
|
|
uint32_t low_pulses;
|
|
uint32_t hi_time;
|
|
uint32_t hi_pulses;
|
|
|
|
bool invert;
|
|
uint32_t mid_time;
|
|
uint32_t time;
|
|
uint32_t count;
|
|
bool last_pulse;
|
|
};
|
|
|
|
FSKDemod*
|
|
fsk_demod_alloc(uint32_t low_time, uint32_t low_pulses, uint32_t hi_time, uint32_t hi_pulses) {
|
|
FSKDemod* demod = malloc(sizeof(FSKDemod));
|
|
demod->invert = false;
|
|
|
|
if(low_time > hi_time) {
|
|
uint32_t tmp;
|
|
tmp = hi_time;
|
|
hi_time = low_time;
|
|
low_time = tmp;
|
|
|
|
tmp = hi_pulses;
|
|
hi_pulses = low_pulses;
|
|
low_pulses = tmp;
|
|
|
|
demod->invert = true;
|
|
}
|
|
|
|
demod->low_time = low_time;
|
|
demod->low_pulses = low_pulses;
|
|
demod->hi_time = hi_time;
|
|
demod->hi_pulses = hi_pulses;
|
|
|
|
demod->mid_time = (hi_time - low_time) / 2 + low_time;
|
|
demod->time = 0;
|
|
demod->count = 0;
|
|
demod->last_pulse = false;
|
|
|
|
return demod;
|
|
}
|
|
|
|
void fsk_demod_free(FSKDemod* demod) {
|
|
free(demod);
|
|
}
|
|
|
|
void fsk_demod_feed(FSKDemod* demod, bool polarity, uint32_t time, bool* value, uint32_t* count) {
|
|
*count = 0;
|
|
|
|
if(polarity) {
|
|
// accumulate time
|
|
demod->time = time;
|
|
} else {
|
|
demod->time += time;
|
|
|
|
// check for valid pulse
|
|
if(demod->time >= demod->low_time && demod->time < demod->hi_time) {
|
|
bool pulse;
|
|
|
|
if(demod->time < demod->mid_time) {
|
|
pulse = false;
|
|
} else {
|
|
pulse = true;
|
|
}
|
|
|
|
demod->count++;
|
|
|
|
// check for edge transition
|
|
if(demod->last_pulse != pulse) {
|
|
uint32_t data_count = demod->count + 1;
|
|
|
|
if(demod->last_pulse) {
|
|
data_count /= demod->hi_pulses;
|
|
*value = !demod->invert;
|
|
} else {
|
|
data_count /= demod->low_pulses;
|
|
*value = demod->invert;
|
|
}
|
|
|
|
*count = data_count;
|
|
demod->count = 0;
|
|
demod->last_pulse = pulse;
|
|
}
|
|
} else {
|
|
demod->count = 0;
|
|
}
|
|
}
|
|
}
|