466 lines
9.2 KiB
C++
466 lines
9.2 KiB
C++
#include "ShunCom.h"
|
||
/*
|
||
// 重启
|
||
byte const Reset[] = {0xFE,0x01,0x41,0x00,0x00,0x40};
|
||
// 擦除组网配置信息
|
||
byte const EraseNetCfg[]= {0xFE,0x05,0x21,0x09,0x03,0x00,0x00,0x01,0x02,0x2D};
|
||
// 倒数第二字节 00：中心 01：路由 02：终端
|
||
byte const ModeMsg[] = {0xFE,0x05,0x21,0x09,0x87,0x00,0x00,0x01,0x00,0xAB};
|
||
// 倒数 2-6 四个字节表示频道号
|
||
// 频道从11-26 为 0x0000 0001 << channel 然后倒序
|
||
byte const ChannelMsg[] = {0xFE,0x08,0x21,0x09,0x84,0x00,0x00,0x04,
|
||
0x00,0x08,0x00,0x00, // 频道
|
||
0xA8};
|
||
// Panid
|
||
byte const PanidMsg[] = {0xFE,0x06,0x21,0x09,0x83,0x00,0x00,0x02,
|
||
0x34,0x12, // Panid
|
||
0x89};
|
||
// 短地址
|
||
byte const ShortidMsg[] = {0xFE,0x06,0x21,0x09,0x11,0x04,0x00,0x02,
|
||
0x34,0x12, // ID
|
||
0x1F};
|
||
// 扩展Panid
|
||
byte const PanidExMsg[] = {0xFE,0x0C,0x21,0x09,0x47,0x00,0x00,0x08,
|
||
0xEF,0xCD,0xAB,0x89,0x67,0x45,0x23,0x01, // ID
|
||
0x6B};
|
||
// 工作模式
|
||
byte const WorkModeMsg[]= {0xFE,0x05,0x21,0x09,0x16,0x04,0x00,0x01,
|
||
0xFF, // Mode
|
||
0xC1};
|
||
|
||
// *********以下透传模式有效*********
|
||
// 修改发送模式
|
||
byte const WorkModeMsg2[]= {0xFE,0x05,0x21,0x09,0x03,0x04,0x00,0x01,
|
||
0x00, // Mode
|
||
0x2B};
|
||
|
||
*/
|
||
|
||
class ShunComMessage
|
||
{
|
||
public:
|
||
byte Frame; // 帧头
|
||
byte Length; // 数据长度
|
||
ushort Code; // 操作码
|
||
ushort Kind; // 操类型
|
||
ushort Size; // 负载数据长度
|
||
byte Data[64]; // 负载数据部分
|
||
byte Checksum; // 校验和、从数据长度到负载数据尾
|
||
|
||
const int HEADERSIZE = 1 + 1 + 2 + 2 + 2;
|
||
|
||
public:
|
||
ShunComMessage(ushort code = 0);
|
||
|
||
bool Read(Stream& ms);
|
||
void Write(Stream& ms) const;
|
||
ByteArray ToArray() const;
|
||
ByteArray ToArray(Stream& ms);
|
||
void Set(ushort kind, const Buffer& bs);
|
||
void Set(ushort kind, byte dat);
|
||
void Set(ushort kind, ushort dat);
|
||
void Set(ushort kind, uint dat);
|
||
|
||
// 验证消息校验码是否有效
|
||
//bool Valid();
|
||
// 显示消息内容
|
||
//void Show() const;
|
||
};
|
||
|
||
ShunCom::ShunCom()
|
||
{
|
||
Led = nullptr;
|
||
ExternalCfg = nullptr;
|
||
}
|
||
|
||
void ShunCom::Init(ITransport* port, Pin rst)
|
||
{
|
||
assert(port, "port");
|
||
|
||
Set(port);
|
||
//MaxSize = 82;
|
||
MaxSize = 64;
|
||
AddrLength = 0;
|
||
|
||
if(rst != P0) Reset.Init(rst, true);
|
||
}
|
||
|
||
bool ShunCom::OnOpen()
|
||
{
|
||
if(ExternalCfg)ExternalCfg(this);
|
||
|
||
debug_printf("\r\nShunCom::Open \r\n");
|
||
|
||
debug_printf(" Sleep : ");
|
||
Sleep.Open();
|
||
debug_printf(" Config: ");
|
||
Config.Open();
|
||
debug_printf(" Reset : ");
|
||
Reset.Open();
|
||
debug_printf(" Power : ");
|
||
Power.Open();
|
||
|
||
Power = true;
|
||
Sleep = false;
|
||
Config = false;
|
||
Reset = false;
|
||
|
||
//debug_printf("Power=%d Sleep=%d Config=%d Reset=%d MinSize=%d\r\n", Power.Read(), Sleep.Read(), Config.Read(), Reset.Read(), MinSize);
|
||
|
||
Port->MinSize = MinSize;
|
||
|
||
return PackPort::OnOpen();
|
||
}
|
||
|
||
void ShunCom::OnClose()
|
||
{
|
||
Power = false;
|
||
Reset = true;
|
||
|
||
Power.Close();
|
||
Sleep.Close();
|
||
Config.Close();
|
||
|
||
Reset.Close();
|
||
|
||
PackPort::OnClose();
|
||
}
|
||
|
||
// 模块进入低功耗模式时需要处理的事情
|
||
void ShunCom::ChangePower(int level)
|
||
{
|
||
//Power = false;
|
||
|
||
Sleep = true;
|
||
Config = false;
|
||
|
||
Reset = true;
|
||
|
||
//Power* pwr = dynamic_cast<Power*>(Port);
|
||
//if(pwr) pwr->ChangePower(level);
|
||
PackPort::OnClose();
|
||
}
|
||
|
||
// 引发数据到达事件
|
||
uint ShunCom::OnReceive(Buffer& bs, void* param)
|
||
{
|
||
if(Led) Led->Write(1000);
|
||
|
||
//debug_printf("zigbee接收\r\n");
|
||
//bs.Show(true);
|
||
|
||
if(!AddrLength)
|
||
return ITransport::OnReceive(bs, param);
|
||
|
||
// 取出地址
|
||
byte* addr = bs.GetBuffer();
|
||
Buffer bs2(addr + AddrLength, bs.Length() - AddrLength);
|
||
//debug_printf("zigbee接收\r\n");
|
||
//bs2.Show(true);
|
||
|
||
return ITransport::OnReceive(bs2, addr);
|
||
}
|
||
|
||
bool ShunCom::OnWriteEx(const Buffer& bs, const void* opt)
|
||
{
|
||
//debug_printf("zigbee发送\r\n");
|
||
//bs.Show(true);
|
||
|
||
if(!AddrLength || !opt) return OnWrite(bs);
|
||
// 加入地址
|
||
ByteArray bs2;
|
||
bs2.Copy(0, opt, AddrLength);
|
||
//debug_printf("zigbee发送\r\n");
|
||
//bs2.Show();
|
||
|
||
bs2.Copy(AddrLength, bs, 0, -1);
|
||
bs2.Show();
|
||
return OnWrite(bs2);
|
||
}
|
||
|
||
// 进入配置模式
|
||
bool ShunCom::EnterConfig()
|
||
{
|
||
if(!Open()) return false;
|
||
|
||
Sys.Sleep(2000);
|
||
|
||
Config = true;
|
||
Sys.Sleep(1000);
|
||
Config = false;
|
||
|
||
ByteArray rs1;
|
||
|
||
// 清空串口缓冲区
|
||
while(true)
|
||
{
|
||
ByteArray rs1;
|
||
Read(rs1);
|
||
if(rs1.Length() == 0) break;
|
||
}
|
||
|
||
Sys.Sleep(1000);
|
||
return true;
|
||
}
|
||
|
||
// 退出配置模式
|
||
void ShunCom::ExitConfig()
|
||
{
|
||
if(!Open()) return;
|
||
|
||
ShunComMessage msg(0x0041);
|
||
msg.Length = 1;
|
||
msg.Data[0] = 0x00;
|
||
|
||
MemoryStream ms;
|
||
auto buf = msg.ToArray(ms);
|
||
//debug_printf("ShunComs重启生效\r\n");
|
||
//buf.Show();
|
||
Write(buf);
|
||
// debug_printf("\r\n");
|
||
|
||
}
|
||
void ShunCom::PrintSrc(bool flag)
|
||
{
|
||
ShunComMessage msg(0x0921);
|
||
if(flag)
|
||
{
|
||
msg.Set(0x040E,(byte)2);
|
||
}
|
||
else
|
||
{
|
||
msg.Set(0x040E,(byte)1);
|
||
}
|
||
MemoryStream ms;
|
||
auto buf = msg.ToArray(ms);
|
||
//debug_printf("ShunCom设置源地址\r\n");
|
||
//buf.Show();
|
||
Write(buf);
|
||
// debug_printf("\r\n");
|
||
|
||
}
|
||
|
||
void ShunCom::EraConfig()
|
||
{
|
||
if(!Open()) return;
|
||
|
||
ShunComMessage msg(0x0921);
|
||
msg.Set(0x0003,(byte)02);
|
||
|
||
MemoryStream ms;
|
||
auto buf = msg.ToArray(ms);
|
||
//debug_printf("ShunCom擦除组网信息\r\n");
|
||
buf.Show();
|
||
//Write(buf);
|
||
//debug_printf("\r\n");
|
||
}
|
||
|
||
// 读取配置信息
|
||
void ShunCom::ShowConfig()
|
||
{
|
||
if(!Open()) return;
|
||
|
||
ShunComMessage msg(0x1521);
|
||
|
||
MemoryStream ms;
|
||
auto buf = msg.ToArray(ms);
|
||
buf.Show();
|
||
Write(buf);
|
||
|
||
Sys.Sleep(300);
|
||
|
||
ByteArray bs;
|
||
Read(bs);
|
||
debug_printf("ShunCom配置信息\r\n");
|
||
bs.Show(true);
|
||
}
|
||
|
||
// 设置设备的类型：00代表中心、01代表路由，02代表终端
|
||
void ShunCom::SetDevice(byte kind)
|
||
{
|
||
ShunComMessage msg(0x0921);
|
||
msg.Set(0x0087, kind);
|
||
MemoryStream ms;
|
||
auto buf = msg.ToArray(ms);
|
||
//debug_printf("ShunCom配置设备类型\r\n");
|
||
//buf.Show();
|
||
Write(buf);
|
||
// debug_printf("\r\n");
|
||
}
|
||
|
||
// 设置无线频点，注意大小端，ShunCom是小端存储
|
||
void ShunCom::SetChannel(byte chn)
|
||
{
|
||
ShunComMessage msg(0x0921);
|
||
//todo 这里需要查资料核对左移公式
|
||
msg.Set(0x0084, (uint)(0x01 << chn));
|
||
|
||
MemoryStream ms;
|
||
auto buf=msg.ToArray(ms);
|
||
//debug_printf("ShunCom配置无线频点\r\n");
|
||
//buf.Show();
|
||
Write(buf);
|
||
// debug_printf("\r\n");
|
||
}
|
||
|
||
// 进入配置PanID,同一网络PanID必须相同
|
||
void ShunCom::SetPanID(ushort id)
|
||
{
|
||
ShunComMessage msg(0x0921);
|
||
msg.Set(0x0083, id);
|
||
|
||
MemoryStream ms;
|
||
auto buf = msg.ToArray(ms);
|
||
//debug_printf("ShunCom配置PanID\r\n");
|
||
//buf.Show();
|
||
Write(buf);
|
||
// debug_printf("\r\n");
|
||
}
|
||
|
||
// 设置发送模式00为广播、01为主从模式、02为点对点模式
|
||
void ShunCom::SetSend(byte mode)
|
||
{
|
||
ShunComMessage msg(0x0921);
|
||
msg.Set(0x0403, mode);
|
||
|
||
MemoryStream ms;
|
||
auto buf = msg.ToArray(ms);
|
||
//debug_printf("ShunCom配置设备主从模式\r\n");
|
||
//buf.Show();
|
||
Write(buf);
|
||
// debug_printf("\r\n");
|
||
}
|
||
//还原zigBee默认配置
|
||
void ShunCom::ShunComReset()
|
||
{
|
||
EnterConfig();
|
||
ShowConfig();
|
||
|
||
SetDevice(01);
|
||
SetChannel(0x0F);
|
||
SetPanID(0x6666);
|
||
PrintSrc(false);
|
||
EraConfig();
|
||
ExitConfig();
|
||
}
|
||
ShunComMessage::ShunComMessage(ushort code)
|
||
{
|
||
Frame = 0xFE;
|
||
Code = code;
|
||
Length = 0;
|
||
}
|
||
|
||
bool ShunComMessage::Read(Stream& ms)
|
||
{
|
||
byte magic = ms.ReadByte();
|
||
if(magic != 0xFE) return false;
|
||
|
||
Frame = magic;
|
||
Length = ms.ReadByte();
|
||
Code = ms.ReadUInt16();
|
||
|
||
Buffer bs(Data, sizeof(Data));
|
||
if(Length > 4)
|
||
{
|
||
Kind = ms.ReadUInt16();
|
||
Size = _REV16(ms.ReadUInt16());
|
||
assert(2 + 2 + Size == Length, "ShunComMessage::Read");
|
||
//ms.Read(Data, 0, Size);
|
||
bs.SetLength(Size);
|
||
}
|
||
else if(Length > 0)
|
||
{
|
||
//ms.Read(Data, 0, Length);
|
||
bs.SetLength(Length);
|
||
}
|
||
ms.Read(bs);
|
||
// 不做校验检查，不是很重要
|
||
Checksum = ms.ReadByte();
|
||
|
||
return true;
|
||
}
|
||
|
||
void ShunComMessage::Write(Stream& ms) const
|
||
{
|
||
byte* p = ms.Current();
|
||
ms.Write(Frame);
|
||
ms.Write(Length);
|
||
ms.Write(Code);
|
||
|
||
Buffer bs((void*)Data, sizeof(Data));
|
||
if(Length > 4)
|
||
{
|
||
ms.Write(Kind);
|
||
ms.Write((ushort)_REV16(Size));
|
||
//ms.Write(Data, 0, Size);
|
||
bs.SetLength(Size);
|
||
}
|
||
else if(Length > 0)
|
||
{
|
||
//ms.Write(Data, 0, Length);
|
||
bs.SetLength(Length);
|
||
}
|
||
ms.Write(bs);
|
||
//ms.Write(Checksum);
|
||
// 计算校验
|
||
byte sum = 0;
|
||
while(p++ < ms.Current()-1) sum^= *p;
|
||
ms.Write(sum);
|
||
|
||
}
|
||
|
||
ByteArray ShunComMessage::ToArray() const
|
||
{
|
||
//MemoryStream ms;
|
||
// 带有负载数据，需要合并成为一段连续的内存
|
||
ByteArray bs;
|
||
Stream ms(bs.GetBuffer(), 64);
|
||
//ms.SetLength(0);
|
||
Write(ms);
|
||
bs.Show(true);
|
||
|
||
return bs;
|
||
}
|
||
|
||
ByteArray ShunComMessage::ToArray(Stream& ms)
|
||
{
|
||
Write(ms);
|
||
ByteArray bs(ms.GetBuffer(), ms.Position());
|
||
return bs;
|
||
}
|
||
void ShunComMessage::Set(ushort kind, const Buffer& bs)
|
||
{
|
||
Kind = kind;
|
||
bs.CopyTo(0, Data, -1);
|
||
|
||
Length = 2 + 2 + bs.Length();
|
||
}
|
||
|
||
void ShunComMessage::Set(ushort kind, byte dat)
|
||
{
|
||
Kind = kind;
|
||
Data[0] = dat;
|
||
Size = 1;
|
||
Length = 2 + 2 + Size;
|
||
}
|
||
|
||
void ShunComMessage::Set(ushort kind, ushort dat)
|
||
{
|
||
Kind = kind;
|
||
Data[0] = dat;
|
||
Data[1] = dat >> 8;
|
||
Size = 2;
|
||
Length = 2 + 2 + Size;
|
||
}
|
||
|
||
void ShunComMessage::Set(ushort kind, uint dat)
|
||
{
|
||
Kind = kind;
|
||
Data[0] = dat;
|
||
Data[1] = dat >> 8;
|
||
Data[2] = dat >> 16;
|
||
Data[3] = dat >> 24;
|
||
Size = 4;
|
||
Length = 2 + 2 + Size;
|
||
}
|