Compare commits

...

8 Commits

Author SHA1 Message Date
Andrea
17011180d1 Merge pull request #4 from LTX128/main
All checks were successful
Build Dev Firmware / build (push) Successful in 6m31s
Add Device Name changer in System Settings
2026-03-24 21:46:42 +01:00
Andrea Santaniello
d85657b6b3 Update README.md 2026-03-24 20:57:49 +01:00
Andrea Santaniello
2fd01bb911 Scher Khan PRO/PRO2 and Sheriff CFM 2026-03-24 20:50:48 +01:00
LTX74
aaf16ec0de add Device Name changer in System Settings 2026-03-22 23:20:34 +01:00
LTX74
cdd7c56b69 increase stack to 2K and add storage dependency 2026-03-22 23:18:16 +01:00
LTX74
0fd985c67a increase stack to 2K and add storage dependency 2026-03-22 23:17:48 +01:00
LTX74
e93606aa87 add TextInput and Storage to SystemSettings struct 2026-03-22 23:15:29 +01:00
LTX74
3933a77b72 Update system_settings.h 2026-03-22 23:14:57 +01:00
9 changed files with 1008 additions and 7 deletions

View File

@@ -62,6 +62,8 @@ This project may incorporate, adapt, or build upon **other open-source projects*
| Mitsubishi | Mitsubishi V0 | 868 MHz | FM | Yes | Yes | No |
| Starline | Star Line | 433 MHz | AM | Yes | Yes | No |
| Scher-Khan | Scher-Khan | 433 MHz | FM | Yes | Yes | No |
| Scher-Khan | Magic Code PRO1/PRO2 | 433 MHz | FM | Yes | Yes | Yes |
| Sheriff | Sheriff CFM (ZX-750/930) | 433 MHz | AM | Yes | Yes | No |
### Gate / Access Protocols

View File

@@ -3,7 +3,7 @@ App(
name="System",
apptype=FlipperAppType.SETTINGS,
entry_point="system_settings_app",
requires=["gui", "locale"],
stack_size=1 * 1024,
requires=["gui", "locale", "storage"],
stack_size=2 * 1024,
order=30,
)

View File

@@ -2,6 +2,9 @@
#include <loader/loader.h>
#include <lib/toolbox/value_index.h>
#include <locale/locale.h>
#include <flipper_format/flipper_format.h>
#include <power/power_service/power.h>
#include <applications/services/namechanger/namechanger.h>
const char* const log_level_text[] = {
"Default",
@@ -208,6 +211,81 @@ static void filename_scheme_changed(VariableItem* item) {
}
}
// ---- Device Name --------------------------------------------------------
#define DEVICE_NAME_ITEM_INDEX 11
static bool system_settings_device_name_validator(
const char* text,
FuriString* error,
void* context) {
UNUSED(context);
for(; *text; ++text) {
const char c = *text;
if((c < '0' || c > '9') && (c < 'A' || c > 'Z') && (c < 'a' || c > 'z')) {
furi_string_printf(error, "Letters and\nnumbers only!");
return false;
}
}
return true;
}
static void system_settings_device_name_callback(void* context) {
SystemSettings* app = context;
// Save name to SD card (same path as namechanger service)
FlipperFormat* file = flipper_format_file_alloc(app->storage);
bool saved = false;
do {
if(app->device_name[0] == '\0') {
// Empty name -> remove file to restore real name
storage_simply_remove(app->storage, NAMECHANGER_PATH);
saved = true;
break;
}
if(!flipper_format_file_open_always(file, NAMECHANGER_PATH)) break;
if(!flipper_format_write_header_cstr(file, NAMECHANGER_HEADER, NAMECHANGER_VERSION)) break;
if(!flipper_format_write_string_cstr(file, "Name", app->device_name)) break;
saved = true;
} while(false);
flipper_format_free(file);
if(saved) {
// Reboot to apply
Power* power = furi_record_open(RECORD_POWER);
power_reboot(power, PowerBootModeNormal);
} else {
// Go back silently on failure
view_dispatcher_switch_to_view(app->view_dispatcher, SystemSettingsViewVarItemList);
}
}
static void system_settings_enter_callback(void* context, uint32_t index) {
SystemSettings* app = context;
if(index == DEVICE_NAME_ITEM_INDEX) {
text_input_reset(app->text_input);
text_input_set_header_text(app->text_input, "Device Name (empty=reset)");
text_input_set_validator(
app->text_input, system_settings_device_name_validator, NULL);
text_input_set_minimum_length(app->text_input, 0);
text_input_set_result_callback(
app->text_input,
system_settings_device_name_callback,
app,
app->device_name,
FURI_HAL_VERSION_ARRAY_NAME_LENGTH,
false);
view_dispatcher_switch_to_view(app->view_dispatcher, SystemSettingsViewTextInput);
}
}
static uint32_t system_settings_text_input_back(void* context) {
UNUSED(context);
return SystemSettingsViewVarItemList;
}
// -------------------------------------------------------------------------
static uint32_t system_settings_exit(void* context) {
UNUSED(context);
return VIEW_NONE;
@@ -218,6 +296,7 @@ SystemSettings* system_settings_alloc(void) {
// Load settings
app->gui = furi_record_open(RECORD_GUI);
app->storage = furi_record_open(RECORD_STORAGE);
app->view_dispatcher = view_dispatcher_alloc();
view_dispatcher_set_event_callback_context(app->view_dispatcher, app);
@@ -314,6 +393,19 @@ SystemSettings* system_settings_alloc(void) {
variable_item_set_current_value_index(item, value_index);
variable_item_set_current_value_text(item, filename_scheme[value_index]);
// Device Name (index = DEVICE_NAME_ITEM_INDEX = 11)
const char* current_name = furi_hal_version_get_name_ptr();
strlcpy(
app->device_name,
current_name ? current_name : "",
FURI_HAL_VERSION_ARRAY_NAME_LENGTH);
item = variable_item_list_add(app->var_item_list, "Device Name", 0, NULL, app);
variable_item_set_current_value_text(
item, app->device_name[0] != '\0' ? app->device_name : "<default>");
variable_item_list_set_enter_callback(
app->var_item_list, system_settings_enter_callback, app);
view_set_previous_callback(
variable_item_list_get_view(app->var_item_list), system_settings_exit);
view_dispatcher_add_view(
@@ -321,6 +413,15 @@ SystemSettings* system_settings_alloc(void) {
SystemSettingsViewVarItemList,
variable_item_list_get_view(app->var_item_list));
// TextInput for device name
app->text_input = text_input_alloc();
view_set_previous_callback(
text_input_get_view(app->text_input), system_settings_text_input_back);
view_dispatcher_add_view(
app->view_dispatcher,
SystemSettingsViewTextInput,
text_input_get_view(app->text_input));
view_dispatcher_switch_to_view(app->view_dispatcher, SystemSettingsViewVarItemList);
return app;
@@ -328,12 +429,16 @@ SystemSettings* system_settings_alloc(void) {
void system_settings_free(SystemSettings* app) {
furi_assert(app);
// TextInput
view_dispatcher_remove_view(app->view_dispatcher, SystemSettingsViewTextInput);
text_input_free(app->text_input);
// Variable item list
view_dispatcher_remove_view(app->view_dispatcher, SystemSettingsViewVarItemList);
variable_item_list_free(app->var_item_list);
// View dispatcher
view_dispatcher_free(app->view_dispatcher);
// Records
furi_record_close(RECORD_STORAGE);
furi_record_close(RECORD_GUI);
free(app);
}

View File

@@ -2,17 +2,24 @@
#include <furi.h>
#include <furi_hal.h>
#include <furi_hal_version.h>
#include <gui/gui.h>
#include <gui/view_dispatcher.h>
#include <gui/modules/variable_item_list.h>
#include <gui/modules/text_input.h>
#include <storage/storage.h>
typedef struct {
Gui* gui;
ViewDispatcher* view_dispatcher;
VariableItemList* var_item_list;
TextInput* text_input;
Storage* storage;
char device_name[FURI_HAL_VERSION_ARRAY_NAME_LENGTH];
} SystemSettings;
typedef enum {
SystemSettingsViewVarItemList,
SystemSettingsViewTextInput,
} SystemSettingsView;

View File

@@ -74,6 +74,7 @@ const SubGhzProtocol* const subghz_protocol_registry_items[] = {
&subghz_protocol_mitsubishi_v0,
&subghz_protocol_star_line,
&subghz_protocol_scher_khan,
&subghz_protocol_sheriff_cfm,
};
const SubGhzProtocolRegistry subghz_protocol_registry = {

View File

@@ -76,3 +76,4 @@
#include "mazda_siemens.h"
#include "star_line.h"
#include "scher_khan.h"
#include "sheriff_cfm.h"

View File

@@ -2,8 +2,129 @@
#include "../blocks/custom_btn_i.h"
#include "../blocks/generic.h"
#include <string.h>
#define TAG "SubGhzProtocolScherKhan"
static const uint8_t sk_pi_bytes[146] = {
0x24, 0x3F, 0x6A, 0x88, 0x85, 0xA3, 0x08, 0xD3,
0x13, 0x19, 0x8A, 0x2E, 0x03, 0x70, 0x73, 0x44,
0xA4, 0x09, 0x38, 0x22, 0x29, 0x9F, 0x31, 0xD0,
0x08, 0x2E, 0xFA, 0x98, 0xEC, 0x4E, 0x6C, 0x89,
0x45, 0x28, 0x21, 0xE6, 0x38, 0xD0, 0x13, 0x77,
0xBE, 0x54, 0x66, 0xCF, 0x34, 0xE9, 0x0C, 0x6C,
0xC0, 0xAC, 0x29, 0xB7, 0xC9, 0x7C, 0x50, 0xDD,
0x3F, 0x84, 0xD5, 0xB5, 0xB5, 0x47, 0x09, 0x17,
0x92, 0x16, 0xD5, 0xD9, 0x89, 0x79, 0xFB, 0x1B,
0xD1, 0x31, 0x0B, 0xA6, 0x98, 0xDF, 0xB5, 0xAC,
0x2F, 0xFD, 0x72, 0xDB, 0xD0, 0x1A, 0xDF, 0xB7,
0xB8, 0xE1, 0xAF, 0xED, 0x6A, 0x26, 0x7E, 0x96,
0xBA, 0x7C, 0x90, 0x45, 0xF1, 0x2C, 0x7F, 0x99,
0x24, 0xA1, 0x99, 0x47, 0xB3, 0x91, 0x6C, 0xF7,
0x08, 0x01, 0xF2, 0xE2, 0x85, 0x8E, 0xFC, 0x16,
0x63, 0x69, 0x20, 0xD8, 0x71, 0x57, 0x4E, 0x69,
0xA4, 0x58, 0xFE, 0xA3, 0xF4, 0x93, 0x3D, 0x7E,
0x0D, 0x95, 0x74, 0x8F, 0x72, 0x8E, 0xB6, 0x58,
0x71, 0x8B,
};
static const uint8_t sk_pro1_encoded[64] = {
0x63, 0x5A, 0x58, 0x98, 0xD6, 0xB3, 0x7E, 0x91,
0x37, 0x1E, 0xBB, 0x78, 0x43, 0x06, 0x20, 0x65,
0xC7, 0x4B, 0x3F, 0x73, 0x0D, 0xAE, 0x36, 0x86,
0x1E, 0x7A, 0xDA, 0xEB, 0xBB, 0x0F, 0x5A, 0xA9,
0x26, 0x3A, 0x51, 0xB2, 0x7A, 0xE0, 0x44, 0x61,
0xAC, 0x53, 0x02, 0xFA, 0x42, 0xBD, 0x2D, 0x6F,
0x85, 0xBB, 0x4A, 0xB5, 0xF9, 0x28, 0x46, 0xAF,
0x2B, 0xB4, 0xB2, 0x90, 0xD0, 0x05, 0x19, 0x64,
};
static const uint8_t sk_pro2_encoded[64] = {
0x90, 0x27, 0xA3, 0x9C, 0xEA, 0x6B, 0x8B, 0x4F,
0x91, 0x47, 0x58, 0x87, 0x8A, 0xD8, 0xD1, 0x99,
0x3B, 0xCD, 0x15, 0xFE, 0xF4, 0x1D, 0xEE, 0xE1,
0xBF, 0xA4, 0x9E, 0xCB, 0x1C, 0x72, 0x5F, 0x95,
0xAC, 0x28, 0xB0, 0x36, 0xE3, 0x2B, 0x1B, 0xAC,
0x30, 0x91, 0xFE, 0x62, 0xD0, 0xD3, 0x6B, 0xA6,
0x4F, 0x64, 0xC0, 0xF2, 0xD2, 0xCF, 0xCA, 0x36,
0x53, 0x3D, 0x36, 0xAA, 0x33, 0x67, 0x19, 0x7F,
};
static const uint8_t sk_pro_crc_encoded[2] = {
0x5B, 0x8C,
};
static void sk_pi_decode(uint8_t* out, const uint8_t* encoded, size_t offset, size_t len) {
for(size_t i = 0; i < len; i++) {
out[i] = encoded[i] ^ sk_pi_bytes[offset + i];
}
}
static uint8_t scher_khan_pro_checksum(const uint8_t* data, uint8_t poly) {
uint8_t cs = 0xFF;
for(uint8_t a = 0; a < 6; a++) {
uint8_t c = data[a];
for(uint8_t b = 0; b < 8; b++) {
uint8_t _cs = cs;
cs <<= 1;
if((_cs ^ c) & 0x80) cs ^= poly;
c <<= 1;
}
}
return cs;
}
static void scher_khan_pro_decrypt(
const uint8_t* encrypted,
uint8_t* decrypted,
const uint8_t* key_table) {
memset(decrypted, 0, 7);
decrypted[0] = encrypted[0];
uint8_t pkt_cnt = encrypted[0] & 0x0F;
for(int i = 1; i < 6; i++) {
for(int j = 0; j < 4; j++) {
uint8_t cr = key_table[(pkt_cnt << 2) + j];
uint8_t s = encrypted[i];
uint8_t bit = 0x80 >> (cr >> 4);
if((s & bit) == bit) decrypted[i] |= 0x80 >> (j << 1);
bit = 0x80 >> (cr & 0x0F);
if((s & bit) == bit) decrypted[i] |= 0x80 >> ((j << 1) + 1);
}
pkt_cnt = (pkt_cnt + 1) & 0x0F;
decrypted[i] ^= encrypted[i - 1];
}
}
static void scher_khan_pro_encrypt(
const uint8_t* plain,
uint8_t* encrypted,
const uint8_t* key_table) {
uint8_t src[7];
memcpy(src, plain, 7);
memset(encrypted, 0, 7);
encrypted[0] = src[0];
uint8_t pkt_cnt = src[0] & 0x0F;
for(int i = 1; i < 6; i++) {
src[i] ^= encrypted[i - 1];
for(int j = 0; j < 4; j++) {
uint8_t cr = key_table[(pkt_cnt << 2) + j];
uint8_t s = src[i];
uint8_t bit = 0x80 >> (j << 1);
if((s & bit) == bit) encrypted[i] |= 0x80 >> (cr >> 4);
bit = 0x80 >> ((j << 1) + 1);
if((s & bit) == bit) encrypted[i] |= 0x80 >> (cr & 0x0F);
}
pkt_cnt = (pkt_cnt + 1) & 0x0F;
}
}
static const char* scher_khan_btn_name(uint8_t btn) {
switch(btn) {
case 0x1: return "Lock";
@@ -163,6 +284,52 @@ static bool subghz_protocol_encoder_scher_khan_get_upload(
instance->generic.btn = btn;
}
if(instance->generic.data_count_bit == 57) {
if((instance->generic.cnt + 1) > 0xFFFF) {
instance->generic.cnt = 0;
} else {
instance->generic.cnt += 1;
}
uint8_t kb[7];
for(int i = 0; i < 7; i++) {
kb[i] = (uint8_t)((instance->generic.data >> (48 - i * 8)) & 0xFF);
}
uint8_t crc_polys[2];
sk_pi_decode(crc_polys, sk_pro_crc_encoded, 144, 2);
uint8_t key_table[64];
uint8_t poly;
uint8_t crc1 = scher_khan_pro_checksum(kb, crc_polys[0]);
if(crc1 == kb[6]) {
sk_pi_decode(key_table, sk_pro1_encoded, 0, 64);
poly = crc_polys[0];
} else {
sk_pi_decode(key_table, sk_pro2_encoded, 64, 64);
poly = crc_polys[1];
}
uint8_t decrypted[7];
scher_khan_pro_decrypt(kb, decrypted, key_table);
decrypted[3] = (decrypted[3] & 0xE0) | (btn & 0x0F);
decrypted[4] = (uint8_t)(instance->generic.cnt >> 8);
decrypted[5] = (uint8_t)(instance->generic.cnt & 0xFF);
uint8_t encrypted[7];
scher_khan_pro_encrypt(decrypted, encrypted, key_table);
encrypted[6] = scher_khan_pro_checksum(encrypted, poly);
instance->generic.data = 0;
for(int i = 0; i < 7; i++) {
instance->generic.data |= ((uint64_t)encrypted[i] << (48 - i * 8));
}
instance->generic.data &= 0x01FFFFFFFFFFFFFFULL;
instance->generic.btn = btn;
}
size_t index = 0;
size_t needed = (6 * 2) + (3 * 2) + (1 * 2) + (instance->generic.data_count_bit * 2) + 1;
if(needed > instance->encoder.size_upload) {
@@ -567,12 +734,53 @@ static void subghz_protocol_scher_khan_check_remote_controller(
instance->btn = (instance->data >> 24) & 0x0F;
instance->cnt = instance->data & 0xFFFF;
break;
case 57:
*protocol_name = "MAGIC CODE PRO/PRO2";
instance->serial = 0;
instance->btn = 0;
instance->cnt = 0;
case 57: {
uint8_t kb[7];
for(int i = 0; i < 7; i++) {
kb[i] = (uint8_t)((instance->data >> (48 - i * 8)) & 0xFF);
}
uint8_t crc_polys[2];
sk_pi_decode(crc_polys, sk_pro_crc_encoded, 144, 2);
uint8_t key_table[64];
uint8_t decrypted[7];
bool found = false;
uint8_t computed_crc = scher_khan_pro_checksum(kb, crc_polys[0]);
if(computed_crc == kb[6]) {
sk_pi_decode(key_table, sk_pro1_encoded, 0, 64);
scher_khan_pro_decrypt(kb, decrypted, key_table);
*protocol_name = "MAGIC CODE PRO1";
found = true;
}
if(!found) {
computed_crc = scher_khan_pro_checksum(kb, crc_polys[1]);
if(computed_crc == kb[6]) {
sk_pi_decode(key_table, sk_pro2_encoded, 64, 64);
scher_khan_pro_decrypt(kb, decrypted, key_table);
*protocol_name = "MAGIC CODE PRO2";
found = true;
}
}
if(found) {
instance->serial =
((uint32_t)decrypted[0] << 16) |
((uint32_t)decrypted[1] << 8) |
(uint32_t)decrypted[2];
instance->btn = decrypted[3] & 0x0F;
instance->cnt =
((uint16_t)decrypted[4] << 8) | decrypted[5];
} else {
*protocol_name = "MAGIC CODE PRO/PRO2";
instance->serial = 0;
instance->btn = 0;
instance->cnt = 0;
}
break;
}
case 63:
*protocol_name = "MAGIC CODE, Response";
instance->serial = 0;

View File

@@ -0,0 +1,634 @@
#include "sheriff_cfm.h"
#include "keeloq_common.h"
#include "../blocks/custom_btn_i.h"
#include "../blocks/generic.h"
#include <string.h>
#define TAG "SubGhzProtocolSheriffCfm"
static const uint8_t cfm_pi_bytes[] = {
0xA4, 0x58, 0xFE, 0xA3, 0xF4, 0x93, 0x3D, 0x7E,
0x0D, 0x95, 0x74, 0x8F, 0x72, 0x8E, 0xB6, 0x58,
};
static const uint8_t cfm_zx750_encoded[8] = {
0x32, 0x4D, 0xCB, 0x84, 0x5F, 0xE9, 0x27, 0xCB,
};
static const uint8_t cfm_zx930_encoded[8] = {
0x94, 0x3B, 0x63, 0xA5, 0xE8, 0xF3, 0xAB, 0x60,
};
static void cfm_pi_decode(uint8_t* out, const uint8_t* encoded, size_t pi_offset, size_t len) {
for(size_t i = 0; i < len; i++) {
out[i] = encoded[i] ^ cfm_pi_bytes[pi_offset + i];
}
}
static uint8_t cfm_rlf(uint8_t in) {
return (uint8_t)((in << 1) | (in >> 7));
}
static uint8_t cfm_rrf(uint8_t in) {
return (uint8_t)((in >> 1) | (in << 7));
}
static uint8_t cfm_swap(uint8_t in) {
return (uint8_t)((in << 4) | (in >> 4));
}
typedef enum {
SheriffCfmModelZX750 = 0,
SheriffCfmModelZX930 = 1,
SheriffCfmModelCount = 2,
} SheriffCfmModel;
static const char* cfm_model_name(SheriffCfmModel model) {
switch(model) {
case SheriffCfmModelZX750: return "ZX-750";
case SheriffCfmModelZX930: return "ZX-930";
default: return "?";
}
}
static void cfm_decrypt_transform(uint8_t* hop, SheriffCfmModel model) {
uint8_t temp;
switch(model) {
case SheriffCfmModelZX750:
hop[0] = cfm_swap(hop[0]);
hop[2] = cfm_swap(hop[2]);
break;
case SheriffCfmModelZX930:
hop[0] = ~hop[0];
temp = hop[1];
hop[1] = hop[2];
hop[2] = temp;
hop[0] = cfm_rrf(hop[0]);
hop[1] = cfm_swap(hop[1]);
hop[1] = cfm_rlf(hop[1]);
hop[1] = cfm_rlf(hop[1]);
break;
default:
break;
}
}
static void cfm_encrypt_transform(uint8_t* hop, SheriffCfmModel model) {
uint8_t temp;
switch(model) {
case SheriffCfmModelZX750:
hop[0] = cfm_swap(hop[0]);
hop[2] = cfm_swap(hop[2]);
break;
case SheriffCfmModelZX930:
hop[1] = cfm_rrf(hop[1]);
hop[1] = cfm_rrf(hop[1]);
hop[1] = cfm_swap(hop[1]);
hop[0] = cfm_rlf(hop[0]);
hop[0] = ~hop[0];
temp = hop[1];
hop[1] = hop[2];
hop[2] = temp;
break;
default:
break;
}
}
static const char* cfm_btn_name(uint8_t btn) {
switch(btn) {
case 0x10: return "Lock";
case 0x20: return "Unlock";
case 0x40: return "Trunk";
case 0x80: return "Panic";
default: return "?";
}
}
static uint8_t cfm_btn_to_custom(uint8_t btn) {
switch(btn) {
case 0x10: return SUBGHZ_CUSTOM_BTN_UP;
case 0x20: return SUBGHZ_CUSTOM_BTN_DOWN;
case 0x40: return SUBGHZ_CUSTOM_BTN_LEFT;
case 0x80: return SUBGHZ_CUSTOM_BTN_RIGHT;
default: return SUBGHZ_CUSTOM_BTN_OK;
}
}
static uint8_t cfm_custom_to_btn(uint8_t custom, uint8_t original_btn) {
if(custom == SUBGHZ_CUSTOM_BTN_OK) return original_btn;
if(custom == SUBGHZ_CUSTOM_BTN_UP) return 0x10;
if(custom == SUBGHZ_CUSTOM_BTN_DOWN) return 0x20;
if(custom == SUBGHZ_CUSTOM_BTN_LEFT) return 0x40;
if(custom == SUBGHZ_CUSTOM_BTN_RIGHT) return 0x80;
return original_btn;
}
static uint8_t cfm_get_btn_code(uint8_t original_btn) {
return cfm_custom_to_btn(subghz_custom_btn_get(), original_btn);
}
static const SubGhzBlockConst subghz_protocol_sheriff_cfm_const = {
.te_short = 400,
.te_long = 800,
.te_delta = 140,
.min_count_bit_for_found = 64,
};
struct SubGhzProtocolDecoderSheriffCfm {
SubGhzProtocolDecoderBase base;
SubGhzBlockDecoder decoder;
SubGhzBlockGeneric generic;
uint16_t header_count;
SheriffCfmModel model;
};
struct SubGhzProtocolEncoderSheriffCfm {
SubGhzProtocolEncoderBase base;
SubGhzProtocolBlockEncoder encoder;
SubGhzBlockGeneric generic;
SheriffCfmModel model;
};
typedef enum {
SheriffCfmDecoderStepReset = 0,
SheriffCfmDecoderStepCheckPreambula,
SheriffCfmDecoderStepSaveDuration,
SheriffCfmDecoderStepCheckDuration,
} SheriffCfmDecoderStep;
const SubGhzProtocolDecoder subghz_protocol_sheriff_cfm_decoder = {
.alloc = subghz_protocol_decoder_sheriff_cfm_alloc,
.free = subghz_protocol_decoder_sheriff_cfm_free,
.feed = subghz_protocol_decoder_sheriff_cfm_feed,
.reset = subghz_protocol_decoder_sheriff_cfm_reset,
.get_hash_data = subghz_protocol_decoder_sheriff_cfm_get_hash_data,
.serialize = subghz_protocol_decoder_sheriff_cfm_serialize,
.deserialize = subghz_protocol_decoder_sheriff_cfm_deserialize,
.get_string = subghz_protocol_decoder_sheriff_cfm_get_string,
};
const SubGhzProtocolEncoder subghz_protocol_sheriff_cfm_encoder = {
.alloc = subghz_protocol_encoder_sheriff_cfm_alloc,
.free = subghz_protocol_encoder_sheriff_cfm_free,
.deserialize = subghz_protocol_encoder_sheriff_cfm_deserialize,
.stop = subghz_protocol_encoder_sheriff_cfm_stop,
.yield = subghz_protocol_encoder_sheriff_cfm_yield,
};
const SubGhzProtocol subghz_protocol_sheriff_cfm = {
.name = SUBGHZ_PROTOCOL_SHERIFF_CFM_NAME,
.type = SubGhzProtocolTypeDynamic,
.flag = SubGhzProtocolFlag_433 | SubGhzProtocolFlag_AM |
SubGhzProtocolFlag_Decodable |
SubGhzProtocolFlag_Load | SubGhzProtocolFlag_Save | SubGhzProtocolFlag_Send,
.decoder = &subghz_protocol_sheriff_cfm_decoder,
.encoder = &subghz_protocol_sheriff_cfm_encoder,
};
static uint64_t cfm_get_mfkey(SheriffCfmModel model) {
uint8_t dkey[8];
switch(model) {
case SheriffCfmModelZX750:
cfm_pi_decode(dkey, cfm_zx750_encoded, 0, 8);
break;
case SheriffCfmModelZX930:
cfm_pi_decode(dkey, cfm_zx930_encoded, 8, 8);
break;
default:
return 0;
}
uint64_t key = 0;
for(int i = 7; i >= 0; i--) {
key = (key << 8) | dkey[i];
}
return key;
}
static bool cfm_try_decrypt(
uint64_t data,
SheriffCfmModel* out_model,
uint8_t* out_btn,
uint32_t* out_serial,
uint16_t* out_cnt) {
uint32_t hop_encrypted = (uint32_t)(data & 0xFFFFFFFF);
uint32_t fix = (uint32_t)(data >> 32);
for(SheriffCfmModel model = 0; model < SheriffCfmModelCount; model++) {
uint8_t hop_bytes[4];
hop_bytes[0] = (uint8_t)(hop_encrypted & 0xFF);
hop_bytes[1] = (uint8_t)((hop_encrypted >> 8) & 0xFF);
hop_bytes[2] = (uint8_t)((hop_encrypted >> 16) & 0xFF);
hop_bytes[3] = (uint8_t)((hop_encrypted >> 24) & 0xFF);
cfm_decrypt_transform(hop_bytes, model);
uint32_t hop_transformed =
(uint32_t)hop_bytes[0] |
((uint32_t)hop_bytes[1] << 8) |
((uint32_t)hop_bytes[2] << 16) |
((uint32_t)hop_bytes[3] << 24);
uint64_t mfkey = cfm_get_mfkey(model);
uint32_t decrypted = subghz_protocol_keeloq_common_decrypt(hop_transformed, mfkey);
uint16_t dec_serial_lo = (uint16_t)((decrypted >> 16) & 0x3FF);
uint16_t fix_serial_lo = (uint16_t)(fix & 0x3FF);
uint8_t btn_byte = (uint8_t)((decrypted >> 24) & 0xFF);
bool valid_btn = (btn_byte == 0x10 || btn_byte == 0x20 ||
btn_byte == 0x40 || btn_byte == 0x80);
if(valid_btn && (dec_serial_lo == fix_serial_lo)) {
*out_model = model;
*out_btn = btn_byte;
*out_serial = fix;
*out_cnt = (uint16_t)(decrypted & 0xFFFF);
return true;
}
}
return false;
}
void* subghz_protocol_encoder_sheriff_cfm_alloc(SubGhzEnvironment* environment) {
UNUSED(environment);
SubGhzProtocolEncoderSheriffCfm* instance = malloc(sizeof(SubGhzProtocolEncoderSheriffCfm));
instance->base.protocol = &subghz_protocol_sheriff_cfm;
instance->generic.protocol_name = instance->base.protocol->name;
instance->encoder.repeat = 3;
instance->encoder.size_upload = 256;
instance->encoder.upload = malloc(instance->encoder.size_upload * sizeof(LevelDuration));
instance->encoder.is_running = false;
instance->encoder.front = 0;
instance->model = SheriffCfmModelZX750;
return instance;
}
void subghz_protocol_encoder_sheriff_cfm_free(void* context) {
furi_check(context);
SubGhzProtocolEncoderSheriffCfm* instance = context;
free(instance->encoder.upload);
free(instance);
}
static bool subghz_protocol_encoder_sheriff_cfm_get_upload(
SubGhzProtocolEncoderSheriffCfm* instance,
uint8_t btn) {
furi_check(instance);
if((instance->generic.cnt + 1) > 0xFFFF) {
instance->generic.cnt = 0;
} else {
instance->generic.cnt += 1;
}
uint32_t fix = (uint32_t)(instance->generic.data >> 32);
uint16_t serial_lo = (uint16_t)(fix & 0x3FF);
uint32_t hop_plain =
((uint32_t)btn << 24) |
((uint32_t)serial_lo << 16) |
(instance->generic.cnt & 0xFFFF);
uint64_t mfkey = cfm_get_mfkey(instance->model);
uint32_t hop_encrypted = subghz_protocol_keeloq_common_encrypt(hop_plain, mfkey);
uint8_t hop_bytes[4];
hop_bytes[0] = (uint8_t)(hop_encrypted & 0xFF);
hop_bytes[1] = (uint8_t)((hop_encrypted >> 8) & 0xFF);
hop_bytes[2] = (uint8_t)((hop_encrypted >> 16) & 0xFF);
hop_bytes[3] = (uint8_t)((hop_encrypted >> 24) & 0xFF);
cfm_encrypt_transform(hop_bytes, instance->model);
hop_encrypted =
(uint32_t)hop_bytes[0] |
((uint32_t)hop_bytes[1] << 8) |
((uint32_t)hop_bytes[2] << 16) |
((uint32_t)hop_bytes[3] << 24);
instance->generic.data = ((uint64_t)fix << 32) | hop_encrypted;
instance->generic.btn = btn;
size_t index = 0;
for(uint8_t i = 11; i > 0; i--) {
instance->encoder.upload[index++] =
level_duration_make(true, (uint32_t)subghz_protocol_sheriff_cfm_const.te_short);
instance->encoder.upload[index++] =
level_duration_make(false, (uint32_t)subghz_protocol_sheriff_cfm_const.te_short);
}
instance->encoder.upload[index++] =
level_duration_make(true, (uint32_t)subghz_protocol_sheriff_cfm_const.te_short);
instance->encoder.upload[index++] =
level_duration_make(false, (uint32_t)subghz_protocol_sheriff_cfm_const.te_short * 10);
for(uint8_t i = instance->generic.data_count_bit; i > 0; i--) {
if(bit_read(instance->generic.data, i - 1)) {
instance->encoder.upload[index++] =
level_duration_make(true, (uint32_t)subghz_protocol_sheriff_cfm_const.te_short);
instance->encoder.upload[index++] =
level_duration_make(false, (uint32_t)subghz_protocol_sheriff_cfm_const.te_long);
} else {
instance->encoder.upload[index++] =
level_duration_make(true, (uint32_t)subghz_protocol_sheriff_cfm_const.te_long);
instance->encoder.upload[index++] =
level_duration_make(false, (uint32_t)subghz_protocol_sheriff_cfm_const.te_short);
}
}
instance->encoder.upload[index++] =
level_duration_make(true, (uint32_t)subghz_protocol_sheriff_cfm_const.te_short);
instance->encoder.upload[index++] =
level_duration_make(false, (uint32_t)subghz_protocol_sheriff_cfm_const.te_short * 40);
instance->encoder.size_upload = index;
return true;
}
SubGhzProtocolStatus
subghz_protocol_encoder_sheriff_cfm_deserialize(void* context, FlipperFormat* flipper_format) {
furi_check(context);
SubGhzProtocolEncoderSheriffCfm* instance = context;
SubGhzProtocolStatus ret = SubGhzProtocolStatusError;
do {
ret = subghz_block_generic_deserialize_check_count_bit(
&instance->generic,
flipper_format,
subghz_protocol_sheriff_cfm_const.min_count_bit_for_found);
if(ret != SubGhzProtocolStatusOk) break;
uint32_t model_temp = 0;
if(flipper_format_read_uint32(flipper_format, "Model", &model_temp, 1)) {
instance->model = (SheriffCfmModel)model_temp;
} else {
SheriffCfmModel detected;
uint8_t det_btn;
uint32_t det_serial;
uint16_t det_cnt;
if(cfm_try_decrypt(instance->generic.data, &detected, &det_btn, &det_serial, &det_cnt)) {
instance->model = detected;
instance->generic.btn = det_btn;
instance->generic.serial = det_serial;
instance->generic.cnt = det_cnt;
}
}
if(!flipper_format_read_uint32(
flipper_format, "Repeat", (uint32_t*)&instance->encoder.repeat, 1)) {
instance->encoder.repeat = 3;
}
subghz_custom_btn_set_original(cfm_btn_to_custom(instance->generic.btn));
subghz_custom_btn_set_max(4);
uint8_t selected_btn = cfm_get_btn_code(instance->generic.btn);
if(!subghz_protocol_encoder_sheriff_cfm_get_upload(instance, selected_btn)) {
break;
}
instance->encoder.is_running = true;
instance->encoder.front = 0;
ret = SubGhzProtocolStatusOk;
} while(false);
return ret;
}
void subghz_protocol_encoder_sheriff_cfm_stop(void* context) {
furi_check(context);
SubGhzProtocolEncoderSheriffCfm* instance = context;
instance->encoder.is_running = false;
}
LevelDuration subghz_protocol_encoder_sheriff_cfm_yield(void* context) {
SubGhzProtocolEncoderSheriffCfm* 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_sheriff_cfm_alloc(SubGhzEnvironment* environment) {
UNUSED(environment);
SubGhzProtocolDecoderSheriffCfm* instance = malloc(sizeof(SubGhzProtocolDecoderSheriffCfm));
instance->base.protocol = &subghz_protocol_sheriff_cfm;
instance->generic.protocol_name = instance->base.protocol->name;
return instance;
}
void subghz_protocol_decoder_sheriff_cfm_free(void* context) {
furi_check(context);
SubGhzProtocolDecoderSheriffCfm* instance = context;
free(instance);
}
void subghz_protocol_decoder_sheriff_cfm_reset(void* context) {
furi_check(context);
SubGhzProtocolDecoderSheriffCfm* instance = context;
instance->decoder.parser_step = SheriffCfmDecoderStepReset;
instance->header_count = 0;
}
void subghz_protocol_decoder_sheriff_cfm_feed(void* context, bool level, uint32_t duration) {
furi_check(context);
SubGhzProtocolDecoderSheriffCfm* instance = context;
switch(instance->decoder.parser_step) {
case SheriffCfmDecoderStepReset:
if((level) && DURATION_DIFF(duration, subghz_protocol_sheriff_cfm_const.te_short) <
subghz_protocol_sheriff_cfm_const.te_delta) {
instance->decoder.parser_step = SheriffCfmDecoderStepCheckPreambula;
instance->header_count++;
}
break;
case SheriffCfmDecoderStepCheckPreambula:
if((!level) && (DURATION_DIFF(duration, subghz_protocol_sheriff_cfm_const.te_short) <
subghz_protocol_sheriff_cfm_const.te_delta)) {
instance->decoder.parser_step = SheriffCfmDecoderStepReset;
break;
}
if((instance->header_count > 2) &&
(DURATION_DIFF(duration, subghz_protocol_sheriff_cfm_const.te_short * 10) <
subghz_protocol_sheriff_cfm_const.te_delta * 10)) {
instance->decoder.parser_step = SheriffCfmDecoderStepSaveDuration;
instance->decoder.decode_data = 0;
instance->decoder.decode_count_bit = 0;
} else {
instance->decoder.parser_step = SheriffCfmDecoderStepReset;
instance->header_count = 0;
}
break;
case SheriffCfmDecoderStepSaveDuration:
if(level) {
instance->decoder.te_last = duration;
instance->decoder.parser_step = SheriffCfmDecoderStepCheckDuration;
}
break;
case SheriffCfmDecoderStepCheckDuration:
if(!level) {
if(duration >= ((uint32_t)subghz_protocol_sheriff_cfm_const.te_short * 2 +
subghz_protocol_sheriff_cfm_const.te_delta)) {
instance->decoder.parser_step = SheriffCfmDecoderStepReset;
if((instance->decoder.decode_count_bit >=
subghz_protocol_sheriff_cfm_const.min_count_bit_for_found) &&
(instance->decoder.decode_count_bit <=
subghz_protocol_sheriff_cfm_const.min_count_bit_for_found + 2)) {
SheriffCfmModel model;
uint8_t btn;
uint32_t serial;
uint16_t cnt;
if(cfm_try_decrypt(
instance->decoder.decode_data, &model, &btn, &serial, &cnt)) {
instance->generic.data = instance->decoder.decode_data;
instance->generic.data_count_bit =
subghz_protocol_sheriff_cfm_const.min_count_bit_for_found;
instance->model = model;
instance->generic.btn = btn;
instance->generic.serial = serial;
instance->generic.cnt = cnt;
if(instance->base.callback)
instance->base.callback(&instance->base, instance->base.context);
}
}
instance->decoder.decode_data = 0;
instance->decoder.decode_count_bit = 0;
instance->header_count = 0;
break;
} else if(
(DURATION_DIFF(
instance->decoder.te_last, subghz_protocol_sheriff_cfm_const.te_short) <
subghz_protocol_sheriff_cfm_const.te_delta) &&
(DURATION_DIFF(duration, subghz_protocol_sheriff_cfm_const.te_long) <
subghz_protocol_sheriff_cfm_const.te_delta * 2)) {
if(instance->decoder.decode_count_bit <
subghz_protocol_sheriff_cfm_const.min_count_bit_for_found) {
subghz_protocol_blocks_add_bit(&instance->decoder, 1);
} else {
instance->decoder.decode_count_bit++;
}
instance->decoder.parser_step = SheriffCfmDecoderStepSaveDuration;
} else if(
(DURATION_DIFF(
instance->decoder.te_last, subghz_protocol_sheriff_cfm_const.te_long) <
subghz_protocol_sheriff_cfm_const.te_delta * 2) &&
(DURATION_DIFF(duration, subghz_protocol_sheriff_cfm_const.te_short) <
subghz_protocol_sheriff_cfm_const.te_delta)) {
if(instance->decoder.decode_count_bit <
subghz_protocol_sheriff_cfm_const.min_count_bit_for_found) {
subghz_protocol_blocks_add_bit(&instance->decoder, 0);
} else {
instance->decoder.decode_count_bit++;
}
instance->decoder.parser_step = SheriffCfmDecoderStepSaveDuration;
} else {
instance->decoder.parser_step = SheriffCfmDecoderStepReset;
instance->header_count = 0;
}
} else {
instance->decoder.parser_step = SheriffCfmDecoderStepReset;
instance->header_count = 0;
}
break;
}
}
uint8_t subghz_protocol_decoder_sheriff_cfm_get_hash_data(void* context) {
furi_check(context);
SubGhzProtocolDecoderSheriffCfm* instance = context;
return subghz_protocol_blocks_get_hash_data(
&instance->decoder, (instance->decoder.decode_count_bit / 8) + 1);
}
SubGhzProtocolStatus subghz_protocol_decoder_sheriff_cfm_serialize(
void* context,
FlipperFormat* flipper_format,
SubGhzRadioPreset* preset) {
furi_check(context);
SubGhzProtocolDecoderSheriffCfm* instance = context;
SubGhzProtocolStatus ret =
subghz_block_generic_serialize(&instance->generic, flipper_format, preset);
if(ret == SubGhzProtocolStatusOk) {
uint32_t model = (uint32_t)instance->model;
flipper_format_insert_or_update_uint32(flipper_format, "Model", &model, 1);
}
return ret;
}
SubGhzProtocolStatus
subghz_protocol_decoder_sheriff_cfm_deserialize(void* context, FlipperFormat* flipper_format) {
furi_check(context);
SubGhzProtocolDecoderSheriffCfm* instance = context;
SubGhzProtocolStatus ret = SubGhzProtocolStatusError;
do {
ret = subghz_block_generic_deserialize_check_count_bit(
&instance->generic,
flipper_format,
subghz_protocol_sheriff_cfm_const.min_count_bit_for_found);
if(ret != SubGhzProtocolStatusOk) break;
uint32_t model_temp = 0;
if(flipper_format_read_uint32(flipper_format, "Model", &model_temp, 1)) {
instance->model = (SheriffCfmModel)model_temp;
}
SheriffCfmModel detected;
uint8_t btn;
uint32_t serial;
uint16_t cnt;
if(cfm_try_decrypt(instance->generic.data, &detected, &btn, &serial, &cnt)) {
instance->model = detected;
instance->generic.btn = btn;
instance->generic.serial = serial;
instance->generic.cnt = cnt;
}
} while(false);
return ret;
}
void subghz_protocol_decoder_sheriff_cfm_get_string(void* context, FuriString* output) {
furi_check(context);
SubGhzProtocolDecoderSheriffCfm* instance = context;
subghz_custom_btn_set_original(cfm_btn_to_custom(instance->generic.btn));
subghz_custom_btn_set_max(4);
uint8_t selected_btn = cfm_get_btn_code(instance->generic.btn);
furi_string_cat_printf(
output,
"%s %dbit\r\n"
"Key:0x%lX%08lX\r\n"
"Sn:%08lX Btn:[%s]\r\n"
"Cnt:%04lX Model:%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,
cfm_btn_name(selected_btn),
(uint32_t)instance->generic.cnt,
cfm_model_name(instance->model));
}

View File

@@ -0,0 +1,43 @@
#pragma once
#include <furi.h>
#include <lib/subghz/protocols/base.h>
#include <lib/subghz/types.h>
#include <lib/subghz/blocks/const.h>
#include <lib/subghz/blocks/decoder.h>
#include <lib/subghz/blocks/encoder.h>
#include <lib/subghz/blocks/generic.h>
#include <lib/subghz/blocks/math.h>
#include <flipper_format/flipper_format.h>
#define SUBGHZ_PROTOCOL_SHERIFF_CFM_NAME "Sheriff CFM"
typedef struct SubGhzProtocolDecoderSheriffCfm SubGhzProtocolDecoderSheriffCfm;
typedef struct SubGhzProtocolEncoderSheriffCfm SubGhzProtocolEncoderSheriffCfm;
extern const SubGhzProtocolDecoder subghz_protocol_sheriff_cfm_decoder;
extern const SubGhzProtocolEncoder subghz_protocol_sheriff_cfm_encoder;
extern const SubGhzProtocol subghz_protocol_sheriff_cfm;
void* subghz_protocol_decoder_sheriff_cfm_alloc(SubGhzEnvironment* environment);
void subghz_protocol_decoder_sheriff_cfm_free(void* context);
void subghz_protocol_decoder_sheriff_cfm_reset(void* context);
void subghz_protocol_decoder_sheriff_cfm_feed(void* context, bool level, uint32_t duration);
uint8_t subghz_protocol_decoder_sheriff_cfm_get_hash_data(void* context);
SubGhzProtocolStatus subghz_protocol_decoder_sheriff_cfm_serialize(
void* context,
FlipperFormat* flipper_format,
SubGhzRadioPreset* preset);
SubGhzProtocolStatus
subghz_protocol_decoder_sheriff_cfm_deserialize(void* context, FlipperFormat* flipper_format);
void subghz_protocol_decoder_sheriff_cfm_get_string(void* context, FuriString* output);
void* subghz_protocol_encoder_sheriff_cfm_alloc(SubGhzEnvironment* environment);
void subghz_protocol_encoder_sheriff_cfm_free(void* context);
SubGhzProtocolStatus
subghz_protocol_encoder_sheriff_cfm_deserialize(void* context, FlipperFormat* flipper_format);
void subghz_protocol_encoder_sheriff_cfm_stop(void* context);
LevelDuration subghz_protocol_encoder_sheriff_cfm_yield(void* context);