| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634 |
- #include "secplus_v1.h"
- #include "../blocks/const.h"
- #include "../blocks/decoder.h"
- #include "../blocks/encoder.h"
- #include "../blocks/generic.h"
- #include "../blocks/math.h"
- /*
- * Help
- * https://github.com/argilo/secplus
- * https://github.com/merbanan/rtl_433/blob/master/src/devices/secplus_v1.c
- */
- #define TAG "SubGhzProtocoSecPlus_v1"
- #define SECPLUS_V1_BIT_ERR -1 //0b0000
- #define SECPLUS_V1_BIT_0 0 //0b0001
- #define SECPLUS_V1_BIT_1 1 //0b0011
- #define SECPLUS_V1_BIT_2 2 //0b0111
- #define SECPLUS_V1_PACKET_1_HEADER 0x00
- #define SECPLUS_V1_PACKET_2_HEADER 0x02
- #define SECPLUS_V1_PACKET_1_INDEX_BASE 0
- #define SECPLUS_V1_PACKET_2_INDEX_BASE 21
- #define SECPLUS_V1_PACKET_1_ACCEPTED (1 << 0)
- #define SECPLUS_V1_PACKET_2_ACCEPTED (1 << 1)
- static const SubGhzBlockConst subghz_protocol_secplus_v1_const = {
- .te_short = 500,
- .te_long = 1500,
- .te_delta = 100,
- .min_count_bit_for_found = 21,
- };
- struct SubGhzProtocolDecoderSecPlus_v1 {
- SubGhzProtocolDecoderBase base;
- SubGhzBlockDecoder decoder;
- SubGhzBlockGeneric generic;
- uint8_t packet_accepted;
- uint8_t base_packet_index;
- uint8_t data_array[44];
- };
- struct SubGhzProtocolEncoderSecPlus_v1 {
- SubGhzProtocolEncoderBase base;
- SubGhzProtocolBlockEncoder encoder;
- SubGhzBlockGeneric generic;
- uint8_t data_array[44];
- };
- typedef enum {
- SecPlus_v1DecoderStepReset = 0,
- SecPlus_v1DecoderStepSearchStartBit,
- SecPlus_v1DecoderStepSaveDuration,
- SecPlus_v1DecoderStepDecoderData,
- } SecPlus_v1DecoderStep;
- const SubGhzProtocolDecoder subghz_protocol_secplus_v1_decoder = {
- .alloc = subghz_protocol_decoder_secplus_v1_alloc,
- .free = subghz_protocol_decoder_secplus_v1_free,
- .feed = subghz_protocol_decoder_secplus_v1_feed,
- .reset = subghz_protocol_decoder_secplus_v1_reset,
- .get_hash_data = subghz_protocol_decoder_secplus_v1_get_hash_data,
- .serialize = subghz_protocol_decoder_secplus_v1_serialize,
- .deserialize = subghz_protocol_decoder_secplus_v1_deserialize,
- .get_string = subghz_protocol_decoder_secplus_v1_get_string,
- };
- const SubGhzProtocolEncoder subghz_protocol_secplus_v1_encoder = {
- .alloc = subghz_protocol_encoder_secplus_v1_alloc,
- .free = subghz_protocol_encoder_secplus_v1_free,
- .deserialize = subghz_protocol_encoder_secplus_v1_deserialize,
- .stop = subghz_protocol_encoder_secplus_v1_stop,
- .yield = subghz_protocol_encoder_secplus_v1_yield,
- };
- const SubGhzProtocol subghz_protocol_secplus_v1 = {
- .name = SUBGHZ_PROTOCOL_SECPLUS_V1_NAME,
- .type = SubGhzProtocolTypeDynamic,
- .flag = SubGhzProtocolFlag_315 | SubGhzProtocolFlag_AM | SubGhzProtocolFlag_Decodable |
- SubGhzProtocolFlag_Load | SubGhzProtocolFlag_Send,
- .decoder = &subghz_protocol_secplus_v1_decoder,
- .encoder = &subghz_protocol_secplus_v1_encoder,
- };
- void* subghz_protocol_encoder_secplus_v1_alloc(SubGhzEnvironment* environment) {
- UNUSED(environment);
- SubGhzProtocolEncoderSecPlus_v1* instance = malloc(sizeof(SubGhzProtocolEncoderSecPlus_v1));
- instance->base.protocol = &subghz_protocol_secplus_v1;
- instance->generic.protocol_name = instance->base.protocol->name;
- instance->encoder.repeat = 10;
- instance->encoder.size_upload = 128;
- instance->encoder.upload = malloc(instance->encoder.size_upload * sizeof(LevelDuration));
- instance->encoder.is_running = false;
- return instance;
- }
- void subghz_protocol_encoder_secplus_v1_free(void* context) {
- furi_assert(context);
- SubGhzProtocolEncoderSecPlus_v1* instance = context;
- free(instance->encoder.upload);
- free(instance);
- }
- /**
- * Generating an upload from data.
- * @param instance Pointer to a SubGhzProtocolEncoderSecPlus_v1 instance
- * @return true On success
- */
- static bool
- subghz_protocol_encoder_secplus_v1_get_upload(SubGhzProtocolEncoderSecPlus_v1* 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, "Encoder size upload exceeds allocated encoder buffer.");
- return false;
- } else {
- instance->encoder.size_upload = size_upload;
- }
- //Send header packet 1
- instance->encoder.upload[index++] = level_duration_make(
- false, (uint32_t)subghz_protocol_secplus_v1_const.te_short * (116 + 3));
- instance->encoder.upload[index++] =
- level_duration_make(true, (uint32_t)subghz_protocol_secplus_v1_const.te_short);
- //Send data packet 1
- for(uint8_t i = SECPLUS_V1_PACKET_1_INDEX_BASE + 1; i < SECPLUS_V1_PACKET_1_INDEX_BASE + 21;
- i++) {
- switch(instance->data_array[i]) {
- case SECPLUS_V1_BIT_0:
- instance->encoder.upload[index++] = level_duration_make(
- false, (uint32_t)subghz_protocol_secplus_v1_const.te_short * 3);
- instance->encoder.upload[index++] =
- level_duration_make(true, (uint32_t)subghz_protocol_secplus_v1_const.te_short);
- break;
- case SECPLUS_V1_BIT_1:
- instance->encoder.upload[index++] = level_duration_make(
- false, (uint32_t)subghz_protocol_secplus_v1_const.te_short * 2);
- instance->encoder.upload[index++] =
- level_duration_make(true, (uint32_t)subghz_protocol_secplus_v1_const.te_short * 2);
- break;
- case SECPLUS_V1_BIT_2:
- instance->encoder.upload[index++] =
- level_duration_make(false, (uint32_t)subghz_protocol_secplus_v1_const.te_short);
- instance->encoder.upload[index++] =
- level_duration_make(true, (uint32_t)subghz_protocol_secplus_v1_const.te_short * 3);
- break;
- default:
- FURI_LOG_E(TAG, "Encoder error, wrong bit type");
- return false;
- break;
- }
- }
- //Send header packet 2
- instance->encoder.upload[index++] =
- level_duration_make(false, (uint32_t)subghz_protocol_secplus_v1_const.te_short * (116));
- instance->encoder.upload[index++] =
- level_duration_make(true, (uint32_t)subghz_protocol_secplus_v1_const.te_short * 3);
- //Send data packet 2
- for(uint8_t i = SECPLUS_V1_PACKET_2_INDEX_BASE + 1; i < SECPLUS_V1_PACKET_2_INDEX_BASE + 21;
- i++) {
- switch(instance->data_array[i]) {
- case SECPLUS_V1_BIT_0:
- instance->encoder.upload[index++] = level_duration_make(
- false, (uint32_t)subghz_protocol_secplus_v1_const.te_short * 3);
- instance->encoder.upload[index++] =
- level_duration_make(true, (uint32_t)subghz_protocol_secplus_v1_const.te_short);
- break;
- case SECPLUS_V1_BIT_1:
- instance->encoder.upload[index++] = level_duration_make(
- false, (uint32_t)subghz_protocol_secplus_v1_const.te_short * 2);
- instance->encoder.upload[index++] =
- level_duration_make(true, (uint32_t)subghz_protocol_secplus_v1_const.te_short * 2);
- break;
- case SECPLUS_V1_BIT_2:
- instance->encoder.upload[index++] =
- level_duration_make(false, (uint32_t)subghz_protocol_secplus_v1_const.te_short);
- instance->encoder.upload[index++] =
- level_duration_make(true, (uint32_t)subghz_protocol_secplus_v1_const.te_short * 3);
- break;
- default:
- FURI_LOG_E(TAG, "Encoder error, wrong bit type.");
- return false;
- break;
- }
- }
- return true;
- }
- /**
- * Security+ 1.0 message encoding
- * @param instance SubGhzProtocolEncoderSecPlus_v1*
- */
- static bool subghz_protocol_secplus_v1_encode(SubGhzProtocolEncoderSecPlus_v1* instance) {
- uint32_t fixed = (instance->generic.data >> 32) & 0xFFFFFFFF;
- uint32_t rolling = instance->generic.data & 0xFFFFFFFF;
- uint8_t rolling_array[20] = {0};
- uint8_t fixed_array[20] = {0};
- uint32_t acc = 0;
- //increment the counter
- rolling += 2;
- //update data
- instance->generic.data &= 0xFFFFFFFF00000000;
- instance->generic.data |= rolling;
- if(rolling > 0xFFFFFFFF) {
- rolling = 0xE6000000;
- }
- if(fixed > 0xCFD41B90) {
- FURI_LOG_E("TAG", "Encode wrong fixed data");
- return false;
- }
- rolling = subghz_protocol_blocks_reverse_key(rolling, 32);
- for(int i = 19; i > -1; i--) {
- rolling_array[i] = rolling % 3;
- rolling /= 3;
- fixed_array[i] = fixed % 3;
- fixed /= 3;
- }
- instance->data_array[SECPLUS_V1_PACKET_1_INDEX_BASE] = SECPLUS_V1_PACKET_1_HEADER;
- instance->data_array[SECPLUS_V1_PACKET_2_INDEX_BASE] = SECPLUS_V1_PACKET_2_HEADER;
- //encode packet 1
- for(uint8_t i = 1; i < 11; i++) {
- acc += rolling_array[i - 1];
- instance->data_array[i * 2 - 1] = rolling_array[i - 1];
- acc += fixed_array[i - 1];
- instance->data_array[i * 2] = acc % 3;
- }
- acc = 0;
- //encode packet 2
- for(uint8_t i = 11; i < 21; i++) {
- acc += rolling_array[i - 1];
- instance->data_array[i * 2] = rolling_array[i - 1];
- acc += fixed_array[i - 1];
- instance->data_array[i * 2 + 1] = acc % 3;
- }
- return true;
- }
- bool subghz_protocol_encoder_secplus_v1_deserialize(void* context, FlipperFormat* flipper_format) {
- furi_assert(context);
- SubGhzProtocolEncoderSecPlus_v1* 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 !=
- 2 * subghz_protocol_secplus_v1_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_secplus_v1_encode(instance)) {
- break;
- }
- if(!subghz_protocol_encoder_secplus_v1_get_upload(instance)) {
- break;
- }
- uint8_t key_data[sizeof(uint64_t)] = {0};
- for(size_t i = 0; i < sizeof(uint64_t); i++) {
- key_data[sizeof(uint64_t) - i - 1] = (instance->generic.data >> i * 8) & 0xFF;
- }
- if(!flipper_format_update_hex(flipper_format, "Key", key_data, sizeof(uint64_t))) {
- FURI_LOG_E(TAG, "Unable to add Key");
- break;
- }
- instance->encoder.is_running = true;
- res = true;
- } while(false);
- return res;
- }
- void subghz_protocol_encoder_secplus_v1_stop(void* context) {
- SubGhzProtocolEncoderSecPlus_v1* instance = context;
- instance->encoder.is_running = false;
- }
- LevelDuration subghz_protocol_encoder_secplus_v1_yield(void* context) {
- SubGhzProtocolEncoderSecPlus_v1* 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_secplus_v1_alloc(SubGhzEnvironment* environment) {
- UNUSED(environment);
- SubGhzProtocolDecoderSecPlus_v1* instance = malloc(sizeof(SubGhzProtocolDecoderSecPlus_v1));
- instance->base.protocol = &subghz_protocol_secplus_v1;
- instance->generic.protocol_name = instance->base.protocol->name;
- return instance;
- }
- void subghz_protocol_decoder_secplus_v1_free(void* context) {
- furi_assert(context);
- SubGhzProtocolDecoderSecPlus_v1* instance = context;
- free(instance);
- }
- void subghz_protocol_decoder_secplus_v1_reset(void* context) {
- furi_assert(context);
- // SubGhzProtocolDecoderSecPlus_v1* instance = context;
- // does not reset the decoder because you need to get 2 parts of the package
- }
- /**
- * Security+ 1.0 message decoding
- * @param instance SubGhzProtocolDecoderSecPlus_v1*
- */
- static void subghz_protocol_secplus_v1_decode(SubGhzProtocolDecoderSecPlus_v1* instance) {
- uint32_t rolling = 0;
- uint32_t fixed = 0;
- uint32_t acc = 0;
- uint8_t digit = 0;
- //decode packet 1
- for(uint8_t i = 1; i < 21; i += 2) {
- digit = instance->data_array[i];
- rolling = (rolling * 3) + digit;
- acc += digit;
- digit = (60 + instance->data_array[i + 1] - acc) % 3;
- fixed = (fixed * 3) + digit;
- acc += digit;
- }
- acc = 0;
- //decode packet 2
- for(uint8_t i = 22; i < 42; i += 2) {
- digit = instance->data_array[i];
- rolling = (rolling * 3) + digit;
- acc += digit;
- digit = (60 + instance->data_array[i + 1] - acc) % 3;
- fixed = (fixed * 3) + digit;
- acc += digit;
- }
- rolling = subghz_protocol_blocks_reverse_key(rolling, 32);
- instance->generic.data = (uint64_t)fixed << 32 | rolling;
- instance->generic.data_count_bit =
- subghz_protocol_secplus_v1_const.min_count_bit_for_found * 2;
- }
- void subghz_protocol_decoder_secplus_v1_feed(void* context, bool level, uint32_t duration) {
- furi_assert(context);
- SubGhzProtocolDecoderSecPlus_v1* instance = context;
- switch(instance->decoder.parser_step) {
- case SecPlus_v1DecoderStepReset:
- if((!level) && (DURATION_DIFF(duration, subghz_protocol_secplus_v1_const.te_short * 120) <
- subghz_protocol_secplus_v1_const.te_delta * 120)) {
- //Found header Security+ 1.0
- instance->decoder.parser_step = SecPlus_v1DecoderStepSearchStartBit;
- instance->decoder.decode_data = 0;
- instance->decoder.decode_count_bit = 0;
- instance->packet_accepted = 0;
- memset(instance->data_array, 0, sizeof(instance->data_array));
- }
- break;
- case SecPlus_v1DecoderStepSearchStartBit:
- if(level) {
- if(DURATION_DIFF(duration, subghz_protocol_secplus_v1_const.te_short) <
- subghz_protocol_secplus_v1_const.te_delta) {
- instance->base_packet_index = SECPLUS_V1_PACKET_1_INDEX_BASE;
- instance
- ->data_array[instance->decoder.decode_count_bit + instance->base_packet_index] =
- SECPLUS_V1_BIT_0;
- instance->decoder.decode_count_bit++;
- instance->decoder.parser_step = SecPlus_v1DecoderStepSaveDuration;
- } else if(
- DURATION_DIFF(duration, subghz_protocol_secplus_v1_const.te_long) <
- subghz_protocol_secplus_v1_const.te_delta) {
- instance->base_packet_index = SECPLUS_V1_PACKET_2_INDEX_BASE;
- instance
- ->data_array[instance->decoder.decode_count_bit + instance->base_packet_index] =
- SECPLUS_V1_BIT_2;
- instance->decoder.decode_count_bit++;
- instance->decoder.parser_step = SecPlus_v1DecoderStepSaveDuration;
- } else {
- instance->decoder.parser_step = SecPlus_v1DecoderStepReset;
- }
- } else {
- instance->decoder.parser_step = SecPlus_v1DecoderStepReset;
- }
- break;
- case SecPlus_v1DecoderStepSaveDuration:
- if(!level) { //save interval
- if(DURATION_DIFF(duration, subghz_protocol_secplus_v1_const.te_short * 120) <
- subghz_protocol_secplus_v1_const.te_delta * 120) {
- if(instance->decoder.decode_count_bit ==
- subghz_protocol_secplus_v1_const.min_count_bit_for_found) {
- if(instance->base_packet_index == SECPLUS_V1_PACKET_1_INDEX_BASE)
- instance->packet_accepted |= SECPLUS_V1_PACKET_1_ACCEPTED;
- if(instance->base_packet_index == SECPLUS_V1_PACKET_2_INDEX_BASE)
- instance->packet_accepted |= SECPLUS_V1_PACKET_2_ACCEPTED;
- if(instance->packet_accepted ==
- (SECPLUS_V1_PACKET_1_ACCEPTED | SECPLUS_V1_PACKET_2_ACCEPTED)) {
- subghz_protocol_secplus_v1_decode(instance);
- if(instance->base.callback)
- instance->base.callback(&instance->base, instance->base.context);
- instance->decoder.parser_step = SecPlus_v1DecoderStepReset;
- }
- }
- instance->decoder.parser_step = SecPlus_v1DecoderStepSearchStartBit;
- instance->decoder.decode_data = 0;
- instance->decoder.decode_count_bit = 0;
- } else {
- instance->decoder.te_last = duration;
- instance->decoder.parser_step = SecPlus_v1DecoderStepDecoderData;
- }
- } else {
- instance->decoder.parser_step = SecPlus_v1DecoderStepReset;
- }
- break;
- case SecPlus_v1DecoderStepDecoderData:
- if(level && (instance->decoder.decode_count_bit <=
- subghz_protocol_secplus_v1_const.min_count_bit_for_found)) {
- if((DURATION_DIFF(
- instance->decoder.te_last, subghz_protocol_secplus_v1_const.te_short * 3) <
- subghz_protocol_secplus_v1_const.te_delta * 3) &&
- (DURATION_DIFF(duration, subghz_protocol_secplus_v1_const.te_short) <
- subghz_protocol_secplus_v1_const.te_delta)) {
- instance
- ->data_array[instance->decoder.decode_count_bit + instance->base_packet_index] =
- SECPLUS_V1_BIT_0;
- instance->decoder.decode_count_bit++;
- instance->decoder.parser_step = SecPlus_v1DecoderStepSaveDuration;
- } else if(
- (DURATION_DIFF(
- instance->decoder.te_last, subghz_protocol_secplus_v1_const.te_short * 2) <
- subghz_protocol_secplus_v1_const.te_delta * 2) &&
- (DURATION_DIFF(duration, subghz_protocol_secplus_v1_const.te_short * 2) <
- subghz_protocol_secplus_v1_const.te_delta * 2)) {
- instance
- ->data_array[instance->decoder.decode_count_bit + instance->base_packet_index] =
- SECPLUS_V1_BIT_1;
- instance->decoder.decode_count_bit++;
- instance->decoder.parser_step = SecPlus_v1DecoderStepSaveDuration;
- } else if(
- (DURATION_DIFF(
- instance->decoder.te_last, subghz_protocol_secplus_v1_const.te_short) <
- subghz_protocol_secplus_v1_const.te_delta) &&
- (DURATION_DIFF(duration, subghz_protocol_secplus_v1_const.te_short * 3) <
- subghz_protocol_secplus_v1_const.te_delta * 3)) {
- instance
- ->data_array[instance->decoder.decode_count_bit + instance->base_packet_index] =
- SECPLUS_V1_BIT_2;
- instance->decoder.decode_count_bit++;
- instance->decoder.parser_step = SecPlus_v1DecoderStepSaveDuration;
- } else {
- instance->decoder.parser_step = SecPlus_v1DecoderStepReset;
- }
- } else {
- instance->decoder.parser_step = SecPlus_v1DecoderStepReset;
- }
- break;
- }
- }
- uint8_t subghz_protocol_decoder_secplus_v1_get_hash_data(void* context) {
- furi_assert(context);
- SubGhzProtocolDecoderSecPlus_v1* instance = context;
- return subghz_protocol_blocks_get_hash_data(
- &instance->decoder, (instance->decoder.decode_count_bit / 8) + 1);
- }
- bool subghz_protocol_decoder_secplus_v1_serialize(
- void* context,
- FlipperFormat* flipper_format,
- SubGhzPresetDefinition* preset) {
- furi_assert(context);
- SubGhzProtocolDecoderSecPlus_v1* instance = context;
- return subghz_block_generic_serialize(&instance->generic, flipper_format, preset);
- }
- bool subghz_protocol_decoder_secplus_v1_deserialize(void* context, FlipperFormat* flipper_format) {
- furi_assert(context);
- SubGhzProtocolDecoderSecPlus_v1* instance = context;
- bool ret = false;
- do {
- if(!subghz_block_generic_deserialize(&instance->generic, flipper_format)) {
- break;
- }
- if(instance->generic.data_count_bit !=
- 2 * subghz_protocol_secplus_v1_const.min_count_bit_for_found) {
- FURI_LOG_E(TAG, "Wrong number of bits in key");
- break;
- }
- ret = true;
- } while(false);
- return ret;
- }
- bool subghz_protocol_secplus_v1_check_fixed(uint32_t fixed) {
- //uint8_t id0 = (fixed / 3) % 3;
- uint8_t id1 = (fixed / 9) % 3;
- uint8_t btn = fixed % 3;
- do {
- if(id1 == 0) return false;
- if(!(btn == 0 || btn == 1 || btn == 2)) return false;
- } while(false);
- return true;
- }
- void subghz_protocol_decoder_secplus_v1_get_string(void* context, FuriString* output) {
- furi_assert(context);
- SubGhzProtocolDecoderSecPlus_v1* instance = context;
- uint32_t fixed = (instance->generic.data >> 32) & 0xFFFFFFFF;
- instance->generic.cnt = instance->generic.data & 0xFFFFFFFF;
- instance->generic.btn = fixed % 3;
- uint8_t id0 = (fixed / 3) % 3;
- uint8_t id1 = (fixed / 9) % 3;
- uint16_t pin = 0;
- furi_string_cat_printf(
- output,
- "%s %db\r\n"
- "Key:0x%lX%08lX\r\n"
- "id1:%d id0:%d",
- instance->generic.protocol_name,
- instance->generic.data_count_bit,
- (uint32_t)(instance->generic.data >> 32),
- (uint32_t)instance->generic.data,
- id1,
- id0);
- if(id1 == 0) {
- // (fixed // 3**3) % (3**7) 3^3=27 3^73=72187
- instance->generic.serial = (fixed / 27) % 2187;
- // pin = (fixed // 3**10) % (3**9) 3^10=59049 3^9=19683
- pin = (fixed / 59049) % 19683;
- if(pin <= 9999) {
- furi_string_cat_printf(output, " pin:%d", pin);
- } else if(10000 <= pin && pin <= 11029) {
- furi_string_cat_printf(output, " pin:enter");
- }
- int pin_suffix = 0;
- // pin_suffix = (fixed // 3**19) % 3 3^19=1162261467
- pin_suffix = (fixed / 1162261467) % 3;
- if(pin_suffix == 1) {
- furi_string_cat_printf(output, " #\r\n");
- } else if(pin_suffix == 2) {
- furi_string_cat_printf(output, " *\r\n");
- } else {
- furi_string_cat_printf(output, "\r\n");
- }
- furi_string_cat_printf(
- output,
- "Sn:0x%08lX\r\n"
- "Cnt:0x%03lX\r\n"
- "Sw_id:0x%X\r\n",
- instance->generic.serial,
- instance->generic.cnt,
- instance->generic.btn);
- } else {
- //id = fixed / 27;
- instance->generic.serial = fixed / 27;
- if(instance->generic.btn == 1) {
- furi_string_cat_printf(output, " Btn:left\r\n");
- } else if(instance->generic.btn == 0) {
- furi_string_cat_printf(output, " Btn:middle\r\n");
- } else if(instance->generic.btn == 2) {
- furi_string_cat_printf(output, " Btn:right\r\n");
- }
- furi_string_cat_printf(
- output,
- "Sn:0x%08lX\r\n"
- "Cnt:0x%03lX\r\n"
- "Sw_id:0x%X\r\n",
- instance->generic.serial,
- instance->generic.cnt,
- instance->generic.btn);
- }
- }
|