DarkFlippers/unleashed-firmware
1
1
Fork 0
mirror of https://github.com/DarkFlippers/unleashed-firmware.git synced 2024-12-25 22:32:29 +03:00
Code Issues Projects Releases Wiki Activity

Fixed

Browse Source
This commit is contained in:
assasinfil 2023-01-18 14:57:30 +03:00
parent 414a13131a
commit cd5596027f
No known key found for this signature in database
GPG Key ID: E5C793A4B4737A16
1 changed files with 54 additions and 50 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

104
lib/subghz/protocols/somfy_telis.c
View File

@ -1,5 +1,6 @@
#include "somfy_telis.h" #include "somfy_telis.h"
#include <lib/toolbox/manchester_decoder.h> #include <lib/toolbox/manchester_decoder.h>
#include <lib/toolbox/manchester_encoder.h>
#include "../blocks/const.h" #include "../blocks/const.h"
#include "../blocks/decoder.h" #include "../blocks/decoder.h"
@ -10,8 +11,8 @@
#define TAG "SubGhzProtocolSomfyTelis" #define TAG "SubGhzProtocolSomfyTelis"
static const SubGhzBlockConst subghz_protocol_somfy_telis_const = { static const SubGhzBlockConst subghz_protocol_somfy_telis_const = {
.te_short = 604, .te_short = 640,
.te_long = 1208, .te_long = 1280,
.te_delta = 250, .te_delta = 250,
.min_count_bit_for_found = 56, .min_count_bit_for_found = 56,
}; };
@ -83,7 +84,7 @@ void* subghz_protocol_encoder_somfy_telis_alloc(SubGhzEnvironment* environment)
instance->keystore = subghz_environment_get_keystore(environment); instance->keystore = subghz_environment_get_keystore(environment);
instance->encoder.repeat = 10; instance->encoder.repeat = 10;
instance->encoder.size_upload = 400; instance->encoder.size_upload = 128;
instance->encoder.upload = malloc(instance->encoder.size_upload * sizeof(LevelDuration)); instance->encoder.upload = malloc(instance->encoder.size_upload * sizeof(LevelDuration));
instance->encoder.is_running = false; instance->encoder.is_running = false;
@ -105,11 +106,11 @@ static bool
instance->generic.cnt = (data >> 24) & 0xFFFF; // rolling code instance->generic.cnt = (data >> 24) & 0xFFFF; // rolling code
instance->generic.serial = data & 0xFFFFFF; // address instance->generic.serial = data & 0xFFFFFF; // address
if(instance->generic.cnt < 0xFFFF) { // if(instance->generic.cnt < 0xFFFF) {
instance->generic.cnt++; // instance->generic.cnt++;
} else if(instance->generic.cnt >= 0xFFFF) { // } else if(instance->generic.cnt >= 0xFFFF) {
instance->generic.cnt = 0; // instance->generic.cnt = 0;
} // }
uint8_t frame[7]; uint8_t frame[7];
frame[0] = data >> 48; frame[0] = data >> 48;
frame[1] = instance->generic.btn << 4; frame[1] = instance->generic.btn << 4;
@ -179,62 +180,55 @@ static bool subghz_protocol_encoder_somfy_telis_get_upload(
size_t index = 0; size_t index = 0;
//Send header //Send header
// Wake-up //Wake up
instance->encoder.upload[index++] = level_duration_make(true, 9415); // 1 instance->encoder.upload[index++] = level_duration_make(true, (uint32_t)9415); // 1
instance->encoder.upload[index++] = level_duration_make(false, 89565); // 0 instance->encoder.upload[index++] = level_duration_make(false, (uint32_t)89565); // 0
//Hardware sync //Hardware sync
for(uint8_t i = 0; i < 2; ++i) { for(uint8_t i = 0; i < 2; ++i) {
instance->encoder.upload[index++] = level_duration_make(true, 4 * 640); // 1 instance->encoder.upload[index++] = level_duration_make(
instance->encoder.upload[index++] = level_duration_make(false, 4 * 640); // 0 true, (uint32_t)subghz_protocol_somfy_telis_const.te_short * 4); // 1
instance->encoder.upload[index++] = level_duration_make(
false, (uint32_t)subghz_protocol_somfy_telis_const.te_short * 4); // 0
} }
//Software sync //Software sync
instance->encoder.upload[index++] = level_duration_make(true, 4550); // 1 instance->encoder.upload[index++] = level_duration_make(true, (uint32_t)4550); // 1
instance->encoder.upload[index++] = level_duration_make(false, 640); // 0 instance->encoder.upload[index++] =
level_duration_make(false, (uint32_t)subghz_protocol_somfy_telis_const.te_short); // 0
//Send key data MSB manchester //Send key data MSB manchester
for(uint8_t i = 0; i < instance->generic.data_count_bit; ++i) {
if(bit_read(instance->generic.data, i)) { for(uint8_t i = instance->generic.data_count_bit; i > 0; i--) {
//send bit 1: 01 = 1 if(bit_read(instance->generic.data, i - 1)) {
instance->encoder.upload[index++] = level_duration_make(false, 640); // 0 if(instance->encoder.upload[index - 1].level == LEVEL_DURATION_LEVEL_LOW) {
instance->encoder.upload[index++] = level_duration_make(true, 640); // 1 instance->encoder.upload[index - 1].duration *= 2; // 00
instance->encoder.upload[index++] = level_duration_make(
true, (uint32_t)subghz_protocol_somfy_telis_const.te_short); // 1
} else { } else {
//send bit 0: 10 = 0 instance->encoder.upload[index++] = level_duration_make(
instance->encoder.upload[index++] = level_duration_make(true, 640); // 1 false, (uint32_t)subghz_protocol_somfy_telis_const.te_short); // 0
instance->encoder.upload[index++] = level_duration_make(false, 640); // 0 instance->encoder.upload[index++] = level_duration_make(
true, (uint32_t)subghz_protocol_somfy_telis_const.te_short); // 1
}
} else {
if(instance->encoder.upload[index - 1].level == LEVEL_DURATION_LEVEL_HIGH) {
instance->encoder.upload[index - 1].duration *= 2; // 11
instance->encoder.upload[index++] = level_duration_make(
false, (uint32_t)subghz_protocol_somfy_telis_const.te_short); // 0
} else {
instance->encoder.upload[index++] = level_duration_make(
true, (uint32_t)subghz_protocol_somfy_telis_const.te_short); // 1
instance->encoder.upload[index++] = level_duration_make(
false, (uint32_t)subghz_protocol_somfy_telis_const.te_short); // 0
}
} }
} }
//Inter-frame silence //Inter-frame silence
instance->encoder.upload[index++] = level_duration_make(false, 30415); instance->encoder.upload[index++] = level_duration_make(false, 30415);
for(uint8_t j = 0; j < 2; ++j) {
//Hardware sync
for(uint8_t i = 0; i < 7; ++i) {
instance->encoder.upload[index++] = level_duration_make(true, 4 * 640); // 1
instance->encoder.upload[index++] = level_duration_make(false, 4 * 640); // 0
}
//Software sync
instance->encoder.upload[index++] = level_duration_make(true, 4550); // 1
instance->encoder.upload[index++] = level_duration_make(false, 640); // 0
//Send key data MSB manchester
for(uint8_t i = 0; i < instance->generic.data_count_bit; ++i) {
if(bit_read(instance->generic.data, i)) {
//send bit 1: 01 = 1
instance->encoder.upload[index++] = level_duration_make(false, 640); // 0
instance->encoder.upload[index++] = level_duration_make(true, 640); // 1
} else {
//send bit 0: 10 = 0
instance->encoder.upload[index++] = level_duration_make(true, 640); // 1
instance->encoder.upload[index++] = level_duration_make(false, 640); // 0
}
}
//Inter-frame silence
instance->encoder.upload[index++] = level_duration_make(false, 30415);
}
size_t size_upload = index; size_t size_upload = index;
FURI_LOG_D(TAG, "Size upload: %d", size_upload);
if(size_upload > instance->encoder.size_upload) { if(size_upload > instance->encoder.size_upload) {
FURI_LOG_E(TAG, "Size upload exceeds allocated encoder buffer."); FURI_LOG_E(TAG, "Size upload exceeds allocated encoder buffer.");
return false; return false;
@ -361,6 +355,7 @@ void subghz_protocol_decoder_somfy_telis_feed(void* context, bool level, uint32_
if((!level) && (DURATION_DIFF(duration, subghz_protocol_somfy_telis_const.te_short * 4) < if((!level) && (DURATION_DIFF(duration, subghz_protocol_somfy_telis_const.te_short * 4) <
subghz_protocol_somfy_telis_const.te_delta * 4)) { subghz_protocol_somfy_telis_const.te_delta * 4)) {
instance->decoder.parser_step = SomfyTelisDecoderStepCheckPreambula; instance->decoder.parser_step = SomfyTelisDecoderStepCheckPreambula;
FURI_LOG_D(TAG, "Found preambula");
} else { } else {
instance->header_count = 0; instance->header_count = 0;
instance->decoder.parser_step = SomfyTelisDecoderStepReset; instance->decoder.parser_step = SomfyTelisDecoderStepReset;
@ -372,6 +367,7 @@ void subghz_protocol_decoder_somfy_telis_feed(void* context, bool level, uint32_
subghz_protocol_somfy_telis_const.te_delta * 4) { subghz_protocol_somfy_telis_const.te_delta * 4) {
instance->decoder.parser_step = SomfyTelisDecoderStepFoundPreambula; instance->decoder.parser_step = SomfyTelisDecoderStepFoundPreambula;
instance->header_count++; instance->header_count++;
FURI_LOG_D(TAG, "Hardware sync");
} else if( } else if(
(instance->header_count > 1) && (instance->header_count > 1) &&
(DURATION_DIFF(duration, subghz_protocol_somfy_telis_const.te_short * 7) < (DURATION_DIFF(duration, subghz_protocol_somfy_telis_const.te_short * 7) <
@ -390,6 +386,7 @@ void subghz_protocol_decoder_somfy_telis_feed(void* context, bool level, uint32_
ManchesterEventLongHigh, ManchesterEventLongHigh,
&instance->manchester_saved_state, &instance->manchester_saved_state,
NULL); NULL);
FURI_LOG_D(TAG, "Software sync");
} }
} }
@ -400,24 +397,31 @@ void subghz_protocol_decoder_somfy_telis_feed(void* context, bool level, uint32_
if(DURATION_DIFF(duration, subghz_protocol_somfy_telis_const.te_short) < if(DURATION_DIFF(duration, subghz_protocol_somfy_telis_const.te_short) <
subghz_protocol_somfy_telis_const.te_delta) { subghz_protocol_somfy_telis_const.te_delta) {
event = ManchesterEventShortLow; event = ManchesterEventShortLow;
FURI_LOG_D(TAG, "Data decode short");
} else if( } else if(
DURATION_DIFF(duration, subghz_protocol_somfy_telis_const.te_long) < DURATION_DIFF(duration, subghz_protocol_somfy_telis_const.te_long) <
subghz_protocol_somfy_telis_const.te_delta) { subghz_protocol_somfy_telis_const.te_delta) {
event = ManchesterEventLongLow; event = ManchesterEventLongLow;
FURI_LOG_D(TAG, "Data decode long");
} else if( } else if(
duration >= (subghz_protocol_somfy_telis_const.te_long + duration >= (subghz_protocol_somfy_telis_const.te_long +
subghz_protocol_somfy_telis_const.te_delta)) { subghz_protocol_somfy_telis_const.te_delta)) {
FURI_LOG_D(
TAG, "Data decode manchester bit: %d", instance->decoder.decode_count_bit);
if(instance->decoder.decode_count_bit == if(instance->decoder.decode_count_bit ==
subghz_protocol_somfy_telis_const.min_count_bit_for_found) { subghz_protocol_somfy_telis_const.min_count_bit_for_found) {
//check crc //check crc
uint64_t data_tmp = instance->decoder.decode_data ^ uint64_t data_tmp = instance->decoder.decode_data ^
(instance->decoder.decode_data >> 8); (instance->decoder.decode_data >> 8);
FURI_LOG_D(TAG, "Check crc: %llx", (data_tmp >> 40) & 0xF);
if(((data_tmp >> 40) & 0xF) == subghz_protocol_somfy_telis_crc(data_tmp)) { if(((data_tmp >> 40) & 0xF) == subghz_protocol_somfy_telis_crc(data_tmp)) {
instance->generic.data = instance->decoder.decode_data; instance->generic.data = instance->decoder.decode_data;
instance->generic.data_count_bit = instance->decoder.decode_count_bit; instance->generic.data_count_bit = instance->decoder.decode_count_bit;
if(instance->base.callback) if(instance->base.callback)
instance->base.callback(&instance->base, instance->base.context); instance->base.callback(&instance->base, instance->base.context);
} else {
FURI_LOG_D(TAG, "Bad crc");
} }
} }
instance->decoder.decode_data = 0; instance->decoder.decode_data = 0;