#include "somfy_telis.h" #include #include "../blocks/const.h" #include "../blocks/decoder.h" #include "../blocks/encoder.h" #include "../blocks/generic.h" #include "../blocks/math.h" #define TAG "SubGhzProtocolSomfyTelis" static const SubGhzBlockConst subghz_protocol_somfy_telis_const = { .te_short = 640, .te_long = 1280, .te_delta = 250, .min_count_bit_for_found = 56, }; struct SubGhzProtocolDecoderSomfyTelis { SubGhzProtocolDecoderBase base; SubGhzBlockDecoder decoder; SubGhzBlockGeneric generic; uint16_t header_count; ManchesterState manchester_saved_state; }; struct SubGhzProtocolEncoderSomfyTelis { SubGhzProtocolEncoderBase base; SubGhzProtocolBlockEncoder encoder; SubGhzBlockGeneric generic; }; typedef enum { SomfyTelisDecoderStepReset = 0, SomfyTelisDecoderStepCheckPreambula, SomfyTelisDecoderStepFoundPreambula, SomfyTelisDecoderStepStartDecode, SomfyTelisDecoderStepDecoderData, } SomfyTelisDecoderStep; const SubGhzProtocolDecoder subghz_protocol_somfy_telis_decoder = { .alloc = subghz_protocol_decoder_somfy_telis_alloc, .free = subghz_protocol_decoder_somfy_telis_free, .feed = subghz_protocol_decoder_somfy_telis_feed, .reset = subghz_protocol_decoder_somfy_telis_reset, .get_hash_data = subghz_protocol_decoder_somfy_telis_get_hash_data, .serialize = subghz_protocol_decoder_somfy_telis_serialize, .deserialize = subghz_protocol_decoder_somfy_telis_deserialize, .get_string = subghz_protocol_decoder_somfy_telis_get_string, }; const SubGhzProtocolEncoder subghz_protocol_somfy_telis_encoder = { .alloc = NULL, .free = NULL, .deserialize = NULL, .stop = NULL, .yield = NULL, }; const SubGhzProtocol subghz_protocol_somfy_telis = { .name = SUBGHZ_PROTOCOL_SOMFY_TELIS_NAME, .type = SubGhzProtocolTypeDynamic, .flag = SubGhzProtocolFlag_433 | SubGhzProtocolFlag_868 | SubGhzProtocolFlag_AM | SubGhzProtocolFlag_Decodable, .decoder = &subghz_protocol_somfy_telis_decoder, .encoder = &subghz_protocol_somfy_telis_encoder, }; void* subghz_protocol_decoder_somfy_telis_alloc(SubGhzEnvironment* environment) { UNUSED(environment); SubGhzProtocolDecoderSomfyTelis* instance = malloc(sizeof(SubGhzProtocolDecoderSomfyTelis)); instance->base.protocol = &subghz_protocol_somfy_telis; instance->generic.protocol_name = instance->base.protocol->name; return instance; } void subghz_protocol_decoder_somfy_telis_free(void* context) { furi_assert(context); SubGhzProtocolDecoderSomfyTelis* instance = context; free(instance); } void subghz_protocol_decoder_somfy_telis_reset(void* context) { furi_assert(context); SubGhzProtocolDecoderSomfyTelis* instance = context; instance->decoder.parser_step = SomfyTelisDecoderStepReset; manchester_advance( instance->manchester_saved_state, ManchesterEventReset, &instance->manchester_saved_state, NULL); } /** * Сhecksum calculation. * @param data Вata for checksum calculation * @return CRC */ static uint8_t subghz_protocol_somfy_telis_crc(uint64_t data) { uint8_t crc = 0; data &= 0xFFF0FFFFFFFFFF; for(uint8_t i = 0; i < 56; i += 8) { crc = crc ^ data >> i ^ (data >> (i + 4)); } return crc & 0xf; } void subghz_protocol_decoder_somfy_telis_feed(void* context, bool level, uint32_t duration) { furi_assert(context); SubGhzProtocolDecoderSomfyTelis* instance = context; ManchesterEvent event = ManchesterEventReset; switch(instance->decoder.parser_step) { case SomfyTelisDecoderStepReset: if((level) && DURATION_DIFF(duration, subghz_protocol_somfy_telis_const.te_short * 4) < subghz_protocol_somfy_telis_const.te_delta * 4) { instance->decoder.parser_step = SomfyTelisDecoderStepFoundPreambula; instance->header_count++; } break; case SomfyTelisDecoderStepFoundPreambula: if((!level) && (DURATION_DIFF(duration, subghz_protocol_somfy_telis_const.te_short * 4) < subghz_protocol_somfy_telis_const.te_delta * 4)) { instance->decoder.parser_step = SomfyTelisDecoderStepCheckPreambula; } else { instance->header_count = 0; instance->decoder.parser_step = SomfyTelisDecoderStepReset; } break; case SomfyTelisDecoderStepCheckPreambula: if(level) { if(DURATION_DIFF(duration, subghz_protocol_somfy_telis_const.te_short * 4) < subghz_protocol_somfy_telis_const.te_delta * 4) { instance->decoder.parser_step = SomfyTelisDecoderStepFoundPreambula; instance->header_count++; } else if( (instance->header_count > 1) && (DURATION_DIFF(duration, subghz_protocol_somfy_telis_const.te_short * 7) < subghz_protocol_somfy_telis_const.te_delta * 4)) { instance->decoder.parser_step = SomfyTelisDecoderStepDecoderData; instance->decoder.decode_data = 0; instance->decoder.decode_count_bit = 0; instance->header_count = 0; manchester_advance( instance->manchester_saved_state, ManchesterEventReset, &instance->manchester_saved_state, NULL); manchester_advance( instance->manchester_saved_state, ManchesterEventLongHigh, &instance->manchester_saved_state, NULL); } } break; case SomfyTelisDecoderStepDecoderData: if(!level) { if(DURATION_DIFF(duration, subghz_protocol_somfy_telis_const.te_short) < subghz_protocol_somfy_telis_const.te_delta) { event = ManchesterEventShortLow; } else if( DURATION_DIFF(duration, subghz_protocol_somfy_telis_const.te_long) < subghz_protocol_somfy_telis_const.te_delta) { event = ManchesterEventLongLow; } else if( duration >= (subghz_protocol_somfy_telis_const.te_long + subghz_protocol_somfy_telis_const.te_delta)) { if(instance->decoder.decode_count_bit == subghz_protocol_somfy_telis_const.min_count_bit_for_found) { //check crc uint64_t data_tmp = instance->decoder.decode_data ^ (instance->decoder.decode_data >> 8); if(((data_tmp >> 40) & 0xF) == subghz_protocol_somfy_telis_crc(data_tmp)) { 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); } } instance->decoder.decode_data = 0; instance->decoder.decode_count_bit = 0; manchester_advance( instance->manchester_saved_state, ManchesterEventReset, &instance->manchester_saved_state, NULL); manchester_advance( instance->manchester_saved_state, ManchesterEventLongHigh, &instance->manchester_saved_state, NULL); instance->decoder.parser_step = SomfyTelisDecoderStepReset; } else { instance->decoder.parser_step = SomfyTelisDecoderStepReset; } } else { if(DURATION_DIFF(duration, subghz_protocol_somfy_telis_const.te_short) < subghz_protocol_somfy_telis_const.te_delta) { event = ManchesterEventShortHigh; } else if( DURATION_DIFF(duration, subghz_protocol_somfy_telis_const.te_long) < subghz_protocol_somfy_telis_const.te_delta) { event = ManchesterEventLongHigh; } else { instance->decoder.parser_step = SomfyTelisDecoderStepReset; } } if(event != ManchesterEventReset) { bool data; bool data_ok = manchester_advance( instance->manchester_saved_state, event, &instance->manchester_saved_state, &data); if(data_ok) { instance->decoder.decode_data = (instance->decoder.decode_data << 1) | data; instance->decoder.decode_count_bit++; } } break; } } /** * Analysis of received data * @param instance Pointer to a SubGhzBlockGeneric* instance */ static void subghz_protocol_somfy_telis_check_remote_controller(SubGhzBlockGeneric* instance) { //https://pushstack.wordpress.com/somfy-rts-protocol/ /* * 604 us * / * | 2416us | 2416us | 2416us | 2416us | 4550 us | | 67648 us | 30415 us | * * +--------+ +--------+ +---...---+ * + +--------+ +--------+ +--+XXXX...XXX+-----...----- * * | hw. sync. | soft. | | Inter-frame * | | sync. | data | gap * * * encrypt | decrypt * * package 56 bit cnt key btn|crc cnt serial * 0xA7232323312222 - 0 => A7 8 0 | 00 00 | 12 13 00 * 0xA7222223312222 - 1 => A7 8 5 | 00 01 | 12 13 00 * 0xA7212123312222 - 2 => A7 8 6 | 00 02 | 12 13 00 * * Key: “Encryption Key”, Most significant 4-bit are always 0xA, Least Significant bits is * a linear counter. In the Smoove Origin this counter is increased together with the * rolling code. But leaving this on a constant value also works. Gerardwr notes that * for some other types of remotes the MSB is not constant. * Btn: 4-bit Control codes, this indicates the button that is pressed * CRC: 4-bit Checksum. * Ctn: 16-bit rolling code (big-endian) increased with every button press. * Serial: 24-bit identifier of sending device (little-endian) * * * Decrypt * * uint8_t frame[7]; * for (i=1; i < 7; i++) { * frame[i] = frame[i] ^ frame[i-1]; * } * or * uint64 Decrypt = frame ^ (frame>>8); * * Btn * * Value Button(s) Description * 0x1 My Stop or move to favourite position * 0x2 Up Move up * 0x3 My + Up Set upper motor limit in initial programming mode * 0x4 Down Move down * 0x5 My + Down Set lower motor limit in initial programming mode * 0x6 Up + Down Change motor limit and initial programming mode * 0x8 Prog Used for (de-)registering remotes, see below * 0x9 Sun + Flag Enable sun and wind detector (SUN and FLAG symbol on the Telis Soliris RC) * 0xA Flag Disable sun detector (FLAG symbol on the Telis Soliris RC) * * CRC * * uint8_t frame[7]; * for (i=0; i < 7; i++) { * cksum = cksum ^ frame[i] ^ (frame[i] >> 4); * } * cksum = cksum & 0xf; * */ uint64_t data = instance->data ^ (instance->data >> 8); instance->btn = (data >> 44) & 0xF; instance->cnt = (data >> 24) & 0xFFFF; instance->serial = data & 0xFFFFFF; } /** * Get button name. * @param btn Button number, 4 bit */ static const char* subghz_protocol_somfy_telis_get_name_button(uint8_t btn) { const char* name_btn[0x10] = { "Unknown", "My", "Up", "My+Up", "Down", "My+Down", "Up+Down", "0x07", "Prog", "Sun+Flag", "Flag", "0x0B", "0x0C", "0x0D", "0x0E", "0x0F"}; return btn <= 0xf ? name_btn[btn] : name_btn[0]; } uint8_t subghz_protocol_decoder_somfy_telis_get_hash_data(void* context) { furi_assert(context); SubGhzProtocolDecoderSomfyTelis* instance = context; return subghz_protocol_blocks_get_hash_data( &instance->decoder, (instance->decoder.decode_count_bit / 8) + 1); } bool subghz_protocol_decoder_somfy_telis_serialize( void* context, FlipperFormat* flipper_format, SubGhzPresetDefinition* preset) { furi_assert(context); SubGhzProtocolDecoderSomfyTelis* instance = context; return subghz_block_generic_serialize(&instance->generic, flipper_format, preset); } bool subghz_protocol_decoder_somfy_telis_deserialize(void* context, FlipperFormat* flipper_format) { furi_assert(context); SubGhzProtocolDecoderSomfyTelis* instance = context; return subghz_block_generic_deserialize(&instance->generic, flipper_format); } void subghz_protocol_decoder_somfy_telis_get_string(void* context, string_t output) { furi_assert(context); SubGhzProtocolDecoderSomfyTelis* instance = context; subghz_protocol_somfy_telis_check_remote_controller(&instance->generic); string_cat_printf( output, "%s %db\r\n" "Key:0x%lX%08lX\r\n" "Sn:0x%06lX \r\n" "Cnt:0x%04X\r\n" "Btn:%s\r\n", instance->generic.protocol_name, instance->generic.data_count_bit, (uint32_t)(instance->generic.data >> 32), (uint32_t)instance->generic.data, instance->generic.serial, instance->generic.cnt, subghz_protocol_somfy_telis_get_name_button(instance->generic.btn)); }