unleashed-firmware/applications/lfrfid/helpers/pulse-joiner.cpp
SG 22e1ecb642
New LF-RFID app ()
* Hal lfrfid: add read timer pulse and period config fns
* New debug application for lfrfid subsystem
* New lfrfid: app, fix naming
* App lfrfid: assets
* Container view module
* App ibutton: remove unused header
* App lfrfid scenes
* App notification, add yield to blocking operations, add speaker volume control
* App lfrfid: reading key scene
* Assets: placeholder icon
* App lfrfid: reworked container view module
* App lfrfid: new scenes
* App lfrfid: write scene
* App lfrfid: write hid
* App lfrfid: emulate scene
* App lfrfid: save name scene
* App lfrfid: add missing file
2021-06-28 17:42:30 +03:00

96 lines
2.4 KiB
C++

#include "pulse-joiner.h"
#include <furi.h>
bool PulseJoiner::push_pulse(bool polarity, uint16_t period, uint16_t pulse) {
bool result = false;
furi_check((pulse_index + 1) < pulse_max);
if(polarity == false && pulse_index == 0) {
// first negative pulse is ommited
} else {
pulses[pulse_index].polarity = polarity;
pulses[pulse_index].time = pulse;
pulse_index++;
}
if(period > pulse) {
pulses[pulse_index].polarity = !polarity;
pulses[pulse_index].time = period - pulse;
pulse_index++;
}
if(pulse_index >= 4) {
// we know that first pulse is always high
// so we wait 2 edges, hi2low and next low2hi
uint8_t edges_count = 0;
bool last_polarity = pulses[0].polarity;
for(uint8_t i = 1; i < pulse_index; i++) {
if(pulses[i].polarity != last_polarity) {
edges_count++;
last_polarity = pulses[i].polarity;
}
}
if(edges_count >= 2) {
result = true;
}
}
return result;
}
void PulseJoiner::pop_pulse(uint16_t* period, uint16_t* pulse) {
furi_check(pulse_index <= (pulse_max + 1));
uint16_t tmp_period = 0;
uint16_t tmp_pulse = 0;
uint8_t edges_count = 0;
bool last_polarity = pulses[0].polarity;
uint8_t next_fist_pulse = 0;
for(uint8_t i = 0; i < pulse_max; i++) {
// count edges
if(pulses[i].polarity != last_polarity) {
edges_count++;
last_polarity = pulses[i].polarity;
}
// wait for 2 edges
if(edges_count == 2) {
next_fist_pulse = i;
break;
}
// sum pulse time
if(pulses[i].polarity) {
tmp_period += pulses[i].time;
tmp_pulse += pulses[i].time;
} else {
tmp_period += pulses[i].time;
}
pulse_index--;
}
*period = tmp_period;
*pulse = tmp_pulse;
// remove counted periods and shift data
for(uint8_t i = 0; i < pulse_max; i++) {
if((next_fist_pulse + i) < pulse_max) {
pulses[i].polarity = pulses[next_fist_pulse + i].polarity;
pulses[i].time = pulses[next_fist_pulse + i].time;
} else {
break;
}
}
}
PulseJoiner::PulseJoiner() {
for(uint8_t i = 0; i < pulse_max; i++) {
pulses[i] = {false, 0};
}
}