mirror of
https://github.com/eried/portapack-mayhem.git
synced 2024-12-26 15:59:28 -05:00
140 lines
5.1 KiB
C++
140 lines
5.1 KiB
C++
|
|
||
|
#ifndef __FPROTO_MAGELLAN_H__
|
||
|
#define __FPROTO_MAGELLAN_H__
|
||
|
|
||
|
#include "subghzdbase.hpp"
|
||
|
|
||
|
typedef enum : uint8_t {
|
||
|
MagellanDecoderStepReset = 0,
|
||
|
MagellanDecoderStepCheckPreambula,
|
||
|
MagellanDecoderStepFoundPreambula,
|
||
|
MagellanDecoderStepSaveDuration,
|
||
|
MagellanDecoderStepCheckDuration,
|
||
|
} MagellanDecoderStep;
|
||
|
|
||
|
class FProtoSubGhzDMagellan : public FProtoSubGhzDBase {
|
||
|
public:
|
||
|
FProtoSubGhzDMagellan() {
|
||
|
sensorType = FPS_MAGELLAN;
|
||
|
te_short = 200;
|
||
|
te_long = 400;
|
||
|
te_delta = 100;
|
||
|
min_count_bit_for_found = 32;
|
||
|
}
|
||
|
|
||
|
void feed(bool level, uint32_t duration) {
|
||
|
switch (parser_step) {
|
||
|
case MagellanDecoderStepReset:
|
||
|
if ((level) && (DURATION_DIFF(duration, te_short) < te_delta)) {
|
||
|
parser_step = MagellanDecoderStepCheckPreambula;
|
||
|
te_last = duration;
|
||
|
header_count = 0;
|
||
|
}
|
||
|
break;
|
||
|
|
||
|
case MagellanDecoderStepCheckPreambula:
|
||
|
if (level) {
|
||
|
te_last = duration;
|
||
|
} else {
|
||
|
if ((DURATION_DIFF(te_last, te_short) < te_delta) &&
|
||
|
(DURATION_DIFF(duration, te_short) < te_delta)) {
|
||
|
// Found header
|
||
|
header_count++;
|
||
|
} else if (
|
||
|
(DURATION_DIFF(te_last, te_short) < te_delta) &&
|
||
|
(DURATION_DIFF(duration, te_long) < te_delta * 2) &&
|
||
|
(header_count > 10)) {
|
||
|
parser_step = MagellanDecoderStepFoundPreambula;
|
||
|
} else {
|
||
|
parser_step = MagellanDecoderStepReset;
|
||
|
}
|
||
|
}
|
||
|
break;
|
||
|
|
||
|
case MagellanDecoderStepFoundPreambula:
|
||
|
if (level) {
|
||
|
te_last = duration;
|
||
|
} else {
|
||
|
if ((DURATION_DIFF(te_last, te_short * 6) < te_delta * 3) &&
|
||
|
(DURATION_DIFF(duration, te_long) < te_delta * 2)) {
|
||
|
parser_step = MagellanDecoderStepSaveDuration;
|
||
|
decode_data = 0;
|
||
|
decode_count_bit = 0;
|
||
|
} else {
|
||
|
parser_step = MagellanDecoderStepReset;
|
||
|
}
|
||
|
}
|
||
|
break;
|
||
|
|
||
|
case MagellanDecoderStepSaveDuration:
|
||
|
if (level) {
|
||
|
te_last = duration;
|
||
|
parser_step = MagellanDecoderStepCheckDuration;
|
||
|
} else {
|
||
|
parser_step = MagellanDecoderStepReset;
|
||
|
}
|
||
|
break;
|
||
|
|
||
|
case MagellanDecoderStepCheckDuration:
|
||
|
if (!level) {
|
||
|
if ((DURATION_DIFF(te_last, te_short) < te_delta) &&
|
||
|
(DURATION_DIFF(duration, te_long) < te_delta)) {
|
||
|
subghz_protocol_blocks_add_bit(1);
|
||
|
parser_step = MagellanDecoderStepSaveDuration;
|
||
|
} else if (
|
||
|
(DURATION_DIFF(te_last, te_long) < te_delta) &&
|
||
|
(DURATION_DIFF(duration, te_short) < te_delta)) {
|
||
|
subghz_protocol_blocks_add_bit(0);
|
||
|
parser_step = MagellanDecoderStepSaveDuration;
|
||
|
} else if (duration >= (te_long * 3)) {
|
||
|
// Found stop bit
|
||
|
if ((decode_count_bit == min_count_bit_for_found) &&
|
||
|
subghz_protocol_magellan_check_crc()) {
|
||
|
data = decode_data;
|
||
|
data_count_bit = decode_count_bit;
|
||
|
|
||
|
// controller
|
||
|
uint64_t data_rev = FProtoGeneral::subghz_protocol_blocks_reverse_key(data >> 8, 24);
|
||
|
serial = data_rev & 0xFFFF;
|
||
|
btn = (data_rev >> 16) & 0xFF;
|
||
|
if (callback) callback(this);
|
||
|
}
|
||
|
decode_data = 0;
|
||
|
decode_count_bit = 0;
|
||
|
parser_step = MagellanDecoderStepReset;
|
||
|
} else {
|
||
|
parser_step = MagellanDecoderStepReset;
|
||
|
}
|
||
|
} else {
|
||
|
parser_step = MagellanDecoderStepReset;
|
||
|
}
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
protected:
|
||
|
bool subghz_protocol_magellan_check_crc() {
|
||
|
uint8_t data[3] = {
|
||
|
(uint8_t)(decode_data >> 24),
|
||
|
(uint8_t)(decode_data >> 16),
|
||
|
(uint8_t)(decode_data >> 8)};
|
||
|
return (decode_data & 0xFF) == subghz_protocol_magellan_crc8(data, sizeof(data));
|
||
|
}
|
||
|
uint8_t subghz_protocol_magellan_crc8(uint8_t* data, size_t len) {
|
||
|
uint8_t crc = 0x00;
|
||
|
uint8_t i, j;
|
||
|
for (i = 0; i < len; i++) {
|
||
|
crc ^= data[i];
|
||
|
for (j = 0; j < 8; j++) {
|
||
|
if ((crc & 0x80) != 0)
|
||
|
crc = (uint8_t)((crc << 1) ^ 0x31);
|
||
|
else
|
||
|
crc <<= 1;
|
||
|
}
|
||
|
}
|
||
|
return crc;
|
||
|
}
|
||
|
};
|
||
|
|
||
|
#endif
|