1234567891011121314151617181920212223242526272829303132 |
- /********************** 头文件 *************************/
- #include "bsp_protocol.h"
- /********************** 变量区 *************************/
- /********************** 函数声明区 *************************/
- void send_protocol(uint8_t index,uint8_t cmd,uint8_t* dat,uint8_t datLen)
- {
- uint8_t buf[128];
- uint16_t Len = datLen+5;
- uint16_t L=0;
- uint8_t i;
- uint8_t ver = 0;
-
- if(Len>128) return;
-
- buf[L++] = 0xAA; ver += 0xAA; //帧头
- // buf[L++] = 0xBB; ver += 0xBB; //帧头
- // buf[L++] = 0xCC; ver += 0xCC; //帧头
- buf[L++] = Len; ver += Len; //长度
- buf[L++] = ~Len; ver += (~Len);//长度反码
- // buf[L++] = index; ver += index; //设备号
- buf[L++] = cmd; ver += cmd; //命令
- for(i=0;i<datLen;i++){ buf[L++] = dat[i]; ver += dat[i];} //数据
- buf[L++] = ver; //校验
-
- ESB_SendBuff(buf,L); //发送出去
- }
|