Compare commits
2 Commits
21caf338eb
...
611176bfcf
| Author | SHA1 | Date |
|---|---|---|
 Mentalflow
|
611176bfcf
|
|
|
Mentalflow
|
abbf3fc3cd
|
34
README.md
34
README.md
|
|
@ -1,6 +1,20 @@
|
|||
# ProtocolParser
|
||||
协议解析器
|
||||
# 通讯协议解析
|
||||
<div align="center">
|
||||
<img src="app_source/resources/imgs/icon.png" alt="Logo" style="width:40%; height:auto;">
|
||||
</div>
|
||||
<h1 align="center"> ProtocolParser 协议解析器 V1.0.1</h1>
|
||||
|
||||
## 一、介绍
|
||||
这是一个用于与DKY的THM3682实验箱搭配使用的上位机协议解析器，具体协议如「通讯协议解析」所示，后续功能使用说明待补充。
|
||||
<div align="center">
|
||||
<div align="center">
|
||||
<img src="documents/pictures/home-light.png" alt="主界面（浅色）" style="width:45%; height:auto;">
|
||||
<img src="documents/pictures/home-dark.png" alt="主界面（深色）" style="width:45%; height:auto;">
|
||||
</div>
|
||||
<p align="center"> 主界面（浅色/深色模式） </p>
|
||||
</div>
|
||||
|
||||
## 二、通讯协议解析
|
||||
|
||||
- [通讯协议解析](#通讯协议解析)
|
||||
- [1. 概述](#1-概述)
|
||||
|
|
@ -22,12 +36,12 @@
|
|||
- [5.1.2 void base\_frame\_maker(void \*in\_frame, base\_frame \*out\_frame, u16 dest\_addr,device \*dev,u16 node\_addr=0)](#512-void-base_frame_makervoid-in_frame-base_frame-out_frame-u16-dest_addrdevice-devu16-node_addr0)
|
||||
- [5.1.3 bool base\_frame\_parser(base\_frame \*in\_frame, void \*\*out\_frame, device \*dev)](#513-bool-base_frame_parserbase_frame-in_frame-void-out_frame-device-dev)
|
||||
- [5.1.4 void ssl\_frame\_maker(ssl\_frame \*frame, u8 \*data, int data\_len)](#514-void-ssl_frame_makerssl_frame-frame-u8-data-int-data_len)
|
||||
- [5.1.5 void zigbee\_data\_encrypt(data\_frame \*data, crypto\_zdata\_frame *zdata, bool (* SM4\_encrypt)(u8 \*key\_origin, u32 key\_len, u8 \*in\_origin, u32 in\_len, u8 \*out, u32 \*out\_len),QString en\_key = "")](#515-void-zigbee_data_encryptdata_frame-data-crypto_zdata_frame-zdata-bool--sm4_encryptu8-key_origin-u32-key_len-u8-in_origin-u32-in_len-u8-out-u32-out_lenqstring-en_key--)
|
||||
- [5.1.6 bool zigbee\_data\_dectypt(data\_frame \*data, crypto\_zdata\_frame *zdata,bool (* SM4\_decrypt)(u8 \*key\_origin, u32 key\_len, u8 \*in, u32 in\_len, u8 \*out, u32 \*out\_len),QString en\_key = "")](#516-bool-zigbee_data_dectyptdata_frame-data-crypto_zdata_frame-zdatabool--sm4_decryptu8-key_origin-u32-key_len-u8-in-u32-in_len-u8-out-u32-out_lenqstring-en_key--)
|
||||
- [5.1.5 void zigbee\_data\_encrypt(data\_frame \*data, crypto\_zdata\_frame *zdata, bool (* SM4\_encrypt)(u8 \*key\_origin, u32 key\_len, u8 \*in\_origin, u32 in\_len, u8 \*out, u32 \*out\_len, bool use\_real\_cbc),QString en\_key = "")](#515-void-zigbee_data_encryptdata_frame-data-crypto_zdata_frame-zdata-bool--sm4_encryptu8-key_origin-u32-key_len-u8-in_origin-u32-in_len-u8-out-u32-out_len-bool-use_real_cbcqstring-en_key--)
|
||||
- [5.1.6 bool zigbee\_data\_dectypt(data\_frame \*data, crypto\_zdata\_frame *zdata,bool (* SM4\_decrypt)(u8 \*key\_origin, u32 key\_len, u8 \*in, u32 in\_len, u8 \*out, u32 \*out\_len, bool use\_real\_cbc),QString en\_key = "")](#516-bool-zigbee_data_dectyptdata_frame-data-crypto_zdata_frame-zdatabool--sm4_decryptu8-key_origin-u32-key_len-u8-in-u32-in_len-u8-out-u32-out_len-bool-use_real_cbcqstring-en_key--)
|
||||
- [5.2 协议认证/验证](#52-协议认证验证)
|
||||
- [5.2.1 void HMAC\_identify(device \*self, device \*node, hmac\_frame \*hframe, void (\*sendTonode)(ZigbeeFrame \&data), void (\*SM3\_HMAC)(u8 \*key, int keylen,u8 \*input, int ilen,u8 output\[32\] ))](#521-void-hmac_identifydevice-self-device-node-hmac_frame-hframe-void-sendtonodezigbeeframe-data-void-sm3_hmacu8-key-int-keylenu8-input-int-ilenu8-output32-)
|
||||
- [5.2.1 void HMAC\_identify(device \*self, device \*node, hmac\_frame \*hframe, void (\*sendTonode)(ZigbeeFrame \&data), void (\*SM3\_HMAC)(u8 \*key, int keylen,u8 \*input, int ilen,u8 output\[32\]))](#521-void-hmac_identifydevice-self-device-node-hmac_frame-hframe-void-sendtonodezigbeeframe-data-void-sm3_hmacu8-key-int-keylenu8-input-int-ilenu8-output32)
|
||||
- [5.2.2 bool data\_frame\_verify(data\_frame \*frame)](#522-bool-data_frame_verifydata_frame-frame)
|
||||
- [5.2.3 void HMAC\_changeVerifykey(u8 key\[16\], device\* self, device \*node, void (*sendTonode)(ZigbeeFrame \&data),bool (* SM4\_encrypt)(u8 \*key\_origin, u32 key\_len, u8 \*in\_origin, u32 in\_len, u8 \*out, u32 \*out\_len))](#523-void-hmac_changeverifykeyu8-key16-device-self-device-node-void-sendtonodezigbeeframe-databool--sm4_encryptu8-key_origin-u32-key_len-u8-in_origin-u32-in_len-u8-out-u32-out_len)
|
||||
- [5.2.3 void HMAC\_changeVerifykey(u8 key\[16\], device\* self, device \*node, void (*sendTonode)(ZigbeeFrame \&data),bool (* SM4\_encrypt)(u8 \*key\_origin, u32 key\_len, u8 \*in\_origin, u32 in\_len, u8 \*out, u32 \*out\_len, bool use\_real\_cbc))](#523-void-hmac_changeverifykeyu8-key16-device-self-device-node-void-sendtonodezigbeeframe-databool--sm4_encryptu8-key_origin-u32-key_len-u8-in_origin-u32-in_len-u8-out-u32-out_len-bool-use_real_cbc)
|
||||
- [5.3 工具](#53-工具)
|
||||
- [5.3.1 uint16\_t crc16\_xmodem(const uint8\_t \*buffer, uint32\_t buffer\_length)](#531-uint16_t-crc16_xmodemconst-uint8_t-buffer-uint32_t-buffer_length)
|
||||
- [5.3.2 bool bytecmp(u8 \*a, u8 \*b, u16 length)](#532-bool-bytecmpu8-a-u8-b-u16-length)
|
||||
|
|
@ -214,7 +228,7 @@ sequenceDiagram
|
|||
| in_frame | 输出 | 非对称双向认证包指针，指向需要被打包进非对称双向认证包的数据地址 |
|
||||
| data | 输入 | 数据指针 |
|
||||
| data_len | 输入 | 数据长度 |
|
||||
#### 5.1.5 void zigbee_data_encrypt(data_frame *data, crypto_zdata_frame *zdata, bool (* SM4_encrypt)(u8 *key_origin, u32 key_len, u8 *in_origin, u32 in_len, u8 *out, u32 *out_len),QString en_key = "")
|
||||
#### 5.1.5 void zigbee_data_encrypt(data_frame *data, crypto_zdata_frame *zdata, bool (* SM4_encrypt)(u8 *key_origin, u32 key_len, u8 *in_origin, u32 in_len, u8 *out, u32 *out_len, bool use_real_cbc),QString en_key = "")
|
||||
对数据进行对称加密。
|
||||
| 变量名 | 输入/输出 | 说明 |
|
||||
|:----:|:----:|:----:|
|
||||
|
|
@ -222,7 +236,7 @@ sequenceDiagram
|
|||
| zdata | 输出 | 待填充的对称加密数据包指针 |
|
||||
| SM4_encrypt | 输入 | SM4加密算法函数指针 |
|
||||
| en_key | 输入 | 若不提供密钥，则将使用默认密钥进行加密 |
|
||||
#### 5.1.6 bool zigbee_data_dectypt(data_frame *data, crypto_zdata_frame *zdata,bool (* SM4_decrypt)(u8 *key_origin, u32 key_len, u8 *in, u32 in_len, u8 *out, u32 *out_len),QString en_key = "")
|
||||
#### 5.1.6 bool zigbee_data_dectypt(data_frame *data, crypto_zdata_frame *zdata,bool (* SM4_decrypt)(u8 *key_origin, u32 key_len, u8 *in, u32 in_len, u8 *out, u32 *out_len, bool use_real_cbc),QString en_key = "")
|
||||
对数据进行对称解密，返回`true`代表解密成功，`false`代表解密失败，需要检查输入是否错误。
|
||||
| 变量名 | 输入/输出 | 说明 |
|
||||
|:----:|:----:|:----:|
|
||||
|
|
@ -231,7 +245,7 @@ sequenceDiagram
|
|||
| SM4_decrypt | 输入 | SM4解密算法函数指针 |
|
||||
| en_key | 输入 | 若不提供密钥，则将使用默认密钥进行解密 |
|
||||
### 5.2 协议认证/验证
|
||||
#### 5.2.1 void HMAC_identify(device *self, device *node, hmac_frame *hframe, void (*sendTonode)(ZigbeeFrame &data), void (*SM3_HMAC)(u8 *key, int keylen,u8 *input, int ilen,u8 output[32] ))
|
||||
#### 5.2.1 void HMAC_identify(device *self, device *node, hmac_frame *hframe, void (*sendTonode)(ZigbeeFrame &data), void (*SM3_HMAC)(u8 *key, int keylen,u8 *input, int ilen,u8 output[32]))
|
||||
对接收到的HMAC包进行数据认证。
|
||||
| 变量名 | 输入/输出 | 说明 |
|
||||
|:----:|:----:|:----:|
|
||||
|
|
@ -244,7 +258,7 @@ sequenceDiagram
|
|||
| 变量名 | 输入/输出 | 说明 |
|
||||
|:----:|:----:|:----:|
|
||||
| frame | 输入 | 待检验的数据帧指针 |
|
||||
#### 5.2.3 void HMAC_changeVerifykey(u8 key[16], device* self, device *node, void (*sendTonode)(ZigbeeFrame &data),bool (* SM4_encrypt)(u8 *key_origin, u32 key_len, u8 *in_origin, u32 in_len, u8 *out, u32 *out_len))
|
||||
#### 5.2.3 void HMAC_changeVerifykey(u8 key[16], device* self, device *node, void (*sendTonode)(ZigbeeFrame &data),bool (* SM4_encrypt)(u8 *key_origin, u32 key_len, u8 *in_origin, u32 in_len, u8 *out, u32 *out_len, bool use_real_cbc))
|
||||
发送对称双向认证密钥更换指令包。
|
||||
| 变量名 | 输入/输出 | 说明 |
|
||||
|:----:|:----:|:----:|
|
||||
|
|
|
|||
|
|
@ -61,9 +61,10 @@ ZigbeeFrame DLLN3X::recv(bool non_blocked)
|
|||
bool DLLN3X::send(ZigbeeFrame zf)
|
||||
{
|
||||
bool status = false;
|
||||
if (zf.getSrcPort() < 0x80)
|
||||
uint8_t len = zf.size();
|
||||
if (zf.getSrcPort() < 0x80 || (len + 4) > 63)
|
||||
return false;
|
||||
status = _DSerial->write((char *)zf.data(),zf.size());
|
||||
status = _DSerial->write((char *)zf.data(),len);
|
||||
status = _DSerial->flush();
|
||||
return status;
|
||||
}
|
||||
|
|
@ -71,7 +72,7 @@ bool DLLN3X::send(ZigbeeFrame zf)
|
|||
bool DLLN3X::send_cmd(uint8_t des_port, uint8_t arg, uint8_t* data, uint8_t data_length)
|
||||
{
|
||||
ZigbeeFrame zf(0x80, des_port, 0x0000);
|
||||
if (data_length - 4 > 63 - 1)
|
||||
if (data_length + 4 > 63)
|
||||
return false;
|
||||
zf.append(arg);
|
||||
zf.addData(data, data_length);
|
||||
|
|
|
|||
|
|
@ -24,8 +24,8 @@ public:
|
|||
static void SM2_sign(u8 *pri, u8 *data, u32 datalen, u8 *out);
|
||||
static bool SM2_verify(u8 *pub, u8 *data, u32 data_len, u8 *sig);
|
||||
static void SM3_HMAC(u8 *key, int keylen,u8 *input, int ilen,u8 output[32] );
|
||||
static bool SM4_encrypt(u8 *key_origin, u32 key_len, u8 *in_origin, u32 in_len, u8 *out, u32 *out_len);
|
||||
static bool SM4_decrypt(u8 *key_origin, u32 key_len, u8 *in, u32 in_len, u8 *out, u32 *out_len);
|
||||
static bool SM4_encrypt(u8 *key_origin, u32 key_len, u8 *in_origin, u32 in_len, u8 *out, u32 *out_len, bool use_real_cbc = true);
|
||||
static bool SM4_decrypt(u8 *key_origin, u32 key_len, u8 *in, u32 in_len, u8 *out, u32 *out_len, bool use_real_cbc = true);
|
||||
static uint8_t get_rand();
|
||||
private:
|
||||
Crypto();
|
||||
|
|
|
|||
|
|
@ -22,12 +22,12 @@ public:
|
|||
void (*sendToserver)(ZigbeeFrame &data),
|
||||
void (*SM3_HMAC)(u8 *key, int keylen,u8 *input, int ilen,u8 output[32] ));
|
||||
void HMAC_changeVerifykey(u8 key[16], device* self, device *node, void (*sendTonode)(ZigbeeFrame &data),
|
||||
bool (* SM4_encrypt)(u8 *key_origin, u32 key_len, u8 *in_origin, u32 in_len, u8 *out, u32 *out_len));
|
||||
void zigbee_data_encrypt(data_frame *data, crypto_zdata_frame *zdata,
|
||||
bool (* SM4_encrypt)(u8 *key_origin, u32 key_len, u8 *in_origin, u32 in_len, u8 *out, u32 *out_len),
|
||||
bool (* SM4_encrypt)(u8 *key_origin, u32 key_len, u8 *in_origin, u32 in_len, u8 *out, u32 *out_len, bool use_real_cbc));
|
||||
void zigbee_data_encrypt(uint8_t *data, uint8_t data_len, crypto_zdata_frame *zdata,
|
||||
bool (* SM4_encrypt)(u8 *key_origin, u32 key_len, u8 *in_origin, u32 in_len, u8 *out, u32 *out_len, bool use_real_cbc),
|
||||
QString en_key = "");
|
||||
bool zigbee_data_dectypt(data_frame *data, crypto_zdata_frame *zdata,
|
||||
bool (* SM4_decrypt)(u8 *key_origin, u32 key_len, u8 *in, u32 in_len, u8 *out, u32 *out_len),
|
||||
bool zigbee_data_dectypt(uint8_t *data, uint8_t *data_len, crypto_zdata_frame *zdata,
|
||||
bool (* SM4_decrypt)(u8 *key_origin, u32 key_len, u8 *in, u32 in_len, u8 *out, u32 *out_len, bool use_real_cbc),
|
||||
QString en_key = "");
|
||||
QString hmac_verify_key = "11223344556677888877665544332211";
|
||||
QStringList pre_hmac_verify_key;
|
||||
|
|
|
|||
|
|
@ -183,13 +183,13 @@ typedef struct login_resp
|
|||
}login_resp;
|
||||
|
||||
#define SENSOR_DATA_TYPE 1
|
||||
#define SENSOR_DATA_LENGTN sizeof(double)*4
|
||||
#define SENSOR_DATA_LENGTN sizeof(float)*4
|
||||
typedef struct sensor_data
|
||||
{
|
||||
double ppm;
|
||||
double temp;
|
||||
double humi;
|
||||
double flare;
|
||||
float ppm;
|
||||
float temp;
|
||||
float humi;
|
||||
float flare;
|
||||
}sensor_data;
|
||||
|
||||
#define THRESHOLD_DATA_TYPE 2
|
||||
|
|
|
|||
|
|
@ -373,8 +373,8 @@ RibbonTabBar {
|
|||
}
|
||||
|
||||
let repeat_count = 16
|
||||
let t = `FF 29 ${get_rand_byte()}${get_rand_byte()} 83 23 32 `+
|
||||
`AA AD 23 32 52 48 23 32 01 00 17 00 00 00 AA AA 01 10 00 FF FF `
|
||||
let t = `FF 29 ${get_rand_byte()}${get_rand_byte()} 83 56 56 `+
|
||||
`AA AD 56 56 52 48 23 32 01 00 17 00 00 00 AA AA 01 10 00 FF FF `
|
||||
for (let j=0;j<repeat_count;j++){
|
||||
t+=` ${get_rand_byte()}${get_rand_byte()}`
|
||||
}
|
||||
|
|
|
|||
|
|
@ -163,16 +163,19 @@ void Crypto::SM3_HMAC(u8 *key, int keylen, u8 *input, int ilen, u8 *output)
|
|||
sm3_hmac(key, keylen, input, ilen, output);
|
||||
}
|
||||
|
||||
bool Crypto::SM4_encrypt(u8 *key_origin, u32 key_len, u8 *in_origin, u32 in_len, u8 *out, u32 *out_len)
|
||||
bool Crypto::SM4_encrypt(u8 *key_origin, u32 key_len, u8 *in_origin, u32 in_len, u8 *out, u32 *out_len, bool use_real_cbc)
|
||||
{
|
||||
struct sm4_ctx a;
|
||||
u32 max_len;
|
||||
u8 key[17] = { 0 }, *in = (u8 *)malloc(sizeof(u8) * (in_len + 16 * 2 + 1)); // 为保证C兼容性，不使用智能指针 两个16分别是为首末尾填充留足留足空间，1是冗余量
|
||||
u8 iv[17] = {
|
||||
0x21, 0xBC, 0xC1, 0xEA, 0x0D, 0xB8, 0x54, 0x6D, 0xCE, 0xE4, 0xDB, 0x3C, 0xFA, 0xC1, 0x3C, 0xEF }, fix_len; // 此处为省时才用固定IV，实际上此处IV必须是随机的才可真正保证SM4 CBC模式下加解密的强度
|
||||
for (int i = 0; i < 16; i++)
|
||||
if (use_real_cbc)
|
||||
{
|
||||
iv[i] = Crypto::getInstance()->get_rand(); // 使用随机数IV，如果想节省时间可以注释
|
||||
for (int i = 0; i < 16; i++)
|
||||
{
|
||||
iv[i] = Crypto::getInstance()->get_rand(); // 使用随机数IV，如果想节省时间可以注释
|
||||
}
|
||||
}
|
||||
if (key_len > 16) {
|
||||
free(in);
|
||||
|
|
@ -180,28 +183,31 @@ bool Crypto::SM4_encrypt(u8 *key_origin, u32 key_len, u8 *in_origin, u32 in_len,
|
|||
}
|
||||
fix_len = 16 - key_len;
|
||||
memcpy(key, key_origin, key_len);
|
||||
for (int i = 0; i < 16; i++)
|
||||
if (use_real_cbc)
|
||||
{
|
||||
in[i] = Crypto::getInstance()->get_rand(); // 首填充
|
||||
for (int i = 0; i < 16; i++)
|
||||
{
|
||||
in[i] = Crypto::getInstance()->get_rand(); // 首填充
|
||||
}
|
||||
}
|
||||
memcpy(in + 16, in_origin, in_len);
|
||||
memcpy(in + (use_real_cbc ? 16 : 0), in_origin, in_len);
|
||||
if (key_len < 16) {
|
||||
for (int i = key_len; i < 16; i++) {
|
||||
key[i] = fix_len;
|
||||
}
|
||||
}
|
||||
if (in_len % 16 != 0) {
|
||||
max_len = ceil(in_len / 16.0)* 16 + 16;
|
||||
fix_len = max_len - 16 - in_len;
|
||||
for (u32 i = in_len + 16; i < max_len; i++) {
|
||||
max_len = ceil(in_len / 16.0)* 16 + (use_real_cbc ? 16 : 0);
|
||||
fix_len = max_len - (use_real_cbc ? 16 : 0) - in_len;
|
||||
for (u32 i = in_len + (use_real_cbc ? 16 : 0); i < max_len; i++) {
|
||||
in[i] = fix_len;
|
||||
}
|
||||
in_len = max_len;
|
||||
} else {
|
||||
for (u32 i = in_len + 16; i < in_len + 16 * 2; i++) {
|
||||
for (u32 i = in_len + (use_real_cbc ? 16 : 0); i < in_len + 16 + (use_real_cbc ? 16 : 0); i++) {
|
||||
in[i] = 16;
|
||||
}
|
||||
in_len += 16 * 2;
|
||||
in_len += 16 + (use_real_cbc ? 16 : 0);
|
||||
}
|
||||
*out_len = in_len;
|
||||
sm4_cbc_encrypt(&a, key, iv, in, in_len, out);
|
||||
|
|
@ -209,7 +215,7 @@ bool Crypto::SM4_encrypt(u8 *key_origin, u32 key_len, u8 *in_origin, u32 in_len,
|
|||
return true;
|
||||
}
|
||||
|
||||
bool Crypto::SM4_decrypt(u8 *key_origin, u32 key_len, u8 *in, u32 in_len, u8 *out, u32 *out_len)
|
||||
bool Crypto::SM4_decrypt(u8 *key_origin, u32 key_len, u8 *in, u32 in_len, u8 *out, u32 *out_len, bool use_real_cbc)
|
||||
{
|
||||
struct sm4_ctx b;
|
||||
u32 fix_len;
|
||||
|
|
@ -217,9 +223,12 @@ bool Crypto::SM4_decrypt(u8 *key_origin, u32 key_len, u8 *in, u32 in_len, u8 *ou
|
|||
u8 iv[17] = {
|
||||
0x21, 0xBC, 0xC1, 0xEA, 0x0D, 0xB8, 0x54, 0x6D, 0xCE, 0xE4, 0xDB, 0x3C, 0xFA, 0xC1, 0x3C, 0xEF }; // 此处为省时才用固定IV，实际上此处IV必须是随机的才可真正保证SM4 CBC模式下加解密的强度
|
||||
u8* out_buf = (u8* )malloc(in_len * sizeof(u8)); // 为保证C兼容性，不使用智能指针
|
||||
for (int i = 0; i < 16; i++)
|
||||
if (use_real_cbc)
|
||||
{
|
||||
iv[i] = Crypto::getInstance()->get_rand(); // 使用随机数IV，如果想节省时间可以注释
|
||||
for (int i = 0; i < 16; i++)
|
||||
{
|
||||
iv[i] = Crypto::getInstance()->get_rand(); // 使用随机数IV，如果想节省时间可以注释
|
||||
}
|
||||
}
|
||||
if (key_len > 16) {
|
||||
free(out_buf);
|
||||
|
|
@ -243,8 +252,8 @@ bool Crypto::SM4_decrypt(u8 *key_origin, u32 key_len, u8 *in, u32 in_len, u8 *ou
|
|||
free(out_buf);
|
||||
return false;
|
||||
}
|
||||
*out_len = in_len - fix_len - 16;
|
||||
memcpy(out, out_buf + 16, *out_len);
|
||||
*out_len = in_len - fix_len - (use_real_cbc ? 16 : 0);
|
||||
memcpy(out, out_buf + (use_real_cbc ? 16 : 0), *out_len);
|
||||
free(out_buf);
|
||||
return true;
|
||||
}
|
||||
|
|
|
|||
|
|
@ -159,19 +159,19 @@ bool Protocol::data_frame_verify(data_frame *frame)
|
|||
return true;
|
||||
}
|
||||
|
||||
void Protocol::zigbee_data_encrypt(data_frame *data, crypto_zdata_frame *zdata,
|
||||
bool (* SM4_encrypt)(u8 *key_origin, u32 key_len, u8 *in_origin, u32 in_len, u8 *out, u32 *out_len),
|
||||
void Protocol::zigbee_data_encrypt(uint8_t *data, uint8_t data_len, crypto_zdata_frame *zdata,
|
||||
bool (* SM4_encrypt)(u8 *key_origin, u32 key_len, u8 *in_origin, u32 in_len, u8 *out, u32 *out_len, bool use_real_cbc),
|
||||
QString en_key)
|
||||
{
|
||||
u32 len;
|
||||
zdata->head=CRYPTO_ZDATA_FRAME_HEAD;
|
||||
QByteArray key = QByteArray::fromHex(en_key == "" ? hmac_verify_key.toLatin1() : en_key.toLatin1());
|
||||
SM4_encrypt((u8 *)key.data(), 16, (u8 *)data, data->data_length + DATA_FRAME_PREFIX_LEN, zdata->data,&len);
|
||||
SM4_encrypt((u8 *)key.data(), 16, data, data_len, zdata->data,&len,false);
|
||||
zdata->length = len + CRYPTO_ZDATA_FRAME_PREFIX_LEN;
|
||||
}
|
||||
|
||||
bool Protocol::zigbee_data_dectypt(data_frame *data, crypto_zdata_frame *zdata,
|
||||
bool (* SM4_decrypt)(u8 *key_origin, u32 key_len, u8 *in, u32 in_len, u8 *out, u32 *out_len),
|
||||
bool Protocol::zigbee_data_dectypt(uint8_t *data, uint8_t *data_len, crypto_zdata_frame *zdata,
|
||||
bool (* SM4_decrypt)(u8 *key_origin, u32 key_len, u8 *in, u32 in_len, u8 *out, u32 *out_len, bool use_real_cbc),
|
||||
QString en_key)
|
||||
{
|
||||
int total_len = zdata->length;
|
||||
|
|
@ -179,7 +179,8 @@ bool Protocol::zigbee_data_dectypt(data_frame *data, crypto_zdata_frame *zdata,
|
|||
return false;
|
||||
u32 len, msglen = total_len - CRYPTO_ZDATA_FRAME_PREFIX_LEN;
|
||||
QByteArray key = QByteArray::fromHex(en_key == "" ? hmac_verify_key.toLatin1() : en_key.toLatin1());
|
||||
SM4_decrypt((u8 *)key.data(), 16, zdata->data, msglen, (u8 *)data, &len);
|
||||
SM4_decrypt((u8 *)key.data(), 16, zdata->data, msglen, data, &len,false);
|
||||
*data_len = len;
|
||||
return true;
|
||||
}
|
||||
|
||||
|
|
@ -209,15 +210,12 @@ void Protocol::HMAC_identify(device *self, device *node, hmac_frame *hframe,
|
|||
}
|
||||
|
||||
void Protocol::HMAC_changeVerifykey(u8 key[16], device* self, device *node, void (*sendTonode)(ZigbeeFrame &data),
|
||||
bool (* SM4_encrypt)(u8 *key_origin, u32 key_len, u8 *in_origin, u32 in_len, u8 *out, u32 *out_len))
|
||||
bool (* SM4_encrypt)(u8 *key_origin, u32 key_len, u8 *in_origin, u32 in_len, u8 *out, u32 *out_len, bool use_real_cbc))
|
||||
{
|
||||
ZigbeeFrame zf(0x82,0x82,node->addr);
|
||||
new_data_frame(16) data;
|
||||
memset(&data, 0, sizeof(data));
|
||||
protocal_wrapper((data_frame *)&data, 0, 16, key, 0);
|
||||
new_crypto_zdata_frame(48) zdata;
|
||||
memset(&zdata, 0, sizeof(zdata));
|
||||
zigbee_data_encrypt((data_frame *)&data, (crypto_zdata_frame *)&zdata, SM4_encrypt);
|
||||
zigbee_data_encrypt(key, 16, (crypto_zdata_frame *)&zdata, SM4_encrypt);
|
||||
new_base_frame(48 + BASE_FRAME_PREFIX_LEN) bframe;
|
||||
memset(&bframe, 0, sizeof(bframe));
|
||||
base_frame_maker(&zdata, (base_frame *)&bframe, node->addr, self);
|
||||
|
|
|
|||
|
|
@ -149,12 +149,9 @@ void ZigBeeParser::des_port_parser(zigbee_protocol::ZigbeeFrame &zframe, bool is
|
|||
if (_protocol->bytecmp(hframe->hmac,hmac,32))
|
||||
{
|
||||
zigbee_protocol::ZigbeeFrame zf(0x82,0x82,node->first.addr);
|
||||
new_data_frame(16) dframe;
|
||||
memset(&dframe, 0, sizeof(dframe));
|
||||
_protocol->protocal_wrapper((data_frame *)&dframe, 0, 16, (u8*)latest_key.data(), 0);
|
||||
new_crypto_zdata_frame(sizeof(dframe)) zdata;
|
||||
new_crypto_zdata_frame(32) zdata;
|
||||
memset(&zdata, 0, sizeof(zdata));
|
||||
_protocol->zigbee_data_encrypt((data_frame *)&dframe, (crypto_zdata_frame *)&zdata, Crypto::SM4_encrypt, key_str);
|
||||
_protocol->zigbee_data_encrypt((u8*)latest_key.data(), 16, (crypto_zdata_frame *)&zdata, Crypto::SM4_encrypt, key_str);
|
||||
new_base_frame(sizeof(zdata) + BASE_FRAME_PREFIX_LEN) bframe;
|
||||
memset(&bframe, 0, sizeof(bframe));
|
||||
_protocol->base_frame_maker(&zdata, (base_frame *)&bframe, node->first.addr, &node->second);
|
||||
|
|
@ -223,11 +220,12 @@ void ZigBeeParser::des_port_parser(zigbee_protocol::ZigbeeFrame &zframe, bool is
|
|||
{
|
||||
zigbee_protocol::ZigbeeFrame dzf = zframe;
|
||||
new_data_frame(72) ndata;
|
||||
uint8_t data_len = 0;
|
||||
memset(&ndata,0,sizeof(ndata));
|
||||
if (*(u16 *)frame == CRYPTO_ZDATA_FRAME_HEAD)
|
||||
{
|
||||
czdata = (crypto_zdata_frame*)frame;
|
||||
_protocol->zigbee_data_dectypt((data_frame*)&ndata, czdata, Crypto::SM4_decrypt);
|
||||
_protocol->zigbee_data_dectypt((uint8_t*)&ndata, &data_len, czdata, Crypto::SM4_decrypt);
|
||||
dzf.setData((char*)&ndata,ndata.data_length + DATA_FRAME_PREFIX_LEN);
|
||||
zdata = QByteArray((char *)dzf.data(), dzf.size());
|
||||
object.insert("decrypted_text", QJsonValue(QString(zdata.toHex(' ').toUpper())));
|
||||
|
|
@ -237,7 +235,7 @@ void ZigBeeParser::des_port_parser(zigbee_protocol::ZigbeeFrame &zframe, bool is
|
|||
object.insert("note_text",QJsonValue("收到节点0x"+sender+"发送的数据"));
|
||||
object.insert("recieved", true);
|
||||
object.insert("type","zigbee_recv_data");
|
||||
if (QRandomGenerator::global()->bounded(2) && is_demo)
|
||||
if (QRandomGenerator::global()->bounded(2)!=0 && is_demo)
|
||||
object.insert("decrypted_text", QJsonValue(QString(zdata.toHex(' ').toUpper())));
|
||||
_bus->push_data("zigbee_recv_data_view",object);
|
||||
}
|
||||
|
|
|
|||
Binary file not shown.
|
After Width: | Height: | Size: 962 KiB |
Binary file not shown.
|
After Width: | Height: | Size: 835 KiB |
Loading…
Reference in New Issue