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
| //
// Created by Serrini on 2022/1/6.
//
#include "TLV.h"
TLV::TLV():m_type(0) , m_length(0), m_data(NULL), m_headLen(0), m_skipPtr(NULL), m_skipLength(0){
}
int TLV::ParseTLV(const unsigned char *data, int len) {
if((data == NULL) || (len < 2)){
printf("Check tlv data and len failed\n");
return -1;
}
m_type = data[0];
if(data[1] > 0x7F){
m_length = 0;
if(len > (1 + 1 + (data[1] - 0x80))){
int i = 0;
m_data = (unsigned char*)data + 1 + 1 + (data[1] - 0x80);
for(i = 0; i < (data[1] - 0x80); ++i){
m_length = m_length * 256 + data[1 + 1 + i];
}
m_headLen = 1 + 1 + (data[1] - 0x80);
}else{
printf("Check value length len failed, length len:%d, len:%d\n", (1 + 1 + (data[1] - 0x80)), len);
return -1;
}
}else{
m_headLen = 1 + 1;
m_length = data[1];
m_data = (unsigned char*)data + 1 + 1;
}
if((m_headLen + m_length) > len){
printf("Check value length and package length failed, tlv:%d, package len:%d\n", (m_headLen + m_length), len);
return -1;
}
printf("type:%x, length:%d, head length:%d\n", m_type, m_length, m_headLen);
return 0;
}
void TLV::SkipHead(int len){
m_skipPtr = m_data;
m_skipLength = len - m_headLen;
if(m_skipLength <= 0){
m_skipPtr = NULL;
m_skipLength = 0;
printf("[SkipHead]:Skip head length failed. len:%d, head len:%d\n", len, m_headLen);
}
}
void TLV::SkipTLV(int len){
m_skipPtr = m_data + m_length;
m_skipLength = len - m_headLen - m_length;
if(m_skipLength <= 0){
m_skipPtr = NULL;
m_skipLength = 0;
printf("[SkipTLV]:Skip head length failed. len:%d, head len:%d, value length: %d\n", len, m_headLen, m_length);
}
}
void TLV::Clear(){
m_type = 0;
m_length = 0;
m_data = NULL;
m_headLen = 0;
m_skipLength = 0;
m_skipPtr = NULL;
}
|