mayhem-firmware/firmware/baseband/fprotos/s-keeloq.hpp
Totoo 2ccda5aebd
Subghz decoder (#1646)
* Initial commit - wip

* Half part of the transition of baseband processor.

* More SGD

* WIP, Weather refactor, UI improv

* Rename

* Added 4msps, and fixes

* Fixes

* princeton working

* Renamed proc_weather, bc now multifunctional

* Proto: bett

* FPS_CAME = 4,
    FPS_PRASTEL = 5,
    FPS_AIRFORCE = 6,

* Came Atomo, fixes

* Separate weather and sgd, bc of baseband size limit

* Fix display

* Save space

* More protos

* Dooya proto added

* More protos

* add protos

* More protos

* Move weather to ext app

* nw

* Revert "Move weather to ext app"

This reverts commit 8a84aac2f5.

* revert

* Fix merge

* Better naming

* More protos

* More protos

* Add protos

* Fix warning

* Add NeroRadio

* more protos

* more protos

* More protos

* Shrink a bit

* fixes

* More protos

* Nicer code

* Fix naming

* Fix format

* Remove unused

* Fix some protos, that needs a LOOOONG part with the same lo/high

* Modify key calculation
2023-12-16 16:37:51 -06:00

108 lines
4.3 KiB
C++

#ifndef __FPROTO_KEELOQ_H__
#define __FPROTO_KEELOQ_H__
#include "subghzdbase.hpp"
typedef enum : uint8_t {
KeeloqDecoderStepReset = 0,
KeeloqDecoderStepCheckPreambula,
KeeloqDecoderStepSaveDuration,
KeeloqDecoderStepCheckDuration,
} KeeloqDecoderStep;
class FProtoSubGhzDKeeLoq : public FProtoSubGhzDBase {
public:
FProtoSubGhzDKeeLoq() {
sensorType = FPS_KEELOQ;
te_short = 400;
te_long = 800;
te_delta = 140;
min_count_bit_for_found = 64;
}
void feed(bool level, uint32_t duration) {
switch (parser_step) {
case KeeloqDecoderStepReset:
if ((level) && DURATION_DIFF(duration, te_short) < te_delta) {
parser_step = KeeloqDecoderStepCheckPreambula;
header_count++;
}
break;
case KeeloqDecoderStepCheckPreambula:
if ((!level) && (DURATION_DIFF(duration, te_short) < te_delta)) {
parser_step = KeeloqDecoderStepReset;
break;
}
if ((header_count > 2) && (DURATION_DIFF(duration, te_short * 10) < te_delta * 10)) {
// Found header
parser_step = KeeloqDecoderStepSaveDuration;
decode_data = 0;
decode_count_bit = 0;
} else {
parser_step = KeeloqDecoderStepReset;
header_count = 0;
}
break;
case KeeloqDecoderStepSaveDuration:
if (level) {
te_last = duration;
parser_step = KeeloqDecoderStepCheckDuration;
}
break;
case KeeloqDecoderStepCheckDuration:
if (!level) {
if (duration >= ((uint32_t)te_short * 2 + te_delta)) {
// Found end TX
parser_step = KeeloqDecoderStepReset;
if ((decode_count_bit >= min_count_bit_for_found) &&
(decode_count_bit <= min_count_bit_for_found + 2)) {
if (data != decode_data) {
data = decode_data;
data_count_bit = min_count_bit_for_found;
// controller
uint64_t key = FProtoGeneral::subghz_protocol_blocks_reverse_key(data, data_count_bit);
uint32_t key_fix = key >> 32;
// uint32_t key_hop = key & 0x00000000ffffffff; //unused
serial = key_fix & 0x0FFFFFFF;
btn = key_fix >> 28;
if (callback) callback(this);
}
decode_data = 0;
decode_count_bit = 0;
header_count = 0;
}
break;
} else if (
(DURATION_DIFF(te_last, te_short) < te_delta) &&
(DURATION_DIFF(duration, te_long) < te_delta * 2)) {
if (decode_count_bit < min_count_bit_for_found) {
subghz_protocol_blocks_add_bit(1);
} else {
decode_count_bit++;
}
parser_step = KeeloqDecoderStepSaveDuration;
} else if (
(DURATION_DIFF(te_last, te_long) < te_delta * 2) &&
(DURATION_DIFF(duration, te_short) < te_delta)) {
if (decode_count_bit < min_count_bit_for_found) {
subghz_protocol_blocks_add_bit(0);
} else {
decode_count_bit++;
}
parser_step = KeeloqDecoderStepSaveDuration;
} else {
parser_step = KeeloqDecoderStepReset;
header_count = 0;
}
} else {
parser_step = KeeloqDecoderStepReset;
header_count = 0;
}
break;
}
}
};
#endif