mirror of https://github.com/arendst/Tasmota.git
274 lines
8.0 KiB
C++
274 lines
8.0 KiB
C++
/*
|
|
xdrv_36
|
|
|
|
This program is free software: you can redistribute it and/or modify
|
|
it under the terms of the GNU General Public License as published by
|
|
the Free Software Foundation, either version 3 of the License, or
|
|
(at your option) any later version.
|
|
|
|
This program is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
GNU General Public License for more details.
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#ifdef USE_KEELOQ
|
|
|
|
#define XDRV_36 36
|
|
|
|
#include "cc1101.h"
|
|
#include <KeeloqLib.h>
|
|
|
|
#define SYNC_WORD 199
|
|
|
|
#define Lowpulse 400
|
|
#define Highpulse 800
|
|
|
|
#define TX_PORT 4 // Outputport for transmission
|
|
#define RX_PORT 5 // Inputport for reception
|
|
|
|
const char kJaroliftCommands[] PROGMEM = "Keeloq|" // prefix
|
|
"SendRaw|SendButton|Set";
|
|
|
|
void (* const jaroliftCommand[])(void) PROGMEM = {
|
|
&CmndSendRaw, &CmdSendButton, &CmdSet};
|
|
|
|
CC1101 cc1101;
|
|
|
|
struct JAROLIFT_DEVICE {
|
|
int device_key_msb = 0x0; // stores cryptkey MSB
|
|
int device_key_lsb = 0x0; // stores cryptkey LSB
|
|
uint64_t button = 0x0; // 1000=0x8 up, 0100=0x4 stop, 0010=0x2 down, 0001=0x1 learning
|
|
int disc = 0x0100; // 0x0100 for single channel remote
|
|
uint32_t enc = 0x0; // stores the 32Bit encrypted code
|
|
uint64_t pack = 0; // Contains data to send.
|
|
int count = 0;
|
|
uint32_t serial = 0x0;
|
|
} jaroliftDevice;
|
|
|
|
void CmdSet(void)
|
|
{
|
|
if (XdrvMailbox.data_len > 0) {
|
|
if (XdrvMailbox.payload > 0) {
|
|
char *p;
|
|
uint32_t i = 0;
|
|
uint32_t param[4] = { 0 };
|
|
for (char *str = strtok_r(XdrvMailbox.data, ", ", &p); str && i < 4; str = strtok_r(nullptr, ", ", &p)) {
|
|
param[i] = strtoul(str, nullptr, 0);
|
|
i++;
|
|
}
|
|
for (uint32_t i = 0; i < 3; i++) {
|
|
if (param[i] < 1) { param[i] = 1; } // msb, lsb, serial, counter
|
|
}
|
|
DEBUG_DRIVER_LOG(LOG_LEVEL_DEBUG_MORE, PSTR("params: %08x %08x %08x %08x"), param[0], param[1], param[2], param[3]);
|
|
Settings.keeloq_master_msb = param[0];
|
|
Settings.keeloq_master_lsb = param[1];
|
|
Settings.keeloq_serial = param[2];
|
|
Settings.keeloq_count = param[3];
|
|
|
|
jaroliftDevice.serial = param[2];
|
|
jaroliftDevice.count = param[3];
|
|
|
|
GenerateDeviceCryptKey();
|
|
ResponseCmndDone();
|
|
} else {
|
|
DEBUG_DRIVER_LOG(LOG_LEVEL_DEBUG_MORE, PSTR("no payload"));
|
|
}
|
|
} else {
|
|
DEBUG_DRIVER_LOG(LOG_LEVEL_DEBUG_MORE, PSTR("no param"));
|
|
}
|
|
}
|
|
|
|
void GenerateDeviceCryptKey()
|
|
{
|
|
Keeloq k(Settings.keeloq_master_msb, Settings.keeloq_master_lsb);
|
|
jaroliftDevice.device_key_msb = k.decrypt(jaroliftDevice.serial | 0x60000000L);
|
|
jaroliftDevice.device_key_lsb = k.decrypt(jaroliftDevice.serial | 0x20000000L);
|
|
|
|
AddLog_P2(LOG_LEVEL_DEBUG, PSTR("generated device keys: %08x %08x"), jaroliftDevice.device_key_msb, jaroliftDevice.device_key_lsb);
|
|
}
|
|
|
|
void CmdSendButton(void)
|
|
{
|
|
noInterrupts();
|
|
entertx();
|
|
|
|
if (XdrvMailbox.data_len > 0)
|
|
{
|
|
if (XdrvMailbox.payload > 0)
|
|
{
|
|
jaroliftDevice.button = strtoul(XdrvMailbox.data, nullptr, 0);
|
|
DEBUG_DRIVER_LOG(LOG_LEVEL_DEBUG_MORE, PSTR("msb: %08x"), jaroliftDevice.device_key_msb);
|
|
DEBUG_DRIVER_LOG(LOG_LEVEL_DEBUG_MORE, PSTR("lsb: %08x"), jaroliftDevice.device_key_lsb);
|
|
DEBUG_DRIVER_LOG(LOG_LEVEL_DEBUG_MORE, PSTR("serial: %08x"), jaroliftDevice.serial);
|
|
DEBUG_DRIVER_LOG(LOG_LEVEL_DEBUG_MORE, PSTR("disc: %08x"), jaroliftDevice.disc);
|
|
AddLog_P2(LOG_LEVEL_DEBUG, PSTR("KLQ: count: %08x"), jaroliftDevice.count);
|
|
|
|
CreateKeeloqPacket();
|
|
jaroliftDevice.count++;
|
|
Settings.keeloq_count = jaroliftDevice.count;
|
|
|
|
for(int repeat = 0; repeat <= 1; repeat++)
|
|
{
|
|
uint64_t bitsToSend = jaroliftDevice.pack;
|
|
digitalWrite(TX_PORT, LOW);
|
|
delayMicroseconds(1150);
|
|
SendSyncPreamble(13);
|
|
delayMicroseconds(3500);
|
|
for(int i=72; i>0; i--)
|
|
{
|
|
SendBit(bitsToSend & 0x0000000000000001);
|
|
bitsToSend >>= 1;
|
|
}
|
|
DEBUG_DRIVER_LOG(LOG_LEVEL_DEBUG_MORE, PSTR("finished sending bits at %d"), micros());
|
|
|
|
delay(16); // delay in loop context is save for wdt
|
|
}
|
|
}
|
|
}
|
|
|
|
interrupts();
|
|
enterrx();
|
|
|
|
ResponseCmndDone();
|
|
}
|
|
|
|
void SendBit(byte bitToSend)
|
|
{
|
|
if (bitToSend==1)
|
|
{
|
|
digitalWrite(TX_PORT, LOW); // Simple encoding of bit state 1
|
|
delayMicroseconds(Lowpulse);
|
|
digitalWrite(TX_PORT, HIGH);
|
|
delayMicroseconds(Highpulse);
|
|
}
|
|
else
|
|
{
|
|
digitalWrite(TX_PORT, LOW); // Simple encoding of bit state 0
|
|
delayMicroseconds(Highpulse);
|
|
digitalWrite(TX_PORT, HIGH);
|
|
delayMicroseconds(Lowpulse);
|
|
}
|
|
}
|
|
|
|
void CmndSendRaw(void)
|
|
{
|
|
DEBUG_DRIVER_LOG(LOG_LEVEL_DEBUG_MORE, PSTR("cmd send called at %d"), micros());
|
|
noInterrupts();
|
|
entertx();
|
|
for(int repeat = 0; repeat <= 1; repeat++)
|
|
{
|
|
if (XdrvMailbox.data_len > 0)
|
|
{
|
|
digitalWrite(TX_PORT, LOW);
|
|
delayMicroseconds(1150);
|
|
SendSyncPreamble(13);
|
|
delayMicroseconds(3500);
|
|
|
|
for(int i=XdrvMailbox.data_len-1; i>=0; i--)
|
|
{
|
|
SendBit(XdrvMailbox.data[i] == '1');
|
|
}
|
|
DEBUG_DRIVER_LOG(LOG_LEVEL_DEBUG_MORE, PSTR("finished sending bits at %d"), micros());
|
|
|
|
delay(16); // delay in loop context is save for wdt
|
|
}
|
|
interrupts();
|
|
}
|
|
enterrx();
|
|
ResponseCmndDone();
|
|
}
|
|
|
|
void enterrx() {
|
|
unsigned char marcState = 0;
|
|
cc1101.setRxState();
|
|
delay(2);
|
|
unsigned long rx_time = micros();
|
|
while (((marcState = cc1101.readStatusReg(CC1101_MARCSTATE)) & 0x1F) != 0x0D )
|
|
{
|
|
if (micros() - rx_time > 50000) break; // Quit when marcState does not change...
|
|
}
|
|
}
|
|
|
|
void entertx() {
|
|
unsigned char marcState = 0;
|
|
cc1101.setTxState();
|
|
delay(2);
|
|
unsigned long rx_time = micros();
|
|
while (((marcState = cc1101.readStatusReg(CC1101_MARCSTATE)) & 0x1F) != 0x13 && 0x14 && 0x15)
|
|
{
|
|
if (micros() - rx_time > 50000) break; // Quit when marcState does not change...
|
|
}
|
|
}
|
|
|
|
void SendSyncPreamble(int l)
|
|
{
|
|
for (int i = 0; i < l; ++i)
|
|
{
|
|
digitalWrite(TX_PORT, LOW);
|
|
delayMicroseconds(400);
|
|
digitalWrite(TX_PORT, HIGH);
|
|
delayMicroseconds(380);
|
|
}
|
|
}
|
|
|
|
void CreateKeeloqPacket()
|
|
{
|
|
Keeloq k(jaroliftDevice.device_key_msb, jaroliftDevice.device_key_lsb);
|
|
unsigned int result = (jaroliftDevice.disc << 16) | jaroliftDevice.count;
|
|
jaroliftDevice.pack = (uint64_t)0;
|
|
jaroliftDevice.pack |= jaroliftDevice.serial & 0xfffffffL;
|
|
jaroliftDevice.pack |= (jaroliftDevice.button & 0xfL) << 28;
|
|
jaroliftDevice.pack <<= 32;
|
|
|
|
jaroliftDevice.enc = k.encrypt(result);
|
|
jaroliftDevice.pack |= jaroliftDevice.enc;
|
|
|
|
AddLog_P2(LOG_LEVEL_DEBUG_MORE, PSTR("pack high: %08x"), jaroliftDevice.pack>>32);
|
|
AddLog_P2(LOG_LEVEL_DEBUG_MORE, PSTR("pack low: %08x"), jaroliftDevice.pack);
|
|
}
|
|
|
|
void InitKeeloq()
|
|
{
|
|
DEBUG_DRIVER_LOG(LOG_LEVEL_DEBUG_MORE, PSTR("cc1101.init()"));
|
|
delay(100);
|
|
cc1101.init();
|
|
AddLog_P(LOG_LEVEL_DEBUG_MORE, PSTR("CC1101 done."));
|
|
cc1101.setSyncWord(SYNC_WORD, false);
|
|
cc1101.setCarrierFreq(CFREQ_433);
|
|
cc1101.disableAddressCheck();
|
|
|
|
pinMode(TX_PORT, OUTPUT);
|
|
pinMode(RX_PORT, INPUT_PULLUP);
|
|
|
|
jaroliftDevice.serial = Settings.keeloq_serial;
|
|
jaroliftDevice.count = Settings.keeloq_count;
|
|
GenerateDeviceCryptKey();
|
|
}
|
|
|
|
/*********************************************************************************************\
|
|
* Interface
|
|
\*********************************************************************************************/
|
|
bool Xdrv36(uint8_t function)
|
|
{
|
|
bool result = false;
|
|
|
|
switch (function) {
|
|
case FUNC_INIT:
|
|
InitKeeloq();
|
|
DEBUG_DRIVER_LOG(LOG_LEVEL_DEBUG_MORE, PSTR("init done."));
|
|
break;
|
|
case FUNC_COMMAND:
|
|
AddLog_P(LOG_LEVEL_DEBUG_MORE, PSTR("calling command"));
|
|
result = DecodeCommand(kJaroliftCommands, jaroliftCommand);
|
|
break;
|
|
}
|
|
|
|
return result;
|
|
}
|
|
|
|
#endif // USE_KEELOQ
|