portapack-mayhem/firmware/baseband/fprotos/s-keeloq.hpp

#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)) {
                            data_count_bit = min_count_bit_for_found;
                            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;
        }
    }

    uint16_t header_count = 0;
};

#endif