mirror of
https://protopirate.net/ProtoPirate/ProtoPirate.git
synced 2026-10-22 15:31:15 +00:00
151 lines
4.5 KiB
C
151 lines
4.5 KiB
C
#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>
|
|
#include <lib/toolbox/manchester_decoder.h>
|
|
|
|
#include <m-array.h>
|
|
|
|
// Extracts bit number n from integer x
|
|
#define bit(x, n) (((x) >> (n)) & 1)
|
|
|
|
// Builds a 5-bit number from five selected bit positions in x
|
|
#define g5(x, a, b, c, d, e) \
|
|
(bit(x, a) + bit(x, b) * 2 + bit(x, c) * 4 + bit(x, d) * 8 + bit(x, e) * 16)
|
|
|
|
struct SubGhzKeystore {
|
|
SubGhzKeyArray_t data;
|
|
const char* mfname;
|
|
uint8_t kl_type;
|
|
};
|
|
|
|
/*
|
|
* Keeloq
|
|
* https://ru.wikipedia.org/wiki/KeeLoq
|
|
* https://phreakerclub.com/forum/showthread.php?t=1094
|
|
*
|
|
*/
|
|
#define KEELOQ_NLF 0x3A5C742E
|
|
|
|
/*
|
|
* KeeLoq learning types
|
|
* https://phreakerclub.com/forum/showthread.php?t=67
|
|
*/
|
|
#define KEELOQ_LEARNING_UNKNOWN 0u
|
|
#define KEELOQ_LEARNING_SIMPLE 1u
|
|
#define KEELOQ_LEARNING_NORMAL 2u
|
|
// #define KEELOQ_LEARNING_SECURE 3u
|
|
#define KEELOQ_LEARNING_MAGIC_XOR_TYPE_1 4u
|
|
// #define KEELOQ_LEARNING_FAAC 5u
|
|
#define KEELOQ_LEARNING_MAGIC_SERIAL_TYPE_1 6u
|
|
#define KEELOQ_LEARNING_MAGIC_SERIAL_TYPE_2 7u
|
|
#define KEELOQ_LEARNING_MAGIC_SERIAL_TYPE_3 8u
|
|
|
|
/**
|
|
* Simple Learning Encrypt
|
|
* @param data - 0xBSSSCCCC, B(4bit) key, S(10bit) serial&0x3FF, C(16bit) counter
|
|
* @param key - manufacture (64bit)
|
|
* @return keeloq encrypt data
|
|
*/
|
|
static inline uint32_t
|
|
subghz_protocol_keeloq_common_encrypt(const uint32_t data, const uint64_t key) {
|
|
uint32_t x = data, r;
|
|
for(r = 0; r < 528; r++)
|
|
x = (x >> 1) ^ ((bit(x, 0) ^ bit(x, 16) ^ (uint32_t)bit(key, r & 63) ^
|
|
bit(KEELOQ_NLF, g5(x, 1, 9, 20, 26, 31)))
|
|
<< 31);
|
|
return x;
|
|
}
|
|
|
|
/**
|
|
* Simple Learning Decrypt
|
|
* @param data - keeloq encrypt data
|
|
* @param key - manufacture (64bit)
|
|
* @return 0xBSSSCCCC, B(4bit) key, S(10bit) serial&0x3FF, C(16bit) counter
|
|
*/
|
|
static inline uint32_t
|
|
subghz_protocol_keeloq_common_decrypt(const uint32_t data, const uint64_t key) {
|
|
uint32_t x = data, r;
|
|
for(r = 0; r < 528; r++)
|
|
x = (x << 1) ^ bit(x, 31) ^ bit(x, 15) ^ (uint32_t)bit(key, (15 - r) & 63) ^
|
|
bit(KEELOQ_NLF, g5(x, 0, 8, 19, 25, 30));
|
|
return x;
|
|
}
|
|
|
|
/**
|
|
* Normal Learning
|
|
* @param data - serial number (28bit)
|
|
* @param key - manufacture (64bit)
|
|
* @return manufacture for this serial number (64bit)
|
|
*/
|
|
static inline uint64_t
|
|
subghz_protocol_keeloq_common_normal_learning(uint32_t data, const uint64_t key) {
|
|
uint32_t k1, k2;
|
|
|
|
data &= 0x0FFFFFFF;
|
|
data |= 0x20000000;
|
|
k1 = subghz_protocol_keeloq_common_decrypt(data, key);
|
|
|
|
data &= 0x0FFFFFFF;
|
|
data |= 0x60000000;
|
|
k2 = subghz_protocol_keeloq_common_decrypt(data, key);
|
|
|
|
return ((uint64_t)k2 << 32) | k1; // key - shifrovanoya
|
|
}
|
|
|
|
/**
|
|
* Magic_xor_type1 Learning
|
|
* @param data - serial number (28bit)
|
|
* @param xor - magic xor (64bit)
|
|
* @return manufacture for this serial number (64bit)
|
|
*/
|
|
static inline uint64_t
|
|
subghz_protocol_keeloq_common_magic_xor_type1_learning(uint32_t data, uint64_t xor) {
|
|
data &= 0x0FFFFFFF;
|
|
return (((uint64_t)data << 32) | data) ^ xor;
|
|
}
|
|
|
|
/** Magic_serial_type1 Learning
|
|
* @param data - serial number (28bit)
|
|
* @param man - magic man (64bit)
|
|
* @return manufacture for this serial number (64bit)
|
|
*/
|
|
static inline uint64_t
|
|
subghz_protocol_keeloq_common_magic_serial_type1_learning(uint32_t data, uint64_t man) {
|
|
return (man & 0xFFFFFFFF) | ((uint64_t)data << 40) |
|
|
((uint64_t)(((data & 0xff) + ((data >> 8) & 0xFF)) & 0xFF) << 32);
|
|
}
|
|
|
|
/** Magic_serial_type2 Learning
|
|
* @param data - btn+serial number (32bit)
|
|
* @param man - magic man (64bit)
|
|
* @return manufacture for this serial number (64bit)
|
|
*/
|
|
static inline uint64_t
|
|
subghz_protocol_keeloq_common_magic_serial_type2_learning(uint32_t data, uint64_t man) {
|
|
uint8_t* p = (uint8_t*)&data;
|
|
uint8_t* m = (uint8_t*)&man;
|
|
m[7] = p[0];
|
|
m[6] = p[1];
|
|
m[5] = p[2];
|
|
m[4] = p[3];
|
|
return man;
|
|
}
|
|
|
|
/** Magic_serial_type3 Learning
|
|
* @param data - btn+serial number (32bit)
|
|
* @param man - magic man (64bit)
|
|
* @return manufacture for this serial number (64bit)
|
|
*/
|
|
static inline uint64_t
|
|
subghz_protocol_keeloq_common_magic_serial_type3_learning(uint32_t data, uint64_t man) {
|
|
return (man & 0xFFFFFFFFFF000000) | (data & 0xFFFFFF);
|
|
}
|