[FL-1156, FL-1249] Add IRDA encoder/decoder library (#451)
* Add cscope db generation * Add api-hal-irda, TIM2: HAL->LL * Add libirda: pwm decoding * Universal state machine * Add irda decoder library * Move IRDA capture to standalone tool * Add encoder/decoder samsung32, NEC, fix bugs * Port current App to new Irda lib * Fix clang format for test data * Port IRDA api-hal to f6 Co-authored-by: あく <alleteam@gmail.com>
This commit is contained in:
Albert Kharisov
GitHub
166
lib/irda/irda_common_decoder.c
Normal file
166
lib/irda/irda_common_decoder.c
Normal file
@@ -0,0 +1,166 @@
|
||||
#include <stdbool.h>
|
||||
#include <furi.h>
|
||||
#include "irda_i.h"
|
||||
|
||||
|
||||
static bool irda_check_preamble(IrdaCommonDecoder* decoder) {
|
||||
furi_assert(decoder);
|
||||
|
||||
bool result = false;
|
||||
bool start_level = (decoder->level + decoder->timings_cnt + 1) % 2;
|
||||
|
||||
// align to start at Mark timing
|
||||
if (start_level) {
|
||||
if (decoder->timings_cnt > 0) {
|
||||
--decoder->timings_cnt;
|
||||
shift_left_array(decoder->timings, decoder->timings_cnt, 1);
|
||||
}
|
||||
}
|
||||
|
||||
while ((!result) && (decoder->timings_cnt >= 2)) {
|
||||
float preamble_tolerance = decoder->protocol->timings.preamble_tolerance;
|
||||
uint16_t preamble_mark = decoder->protocol->timings.preamble_mark;
|
||||
uint16_t preamble_space = decoder->protocol->timings.preamble_space;
|
||||
|
||||
if ((MATCH_PREAMBLE_TIMING(decoder->timings[0], preamble_mark, preamble_tolerance))
|
||||
&& (MATCH_PREAMBLE_TIMING(decoder->timings[1], preamble_space, preamble_tolerance))) {
|
||||
result = true;
|
||||
}
|
||||
|
||||
decoder->timings_cnt -= 2;
|
||||
shift_left_array(decoder->timings, decoder->timings_cnt, 2);
|
||||
}
|
||||
|
||||
return result;
|
||||
}
|
||||
|
||||
// Pulse Distance-Width Modulation
|
||||
DecodeStatus irda_common_decode_pdwm(IrdaCommonDecoder* decoder) {
|
||||
furi_assert(decoder);
|
||||
|
||||
uint32_t* timings = decoder->timings;
|
||||
uint16_t index = 0;
|
||||
uint8_t shift = 0;
|
||||
DecodeStatus status = DecodeStatusError;
|
||||
uint32_t bit_tolerance = decoder->protocol->timings.bit_tolerance;
|
||||
uint16_t bit1_mark = decoder->protocol->timings.bit1_mark;
|
||||
uint16_t bit1_space = decoder->protocol->timings.bit1_space;
|
||||
uint16_t bit0_mark = decoder->protocol->timings.bit0_mark;
|
||||
uint16_t bit0_space = decoder->protocol->timings.bit0_space;
|
||||
|
||||
while (1) {
|
||||
// Stop bit
|
||||
if ((decoder->databit_cnt == decoder->protocol->databit_len) && (decoder->timings_cnt == 1)) {
|
||||
if (MATCH_BIT_TIMING(timings[0], bit1_mark, bit_tolerance)) {
|
||||
decoder->timings_cnt = 0;
|
||||
status = DecodeStatusReady;
|
||||
} else {
|
||||
status = DecodeStatusError;
|
||||
}
|
||||
break;
|
||||
}
|
||||
|
||||
if (decoder->timings_cnt >= 2) {
|
||||
index = decoder->databit_cnt / 8;
|
||||
shift = decoder->databit_cnt % 8; // LSB first
|
||||
if (!shift)
|
||||
decoder->data[index] = 0;
|
||||
if (MATCH_BIT_TIMING(timings[0], bit1_mark, bit_tolerance)
|
||||
&& MATCH_BIT_TIMING(timings[1], bit1_space, bit_tolerance)) {
|
||||
decoder->data[index] |= (0x1 << shift); // add 1
|
||||
} else if (MATCH_BIT_TIMING(timings[0], bit0_mark, bit_tolerance)
|
||||
&& MATCH_BIT_TIMING(timings[1], bit0_space, bit_tolerance)) {
|
||||
(void) decoder->data[index]; // add 0
|
||||
} else {
|
||||
status = DecodeStatusError;
|
||||
break;
|
||||
}
|
||||
++decoder->databit_cnt;
|
||||
decoder->timings_cnt -= 2;
|
||||
shift_left_array(decoder->timings, decoder->timings_cnt, 2);
|
||||
} else {
|
||||
status = DecodeStatusOk;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
return status;
|
||||
}
|
||||
|
||||
IrdaMessage* irda_common_decode(IrdaCommonDecoder* decoder, bool level, uint32_t duration) {
|
||||
furi_assert(decoder);
|
||||
|
||||
IrdaMessage* message = 0;
|
||||
DecodeStatus status = DecodeStatusError;
|
||||
|
||||
if (decoder->level == level) {
|
||||
furi_assert(0);
|
||||
decoder->timings_cnt = 0;
|
||||
}
|
||||
decoder->level = level; // start with high level (Space timing)
|
||||
|
||||
decoder->timings[decoder->timings_cnt] = duration;
|
||||
decoder->timings_cnt++;
|
||||
furi_check(decoder->timings_cnt <= sizeof(decoder->timings));
|
||||
|
||||
while(1) {
|
||||
switch (decoder->state) {
|
||||
case IrdaCommonStateWaitPreamble:
|
||||
if (irda_check_preamble(decoder)) {
|
||||
decoder->state = IrdaCommonStateDecode;
|
||||
decoder->databit_cnt = 0;
|
||||
}
|
||||
break;
|
||||
case IrdaCommonStateDecode:
|
||||
status = decoder->protocol->decode(decoder);
|
||||
if (status == DecodeStatusReady) {
|
||||
if (decoder->protocol->interpret(decoder)) {
|
||||
message = &decoder->message;
|
||||
decoder->state = IrdaCommonStateProcessRepeat;
|
||||
} else {
|
||||
decoder->state = IrdaCommonStateWaitPreamble;
|
||||
}
|
||||
} else if (status == DecodeStatusError) {
|
||||
decoder->state = IrdaCommonStateWaitPreamble;
|
||||
continue;
|
||||
}
|
||||
break;
|
||||
case IrdaCommonStateProcessRepeat:
|
||||
if (!decoder->protocol->decode_repeat) {
|
||||
decoder->state = IrdaCommonStateWaitPreamble;
|
||||
continue;
|
||||
}
|
||||
status = decoder->protocol->decode_repeat(decoder);
|
||||
if (status == DecodeStatusError) {
|
||||
decoder->state = IrdaCommonStateWaitPreamble;
|
||||
continue;
|
||||
} else if (status == DecodeStatusReady) {
|
||||
decoder->message.repeat = true;
|
||||
message = &decoder->message;
|
||||
}
|
||||
break;
|
||||
}
|
||||
break;
|
||||
}
|
||||
|
||||
return message;
|
||||
}
|
||||
|
||||
void* irda_common_decoder_alloc(const IrdaCommonProtocolSpec* protocol) {
|
||||
furi_assert(protocol);
|
||||
|
||||
uint32_t alloc_size = sizeof(IrdaCommonDecoder)
|
||||
+ protocol->databit_len / 8
|
||||
+ !!(protocol->databit_len % 8);
|
||||
IrdaCommonDecoder* decoder = furi_alloc(alloc_size);
|
||||
memset(decoder, 0, alloc_size);
|
||||
decoder->protocol = protocol;
|
||||
return decoder;
|
||||
}
|
||||
|
||||
void irda_common_decoder_free(void* decoder) {
|
||||
furi_assert(decoder);
|
||||
|
||||
free(decoder);
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user