pelco-d协议数据解析示例

版权声明：本文为迟思堂主人李迟原创文章，如转载请注明，并附带原文超链接地址，谢谢。

前段时间写了有关pelco协议的一些笔记，后来，有个小模块是接收pelco格式的数据，然后解析出是什么命令，于是又写了个简单的解析函数。这个函数没什么技术含量。主要思路：

1、逐字节解析，保证每一字节都处理到；
2、找到0xff，此为命令头；
3、找到命令结束字符，方法是根据pelco命令组装的算法，——其实就是当某一字节的值是前面几个的校验和就结束，有一点要校验和正确但长度不符合pelco标准的情况，比如出现0x01,0x02,0x03，根据校验方法是正确的，但它不是正确的命令，pelco文档有提到命令都是7个字节的，但有的文档的命令多于7字节，于是，统一用7字节或以上为判断。
4、结束，找到了一个命令。

代码如下：

[cpp] view plaincopy print?

1. static void protocol_d(unsigned char* buffer, int len)
2. {
3. unsigned char* tmp = NULL;
4. int cksm = 0;
5. unsigned char ch = 0;
6. int tmp_len = len;
7. int cmd_len = 0;
8. unsigned char* cmd_ptr = NULL;
9. tmp = buffer;
10. while (tmp_len > 0)
11. {
12. while (*tmp != 0xff)
13. {
14. tmp++;
15. tmp_len--;
16. if (tmp_len <= 0)
17. goto end;
18. }
19. cmd_ptr = tmp;
20. // 第一个字节
21. ch = *(++tmp);
22. cksm += ch;
23. cmd_len = 2;
24. tmp_len--;
25. while (tmp_len > 0)
26. {
27. ch = *(++tmp);
28. cmd_len++;
29. tmp_len--;
30. if (ch == cksm && cmd_len >= 7)
31. {
32. dump_cmd(NULL, cmd_ptr, cmd_len);
33. //找到了命令，就可以做其它事情了。
34. cksm = 0;
35. break;
36. }
37. cksm += ch;
38. cksm %= 0x100;
39. }
40. end:
41. ;
42. }
43. }

static void protocol_d(unsigned char* buffer, int len)
{unsigned char* tmp = NULL;int cksm = 0;unsigned char ch = 0;int tmp_len = len;int cmd_len = 0;unsigned char* cmd_ptr = NULL;tmp = buffer;while (tmp_len > 0){while (*tmp != 0xff){tmp++;tmp_len--;if (tmp_len <= 0)goto end;}cmd_ptr = tmp; // 第一个字节ch = *(++tmp);cksm += ch;cmd_len = 2;tmp_len--;while (tmp_len > 0){ch = *(++tmp);cmd_len++;tmp_len--;if (ch == cksm && cmd_len >= 7){dump_cmd(NULL, cmd_ptr, cmd_len);//找到了命令，就可以做其它事情了。 cksm = 0;break;}cksm += ch;cksm %= 0x100;}end:;}
}

测试代码如下，特意加了些干扰的字符。

[cpp] view plaincopy print?

1. int serial_simple_test()
2. {
3. #define LEN (5*7+2+2+2+3)
4. unsigned char buffer[LEN] = {
5. 0x11, 0x8, 0xff, 0x01, 0x00, 0x08, 0x00, 0x01, 0x0a,
6. 0xff, 0x01, 0x00, 0x08, 0x00, 0x02, 0x0b, 0x9,
7. 0xff, 0x01, 0x00, 0x00, 0x00, 0x00, 0x01,
8. 0xff, 0x01, 0x00, 0x0c, 0x0d, 0x08, 0x22,0x9,
9. 0xff, 0x01, 0x00, 0x01, 0x01, 0x03, 0x6, 0x01, 0x05,
10. };
11. protocol_d(buffer, LEN);
12. return 0;
13. }

int serial_simple_test()
{
#define LEN (5*7+2+2+2+3)unsigned char buffer[LEN] = {0x11, 0x8, 0xff, 0x01, 0x00, 0x08, 0x00, 0x01, 0x0a, 0xff, 0x01, 0x00, 0x08, 0x00, 0x02, 0x0b, 0x9,0xff, 0x01, 0x00, 0x00, 0x00, 0x00, 0x01,0xff, 0x01, 0x00, 0x0c, 0x0d, 0x08, 0x22,0x9,0xff, 0x01, 0x00, 0x01, 0x01, 0x03, 0x6, 0x01, 0x05, };protocol_d(buffer, LEN);return 0;
}

李迟记于2014年8月14日

顶

0

踩

0

我的同类文章