当前位置: 首页 > 我的程序代码 > 正文

pelco-d协议数据解析示例

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

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

代码如下:

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:
        ;
    }
}

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

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日

本文固定链接: http://www.latelee.org/my-library/parse-pelco-d-data.html

如无特别说明,迟思堂工作室文章均为原创,转载请注明: pelco-d协议数据解析示例 | 迟思堂工作室

目前暂无评论

发表评论

*

快捷键:Ctrl+Enter