54 lines
1.4 KiB
C
54 lines
1.4 KiB
C
|
#include "manchester-encoder.h"
|
||
|
#include <stdio.h>
|
||
|
|
||
|
void manchester_encoder_reset(ManchesterEncoderState* state) {
|
||
|
state->step = 0;
|
||
|
}
|
||
|
|
||
|
bool manchester_encoder_advance(
|
||
|
ManchesterEncoderState* state,
|
||
|
const bool curr_bit,
|
||
|
ManchesterEncoderResult* 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:
|
||
|
printf("DO CRASH HERE\r\n");
|
||
|
// furi_crash
|
||
|
break;
|
||
|
}
|
||
|
return advance;
|
||
|
}
|
||
|
|
||
|
ManchesterEncoderResult manchester_encoder_finish(ManchesterEncoderState* state) {
|
||
|
state->step = 0;
|
||
|
return (state->prev_bit << 1) + state->prev_bit;
|
||
|
}
|