unleashed-firmware/lib/toolbox/manchester_encoder.c

61 lines
1.4 KiB
C
Raw Normal View History

#include "manchester_encoder.h"
#include <furi.h>
void manchester_encoder_reset(ManchesterEncoderState* state) {
furi_check(state);
state->step = 0;
}
bool manchester_encoder_advance(
ManchesterEncoderState* state,
const bool curr_bit,
ManchesterEncoderResult* result) {
furi_check(state);
furi_check(result);
bool advance = false;
switch(state->step) {
case 0:
state->prev_bit = curr_bit;
if(state->prev_bit) {
*result = ManchesterEncoderResultShortLow;
} else {
*result = ManchesterEncoderResultShortHigh;
}
state->step = 1;
advance = true;
break;
case 1:
*result = (state->prev_bit << 1) + curr_bit;
if(curr_bit == state->prev_bit) {
state->step = 2;
} else {
state->prev_bit = curr_bit;
advance = true;
}
break;
case 2:
if(curr_bit) {
*result = ManchesterEncoderResultShortLow;
} else {
*result = ManchesterEncoderResultShortHigh;
}
state->prev_bit = curr_bit;
state->step = 1;
advance = true;
break;
default:
furi_crash();
break;
}
return advance;
}
ManchesterEncoderResult manchester_encoder_finish(ManchesterEncoderState* state) {
furi_check(state);
state->step = 0;
return (state->prev_bit << 1) + state->prev_bit;
}