3360f818a1
* Adding checks for get_upload functions Almost in every protocol, function which generates upload might fail and return false. But we don't check this result, which might end up sending random memory contents to the air. * Format sources and fix crash on ivalid bit count in chamberlain Co-authored-by: あく <alleteam@gmail.com>
344 lines
12 KiB
C
344 lines
12 KiB
C
#include "bett.h"
|
|
|
|
#include "../blocks/const.h"
|
|
#include "../blocks/decoder.h"
|
|
#include "../blocks/encoder.h"
|
|
#include "../blocks/generic.h"
|
|
#include "../blocks/math.h"
|
|
|
|
// protocol BERNER / ELKA / TEDSEN / TELETASTER
|
|
#define TAG "SubGhzProtocolBETT"
|
|
|
|
#define DIP_P 0b11 //(+)
|
|
#define DIP_O 0b10 //(0)
|
|
#define DIP_N 0b00 //(-)
|
|
|
|
#define DIP_PATTERN "%c%c%c%c%c%c%c%c%c"
|
|
#define SHOW_DIP_P(dip, check_dip) \
|
|
((((dip >> 0x8) >> 0x8) == check_dip) ? '*' : '_'), \
|
|
((((dip >> 0xE) & 0x3) == check_dip) ? '*' : '_'), \
|
|
((((dip >> 0xC) & 0x3) == check_dip) ? '*' : '_'), \
|
|
((((dip >> 0xA) & 0x3) == check_dip) ? '*' : '_'), \
|
|
((((dip >> 0x8) & 0x3) == check_dip) ? '*' : '_'), \
|
|
((((dip >> 0x6) & 0x3) == check_dip) ? '*' : '_'), \
|
|
((((dip >> 0x4) & 0x3) == check_dip) ? '*' : '_'), \
|
|
((((dip >> 0x2) & 0x3) == check_dip) ? '*' : '_'), \
|
|
((((dip >> 0x0) & 0x3) == check_dip) ? '*' : '_')
|
|
|
|
static const SubGhzBlockConst subghz_protocol_bett_const = {
|
|
.te_short = 340,
|
|
.te_long = 2000,
|
|
.te_delta = 150,
|
|
.min_count_bit_for_found = 18,
|
|
};
|
|
|
|
struct SubGhzProtocolDecoderBETT {
|
|
SubGhzProtocolDecoderBase base;
|
|
|
|
SubGhzBlockDecoder decoder;
|
|
SubGhzBlockGeneric generic;
|
|
};
|
|
|
|
struct SubGhzProtocolEncoderBETT {
|
|
SubGhzProtocolEncoderBase base;
|
|
|
|
SubGhzProtocolBlockEncoder encoder;
|
|
SubGhzBlockGeneric generic;
|
|
};
|
|
|
|
typedef enum {
|
|
BETTDecoderStepReset = 0,
|
|
BETTDecoderStepSaveDuration,
|
|
BETTDecoderStepCheckDuration,
|
|
} BETTDecoderStep;
|
|
|
|
const SubGhzProtocolDecoder subghz_protocol_bett_decoder = {
|
|
.alloc = subghz_protocol_decoder_bett_alloc,
|
|
.free = subghz_protocol_decoder_bett_free,
|
|
|
|
.feed = subghz_protocol_decoder_bett_feed,
|
|
.reset = subghz_protocol_decoder_bett_reset,
|
|
|
|
.get_hash_data = subghz_protocol_decoder_bett_get_hash_data,
|
|
.serialize = subghz_protocol_decoder_bett_serialize,
|
|
.deserialize = subghz_protocol_decoder_bett_deserialize,
|
|
.get_string = subghz_protocol_decoder_bett_get_string,
|
|
};
|
|
|
|
const SubGhzProtocolEncoder subghz_protocol_bett_encoder = {
|
|
.alloc = subghz_protocol_encoder_bett_alloc,
|
|
.free = subghz_protocol_encoder_bett_free,
|
|
|
|
.deserialize = subghz_protocol_encoder_bett_deserialize,
|
|
.stop = subghz_protocol_encoder_bett_stop,
|
|
.yield = subghz_protocol_encoder_bett_yield,
|
|
};
|
|
|
|
const SubGhzProtocol subghz_protocol_bett = {
|
|
.name = SUBGHZ_PROTOCOL_BETT_NAME,
|
|
.type = SubGhzProtocolTypeStatic,
|
|
.flag = SubGhzProtocolFlag_433 | SubGhzProtocolFlag_AM | SubGhzProtocolFlag_Decodable |
|
|
SubGhzProtocolFlag_Load | SubGhzProtocolFlag_Save | SubGhzProtocolFlag_Send,
|
|
|
|
.decoder = &subghz_protocol_bett_decoder,
|
|
.encoder = &subghz_protocol_bett_encoder,
|
|
};
|
|
|
|
void* subghz_protocol_encoder_bett_alloc(SubGhzEnvironment* environment) {
|
|
UNUSED(environment);
|
|
SubGhzProtocolEncoderBETT* instance = malloc(sizeof(SubGhzProtocolEncoderBETT));
|
|
|
|
instance->base.protocol = &subghz_protocol_bett;
|
|
instance->generic.protocol_name = instance->base.protocol->name;
|
|
|
|
instance->encoder.repeat = 10;
|
|
instance->encoder.size_upload = 52;
|
|
instance->encoder.upload = malloc(instance->encoder.size_upload * sizeof(LevelDuration));
|
|
instance->encoder.is_running = false;
|
|
return instance;
|
|
}
|
|
|
|
void subghz_protocol_encoder_bett_free(void* context) {
|
|
furi_assert(context);
|
|
SubGhzProtocolEncoderBETT* instance = context;
|
|
free(instance->encoder.upload);
|
|
free(instance);
|
|
}
|
|
|
|
/**
|
|
* Generating an upload from data.
|
|
* @param instance Pointer to a SubGhzProtocolEncoderBETT instance
|
|
* @return true On success
|
|
*/
|
|
static bool subghz_protocol_encoder_bett_get_upload(SubGhzProtocolEncoderBETT* instance) {
|
|
furi_assert(instance);
|
|
size_t index = 0;
|
|
size_t size_upload = (instance->generic.data_count_bit * 2);
|
|
if(size_upload > instance->encoder.size_upload) {
|
|
FURI_LOG_E(TAG, "Size upload exceeds allocated encoder buffer.");
|
|
return false;
|
|
} else {
|
|
instance->encoder.size_upload = size_upload;
|
|
}
|
|
|
|
for(uint8_t i = instance->generic.data_count_bit; i > 1; i--) {
|
|
if(bit_read(instance->generic.data, i - 1)) {
|
|
//send bit 1
|
|
instance->encoder.upload[index++] =
|
|
level_duration_make(true, (uint32_t)subghz_protocol_bett_const.te_long);
|
|
instance->encoder.upload[index++] =
|
|
level_duration_make(false, (uint32_t)subghz_protocol_bett_const.te_short);
|
|
} else {
|
|
//send bit 0
|
|
instance->encoder.upload[index++] =
|
|
level_duration_make(true, (uint32_t)subghz_protocol_bett_const.te_short);
|
|
instance->encoder.upload[index++] =
|
|
level_duration_make(false, (uint32_t)subghz_protocol_bett_const.te_long);
|
|
}
|
|
}
|
|
if(bit_read(instance->generic.data, 0)) {
|
|
//send bit 1
|
|
instance->encoder.upload[index++] =
|
|
level_duration_make(true, (uint32_t)subghz_protocol_bett_const.te_long);
|
|
instance->encoder.upload[index++] = level_duration_make(
|
|
false,
|
|
(uint32_t)subghz_protocol_bett_const.te_short +
|
|
subghz_protocol_bett_const.te_long * 7);
|
|
} else {
|
|
//send bit 0
|
|
instance->encoder.upload[index++] =
|
|
level_duration_make(true, (uint32_t)subghz_protocol_bett_const.te_short);
|
|
instance->encoder.upload[index++] = level_duration_make(
|
|
false,
|
|
(uint32_t)subghz_protocol_bett_const.te_long + subghz_protocol_bett_const.te_long * 7);
|
|
}
|
|
return true;
|
|
}
|
|
|
|
bool subghz_protocol_encoder_bett_deserialize(void* context, FlipperFormat* flipper_format) {
|
|
furi_assert(context);
|
|
SubGhzProtocolEncoderBETT* instance = context;
|
|
bool res = false;
|
|
do {
|
|
if(!subghz_block_generic_deserialize(&instance->generic, flipper_format)) {
|
|
FURI_LOG_E(TAG, "Deserialize error");
|
|
break;
|
|
}
|
|
if(instance->generic.data_count_bit !=
|
|
subghz_protocol_bett_const.min_count_bit_for_found) {
|
|
FURI_LOG_E(TAG, "Wrong number of bits in key");
|
|
break;
|
|
}
|
|
//optional parameter parameter
|
|
flipper_format_read_uint32(
|
|
flipper_format, "Repeat", (uint32_t*)&instance->encoder.repeat, 1);
|
|
|
|
if(!subghz_protocol_encoder_bett_get_upload(instance)) break;
|
|
instance->encoder.is_running = true;
|
|
|
|
res = true;
|
|
} while(false);
|
|
|
|
return res;
|
|
}
|
|
|
|
void subghz_protocol_encoder_bett_stop(void* context) {
|
|
SubGhzProtocolEncoderBETT* instance = context;
|
|
instance->encoder.is_running = false;
|
|
}
|
|
|
|
LevelDuration subghz_protocol_encoder_bett_yield(void* context) {
|
|
SubGhzProtocolEncoderBETT* instance = context;
|
|
|
|
if(instance->encoder.repeat == 0 || !instance->encoder.is_running) {
|
|
instance->encoder.is_running = false;
|
|
return level_duration_reset();
|
|
}
|
|
|
|
LevelDuration ret = instance->encoder.upload[instance->encoder.front];
|
|
|
|
if(++instance->encoder.front == instance->encoder.size_upload) {
|
|
instance->encoder.repeat--;
|
|
instance->encoder.front = 0;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
void* subghz_protocol_decoder_bett_alloc(SubGhzEnvironment* environment) {
|
|
UNUSED(environment);
|
|
SubGhzProtocolDecoderBETT* instance = malloc(sizeof(SubGhzProtocolDecoderBETT));
|
|
instance->base.protocol = &subghz_protocol_bett;
|
|
instance->generic.protocol_name = instance->base.protocol->name;
|
|
return instance;
|
|
}
|
|
|
|
void subghz_protocol_decoder_bett_free(void* context) {
|
|
furi_assert(context);
|
|
SubGhzProtocolDecoderBETT* instance = context;
|
|
free(instance);
|
|
}
|
|
|
|
void subghz_protocol_decoder_bett_reset(void* context) {
|
|
furi_assert(context);
|
|
SubGhzProtocolDecoderBETT* instance = context;
|
|
instance->decoder.parser_step = BETTDecoderStepReset;
|
|
}
|
|
|
|
void subghz_protocol_decoder_bett_feed(void* context, bool level, uint32_t duration) {
|
|
furi_assert(context);
|
|
SubGhzProtocolDecoderBETT* instance = context;
|
|
|
|
switch(instance->decoder.parser_step) {
|
|
case BETTDecoderStepReset:
|
|
if((!level) && (DURATION_DIFF(duration, subghz_protocol_bett_const.te_short * 44) <
|
|
(subghz_protocol_bett_const.te_delta * 15))) {
|
|
instance->decoder.decode_data = 0;
|
|
instance->decoder.decode_count_bit = 0;
|
|
instance->decoder.parser_step = BETTDecoderStepCheckDuration;
|
|
}
|
|
break;
|
|
case BETTDecoderStepSaveDuration:
|
|
if(!level) {
|
|
if(DURATION_DIFF(duration, subghz_protocol_bett_const.te_short * 44) <
|
|
(subghz_protocol_bett_const.te_delta * 15)) {
|
|
instance->decoder.parser_step = BETTDecoderStepSaveDuration;
|
|
if(instance->decoder.decode_count_bit ==
|
|
subghz_protocol_bett_const.min_count_bit_for_found) {
|
|
instance->generic.data = instance->decoder.decode_data;
|
|
instance->generic.data_count_bit = instance->decoder.decode_count_bit;
|
|
|
|
if(instance->base.callback)
|
|
instance->base.callback(&instance->base, instance->base.context);
|
|
} else {
|
|
instance->decoder.parser_step = BETTDecoderStepReset;
|
|
}
|
|
instance->decoder.decode_data = 0;
|
|
instance->decoder.decode_count_bit = 0;
|
|
break;
|
|
} else {
|
|
if((DURATION_DIFF(duration, subghz_protocol_bett_const.te_short) <
|
|
subghz_protocol_bett_const.te_delta) ||
|
|
(DURATION_DIFF(duration, subghz_protocol_bett_const.te_long) <
|
|
subghz_protocol_bett_const.te_delta * 3)) {
|
|
instance->decoder.parser_step = BETTDecoderStepCheckDuration;
|
|
} else {
|
|
instance->decoder.parser_step = BETTDecoderStepReset;
|
|
}
|
|
}
|
|
}
|
|
break;
|
|
case BETTDecoderStepCheckDuration:
|
|
if(level) {
|
|
if(DURATION_DIFF(duration, subghz_protocol_bett_const.te_long) <
|
|
subghz_protocol_bett_const.te_delta * 3) {
|
|
subghz_protocol_blocks_add_bit(&instance->decoder, 1);
|
|
instance->decoder.parser_step = BETTDecoderStepSaveDuration;
|
|
} else if(
|
|
DURATION_DIFF(duration, subghz_protocol_bett_const.te_short) <
|
|
subghz_protocol_bett_const.te_delta) {
|
|
subghz_protocol_blocks_add_bit(&instance->decoder, 0);
|
|
instance->decoder.parser_step = BETTDecoderStepSaveDuration;
|
|
} else {
|
|
instance->decoder.parser_step = BETTDecoderStepReset;
|
|
}
|
|
} else {
|
|
instance->decoder.parser_step = BETTDecoderStepReset;
|
|
}
|
|
break;
|
|
}
|
|
}
|
|
|
|
uint8_t subghz_protocol_decoder_bett_get_hash_data(void* context) {
|
|
furi_assert(context);
|
|
SubGhzProtocolDecoderBETT* instance = context;
|
|
return subghz_protocol_blocks_get_hash_data(
|
|
&instance->decoder, (instance->decoder.decode_count_bit / 8) + 1);
|
|
}
|
|
|
|
bool subghz_protocol_decoder_bett_serialize(
|
|
void* context,
|
|
FlipperFormat* flipper_format,
|
|
SubGhzPresetDefinition* preset) {
|
|
furi_assert(context);
|
|
SubGhzProtocolDecoderBETT* instance = context;
|
|
return subghz_block_generic_serialize(&instance->generic, flipper_format, preset);
|
|
}
|
|
|
|
bool subghz_protocol_decoder_bett_deserialize(void* context, FlipperFormat* flipper_format) {
|
|
furi_assert(context);
|
|
SubGhzProtocolDecoderBETT* instance = context;
|
|
bool ret = false;
|
|
do {
|
|
if(!subghz_block_generic_deserialize(&instance->generic, flipper_format)) {
|
|
break;
|
|
}
|
|
if(instance->generic.data_count_bit !=
|
|
subghz_protocol_bett_const.min_count_bit_for_found) {
|
|
FURI_LOG_E(TAG, "Wrong number of bits in key");
|
|
break;
|
|
}
|
|
ret = true;
|
|
} while(false);
|
|
return ret;
|
|
}
|
|
|
|
void subghz_protocol_decoder_bett_get_string(void* context, string_t output) {
|
|
furi_assert(context);
|
|
SubGhzProtocolDecoderBETT* instance = context;
|
|
uint32_t data = (uint32_t)(instance->generic.data & 0x3FFFF);
|
|
string_cat_printf(
|
|
output,
|
|
"%s %dbit\r\n"
|
|
"Key:%05lX\r\n"
|
|
" +: " DIP_PATTERN "\r\n"
|
|
" o: " DIP_PATTERN "\r\n"
|
|
" -: " DIP_PATTERN "\r\n",
|
|
instance->generic.protocol_name,
|
|
instance->generic.data_count_bit,
|
|
data,
|
|
SHOW_DIP_P(data, DIP_P),
|
|
SHOW_DIP_P(data, DIP_O),
|
|
SHOW_DIP_P(data, DIP_N));
|
|
}
|