TLV协议（完善+封包+解析）

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
#include<stdio.h>
#include<string.h>
#include<unistd.h> 
#include"crc-itu-t.c"
#include<stdlib.h>

#define TLV_MAX_SIZE    128
#define TLV_MIN_SIZE    6
#define Tag_temper		0x03	//可以使用枚举
#define HEADER         	0xfd
 
int tlv_pack(char *buf, int size, int cmd)
{
         unsigned short      crc16;
         int                 pack_len =  0x02
         /* Only 2 byte value */
 
        if(!buf || size<TLV_MIN_SIZE )
        {
               printf("Invalid input argumentsn");
                return 0;
        }
        /* Packet head */
        buf[0] = HEADER; 
        /* Tag */ 
        buf[1] = Tag_temper;	
        /* Length, this packet total 6 bytes */
        buf[2] = pack_len;
        /* Value */
        buf[3] = 0x0e;		//如果value多的话,可以用for循环
        buf[3] = 0x03;
  		//CRC检验算法网上也比较多,可以直接用就行
        crc16 = crc_itu_t(MAGIC_CRC, buf, 4); //HTLV计算出一个unsigned short类型crc的值
        ushort_to_bytes(&buf[4], crc16);//将16位的crc值(1个字节8个位)转换成两个字节加到HTLV最后变成HTLV CRC的tlv报文
        return pack_len;
}

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
#include<stdio.h>
#include<string.h>
#include<unistd.h> 
#include "tlv_unpack.h"
#include "crc-itu-t.h"
#include "hex_str_to_int.h"

int tlv_unpack(char *r_buf, int size, int cli_fd, char *tlv)
{
    int     i;
    int     len;
    unsigned short   val;
    unsigned short  crc16;
    int data;
    
start_loop:
    int     ofset = 0;   
    //首先判断读取的全部帧当中，是否存在有效数据, 否则传输NAK报文请求重传 
    if (size < MIN_PACK_SIZE)
    {
        printf("Pack too short and get data stream failure: %sn", strerror(errno));
        //写NAK报文给客户端   MAGIC_CRC选定的CRC校验的除数
        crc16 = crc_itu_t(MAGIC_CRC, (unsigned char *)nak_buf, 4);  //获得unsigned short类型校验位, 第一个为除数, 第二个为数组指针, 第三个为校验长度
        ushort_to_bytes(&nak_buf[4], crc16);        //将CRC的2字节的校验值，转化成两个一字节存在unsigned char 当中    

        write(cli_fd, nak_buf, strlen(MIN_PACK_SIZE) );
        return -1;
    }
    //在一个buf中一帧一帧解析TLV，进行读取数据
    for (i=0; i<size; i++)
    {   
        //读到报文头
        if (r_buf[i] == HEARDER)
        {
            //只有帧头和标志位,没有value值 (读到buf的最后了)
            if (size-i < 2)
            {
                printf("remain data too short and read ok.n")
                printf("Wait continue input data.n")

                //这里需要注意, 若将字符串后面的''也读取到了,那么会将目的buf的后面数据全部清除
                memmvoe(r_buf, &r_buf[i], strlen(size-i) );         //数据拷贝到buf首部，等待下一次传输数据，再读取
                crc16 = crc_itu_t(MAGIC_CRC, (unsigned char *)nak_buf, 4);  //获得unsigned short类型校验位
                ushort_to_bytes(&ack_buf[4], crc16);        //将CRC的2字节的校验值，转化成两个一字节存在unsigned char 当中 

                write(cli_fd, ack_buf, strlen(MIN_PACK_SIZE) );
                return  size-i;          //剩余字节数
            }
           
            ofset += i+2; 
            len = r_buf[ofset];
            
            //帧(length)长度错误，直接丢弃该报文段，并发送NAK报文，请求重新发数据
            if ( len < MIN_PACK_SIZE || len > MAX_PACK_SIZE)
            {
                memmove(r_buf, &r_buf[ofset], strlen(size-i-len));
                crc16 = crc_itu_t(MAGIC_CRC, (unsigned char *)nak_buf, 4);  //获得unsigned short类型校验位
                ushort_to_bytes(&nak_buf[4], crc16);        //将CRC的2字节的校验值，转化成两个一字节存在unsigned char 当中  

                write(cli_fd, nak_buf, strlen(MIN_PACK_SIZE) );
                goto start_loop;
            }
            printf("Current TLV data abnormal.n")
            //报文未读完，继续保存到buf,下一次读取
            if (len > size-i)
            {
                memmove(r_buf, &r_buf[ofset], strlen(size-i) );
                printf("TLV packed is accomplish.n");
                printf("Wait next data input.n");
                crc16 = crc_itu_t(MAGIC_CRC, (unsigned char *)nak_buf, 4);  //获得unsigned short类型校验位
                ushort_to_bytes(&ack_buf[4], crc16);        //将CRC的2字节的校验值，转化成两个一字节存在unsigned char 当中 

                write(cli_fd, ack_buf, strlen(MIN_PACK_SIZE) );
                return size-i;              //剩余字节数
            }
            
            //正常读取TLV数据包,需要首先判断CRC检验和是否相同, 不同则直接丢弃该报文段
            crc16 = crc_itu_t(MAGIC_CRC, (unsigned char *)r_buf[i], len);  //获得unsigned short类型校验位
            val = bytes_to_ushort(&r_buf[i+len-2], crc16);        //将CRC的2字节的校验值，转化成两个一字节存在unsigned char 当中 

            //CRC若不相等则检验失败,发送NAK报文请求重传
            if (crc16 != val)
            {
                printf("CRC checkout failure.n");
                memmove(r_buf, &r_buf[i], strlen(len) );
                crc16 = crc_itu_t(MAGIC_CRC, (unsigned char *)nak_buf, 4);  //获得unsigned short类型校验位
                ushort_to_bytes(&nak_buf[4], crc16);        //将CRC的2字节的校验值，转化成两个一字节存在unsigned char 当中 

                write(cli_fd, nak_buf, strlen(MIN_PACK_SIZE) );
                goto start_loop;
            }
            printf("CRC checkout sucessfuly.n");

            //解析成功,将该TLV数据包保存进行处理
            ofset = 0;
            ofset = (i+3);
            if (r_buf[i+1] == Tag_temper)
            {
   				;	//实现自己想要的功能
            }    
            //分析完成一个TLV数据包后,丢弃该包,分析下一个TLV
            printf("Unpack a TLV data accomplish.n");
            memmove(r_buf, &r_buf[i], size-i-len);
            size = size-i-len;  //分析剩余TLV数据

            goto start_loop;
        }//if (r_buf[i] == HEARDER)
    }//for (i=0; i<size; i++)
    
    return 0;
}