22e1ecb642
* 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
96 lines
2.4 KiB
C++
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};
|
|
}
|
|
}
|