单片机接收数据帧帧头帧尾校验数据解析

转自：http://blog.csdn.net/xr528787067/article/details/52822377

前阵子一朋友使用单片机与某外设进行通信时，外设返回的是一堆格式如下的数据：

[cpp] view plain copy

1. AA AA 04 80 02 00 02 7B AA AA 04 80 02 00 08 75 AA AA 04 80 02 00 9B E2 AA AA 04 80 02 00 F6 87 AA AA 04 80 02 00 EC 91  

其中 AA AA 04 80 02 是数据校验头，后面三位是有效数据，问我怎么从外设不断返回的数据中取出有效的数据。

对于这种问题最容易想到的就是使用一个标志位用于标志当前正解析到一帧数据的第几位，然后判断当前接收的数据是否与校验数据一致，如果一致则将标志位加一，否则将标志位置0重新判断，使用这种方法解析数据的代码如下：

[cpp] view plain copy

1. if(flag == 0)  
2. {  
3.     if(tempData == 0xAA)  
4.         flag++;  
5.     else  
6.         flag = 0;  
7. }  
8. else if(flag == 1)  
9. {  
10.     if(tempData == 0xAA)  
11.         flag++;  
12.     else  
13.         flag = 0;  
14. }  
15. else if(flag == 2)  
16. {  
17.     if(tempData == 0x04)  
18.         flag++;  
19.     else  
20.         flag = 0;  
21. }  
22. else if(flag == 3)  
23. {  
24.     if(tempData == 0x80)  
25.         flag++;  
26.     else  
27.         flag = 0;  
28. }  
29. else if(flag == 4)  
30. {  
31.     if(tempData == 0x02)  
32.         flag++;  
33.     else  
34.         flag = 0;  
35. }  
36. else if(flag == 5 || flag == 6 || flag == 7)  
37. {  
38.     data[flag-5] = tempData;  
39.     flag = (flag == 7) ? 0 : flag+1;  
40. }  

使用上述方法是最容易想到的也是最简单的方法了，百度了一下基本上也都是使用类似的方法进行数据解析，但是使用这种方法有如下几个缺点： 

1、 大量使用了判断，容易导致出现逻辑混乱

2、 代码重复率高，抽象程度低。从上述代码可以看到一大堆代码仅仅是判断的数据不同，其他代码都完全一致

3、 代码可复用性差。写好的代码无法用在其他类似的外设上，如果有多个外设就需要编写多份类似的代码

4、 可扩展性低。如果外设还有一个数据校验尾需要校验或者数据校验头发生改变，就需要再次写多个判断重新用于校验，无法在原有的代码上进行扩展

5、 容易出现误判  

对此，这里提出了一种新的解决方案，可以通用与所有类似的数据解析，原理如下： 

使用一个固定容量的队列用来缓存接收到的数据，队列容量等于一帧数据的大小，每来一个数据就将数据往队列里面加，当完整接收到一帧数据时此时队列中的全部数据也就是一帧完整的数据，因此只需要判断队列是否是数据校验头，队列尾是否是数据校验尾就可以得知当前是否已经接收到了一帧完整的数据，然后在将数据从队列中取出即可。原理图如下：

每来一个数据就往队列里面加：

当接收到一帧完整数据时队列头和数据校验头重合：

此时只需要从队列中取出有效数据即可。

如果有数据尾校验，仅仅只需要添加一个校验尾即可，如下图所示：

好，分析结束，开始编码。

首先需要一个队列，为了保证通用性，队列底层使用类似于双向链表的实现（当然也可以使用数组实现），需要封装的结构有队列容量、队列大小、队头节点和队尾节点，需要实现的操作有队列初始化、数据入队、数据出队、清空队列和释放队列，具体代码如下：

[cpp] view plain copy

1. /* queue.h */  
2.   
3. #ifndef _QUEUE_H_  
4. #define _QUEUE_H_  
5.   
6. #ifndef NULL  
7. #define NULL    ((void *)0)  
8. #endif  
9.   
10. typedef unsigned char uint8;  
11.   
12. /* 队列节点 */  
13. typedef struct Node  
14. {  
15.     uint8 data;  
16.     struct Node *pre_node;  
17.     struct Node *next_node;  
18. } Node;  
19.   
20. /* 队列结构 */  
21. typedef struct Queue  
22. {  
23.     uint8 capacity;     // 队列总容量  
24.     uint8 size;         // 当前队列大小  
25.     Node *front;        // 队列头节点  
26.     Node *back;         // 队列尾节点  
27. } Queue;  
28.   
29. /* 初始化一个队列 */  
30. Queue *init_queue(uint8 _capacity);  
31. /* 数据入队 */  
32. uint8 en_queue(Queue *_queue, uint8 _data);  
33. /* 数据出队 */  
34. uint8 de_queue(Queue *_queue);  
35. /* 清空队列 */  
36. void clear_queue(Queue *_queue);  
37. /* 释放队列 */  
38. void release_queue(Queue *_queue);  
39.   
40. #endif  

[cpp] view plain copy

1. /* queue.c */  
2.   
3. #include <stdlib.h>  
4. #include "parser.h"  
5.   
6. /** 
7.  * 初始化一个队列 
8.  * 
9.  * @_capacity: 队列总容量 
10.  */  
11. Queue *init_queue(uint8 _capacity)  
12. {  
13.     Queue *queue = (Queue *)malloc(sizeof(Queue));  
14.     queue->capacity = _capacity;  
15.     queue->size = 0;  
16.     return queue;  
17. }  
18.   
19. /** 
20.  * 数据入队 
21.  * 
22.  * @_queue: 队列 
23.  * @_data: 数据 
24.  **/  
25. uint8 en_queue(Queue *_queue, uint8 _data)  
26. {  
27.     if(_queue->size < _queue->capacity)  
28.     {  
29.         Node *node = (Node *)malloc(sizeof(Node));  
30.         node->data = _data;  
31.         node->next_node = NULL;  
32.   
33.         if(_queue->size == 0)  
34.         {  
35.             node->pre_node = NULL;  
36.             _queue->back = node;  
37.             _queue->front = _queue->back;  
38.         }  
39.         else  
40.         {  
41.             node->pre_node = _queue->back;  
42.   
43.             _queue->back->next_node = node;  
44.             _queue->back = _queue->back->next_node;  
45.         }  
46.         _queue->size++;  
47.     }  
48.     else  
49.     {  
50.         Node *temp_node = _queue->front->next_node;  
51.         _queue->front->pre_node = _queue->back;  
52.         _queue->back->next_node = _queue->front;  
53.         _queue->back = _queue->back->next_node;  
54.         _queue->back->data = _data;  
55.         _queue->back->next_node = NULL;  
56.         _queue->front = temp_node;  
57.     }  
58.     return _queue->size-1;  
59. }  
60.   
61. /** 
62.  * 数据出队 
63.  * 
64.  * @_queue: 队列 
65.  * 
66.  * @return: 出队的数据 
67.  */  
68. uint8 de_queue(Queue *_queue)  
69. {  
70.     uint8 old_data = 0;  
71.   
72.     if(_queue->size > 0)  
73.     {  
74.         old_data = _queue->front->data;  
75.         if(_queue->size == 1)  
76.         {  
77.             free(_queue->front);  
78.             _queue->front = NULL;  
79.             _queue->back = NULL;  
80.         }  
81.         else  
82.         {  
83.             _queue->front = _queue->front->next_node;  
84.             free(_queue->front->pre_node);  
85.             _queue->front->pre_node = NULL;  
86.         }  
87.         _queue->size--;  
88.     }  
89.     return old_data;  
90. }  
91.   
92. /** 
93.  * 清空队列 
94.  * 
95.  * @_queue: 队列 
96.  */  
97. void clear_queue(Queue *_queue)  
98. {  
99.     while(_queue->size > 0)  
100.     {  
101.         de_queue(_queue);  
102.     }  
103. }  
104.   
105. /** 
106.  * 释放队列 
107.  * 
108.  * @_queue: 队列 
109.  */  
110. void release_queue(Queue *_queue)  
111. {  
112.     clear_queue(_queue);  
113.     free(_queue);  
114.     _queue = NULL;  
115. }  

其次是解析器，需要封装的结构有解析数据队列、数据校验头、数据校验尾、解析结果以及指向解析结果的指针，需要实现的操作有解析器初始化、添加数据解析、获取解析结果、重置解析器和释放解析器，具体代码如下：

[cpp] view plain copy

1. /* parser.h */  
2.   
3. #ifndef _PARSER_H_  
4. #define _PARSER_H_  
5.   
6. #include "queue.h"  
7.   
8. typedef enum  
9. {  
10.     RESULT_FALSE,  
11.     RESULT_TRUE  
12. } ParserResult;  
13.   
14. /* 解析器结构 */  
15. typedef struct DataParser  
16. {  
17.     Queue *parser_queue;            // 数据解析队列  
18.     Node *resule_pointer;           // 解析结果数据指针  
19.     uint8 *data_header;             // 数据校验头指针  
20.     uint8 header_size;              // 数据校验头大小  
21.     uint8 *data_footer;             // 数据校验尾指针  
22.     uint8 footer_size;              // 数据校验尾大小  
23.     uint8 result_size;              // 解析数据大小  
24.     ParserResult parserResult;      // 解析结果  
25. } DataParser;  
26.   
27. /* 初始化一个解析器 */  
28. DataParser *parser_init(uint8 *_data_header, uint8 _header_size, uint8 *_data_footer, uint8 _foot_size, uint8 _data_frame_size);  
29. /* 将数据添加到解析器中进行解析 */  
30. ParserResult parser_put_data(DataParser *_parser, uint8 _data);  
31. /* 解析成功后从解析器中取出解析结果 */  
32. int parser_get_data(DataParser *_parser, uint8 _index);  
33. /* 重置解析器 */  
34. void parser_reset(DataParser *_parser);  
35. /* 释放解析器 */  
36. void parser_release(DataParser *_parser);  
37.   
38. #endif  

[cpp] view plain copy

1. /* parser.c */  
2.   
3. #include <stdlib.h>  
4. #include "parser.h"  
5.   
6. /** 
7.  * 初始化一个解析器 
8.  * 
9.  * @_data_header: 数据头指针 
10.  * @_header_size: 数据头大小 
11.  * @_data_footer: 数据尾指针 
12.  * @_foot_size: 数据尾大小 
13.  * @_data_frame_size: 一帧完整数据的大小 
14.  * 
15.  * @return: 解析器 
16.  */  
17. DataParser *parser_init(uint8 *_data_header, uint8 _header_size, uint8 *_data_footer, uint8 _foot_size, uint8 _data_frame_size)  
18. {  
19.     if((_header_size+_foot_size) > _data_frame_size || (_header_size+_foot_size) == 0)  
20.         return NULL;  
21.   
22.     DataParser *parser = (DataParser *)malloc(sizeof(DataParser));  
23.     parser->parser_queue = init_queue(_data_frame_size);  
24.     parser->resule_pointer = NULL;  
25.     parser->data_header = _data_header;  
26.     parser->header_size = _header_size;  
27.     parser->data_footer = _data_footer;  
28.     parser->footer_size = _foot_size;  
29.     parser->result_size = _data_frame_size - parser->header_size - parser->footer_size;  
30.     parser->parserResult = RESULT_FALSE;  
31.   
32.     while(_data_frame_size-- > 0)  
33.     {  
34.         en_queue(parser->parser_queue, 0);  
35.     }  
36.   
37.     return parser;  
38. }  
39.   
40. /** 
41.  * 将数据添加到解析器中进行解析 
42.  * 
43.  * @_parser: 解析器 
44.  * @_data: 要解析的数据 
45.  * 
46.  * @return: 当前解析结果，返回 RESULT_TRUE 代表成功解析出一帧数据 
47.  */  
48. ParserResult parser_put_data(DataParser *_parser, uint8 _data)  
49. {  
50.     uint8 i;  
51.     Node *node;  
52.   
53.     if(_parser == NULL)  
54.         return RESULT_FALSE;  
55.   
56.     en_queue(_parser->parser_queue, _data);  
57.   
58.     /* 校验数据尾 */  
59.     node = _parser->parser_queue->back;  
60.     for(i = _parser->footer_size; i > 0; i--)  
61.     {  
62.         if(node->data != _parser->data_footer[i-1])  
63.             goto DATA_FRAME_FALSE;  
64.         node = node->pre_node;  
65.     }  
66.   
67.     /* 校验数据头 */  
68.     node = _parser->parser_queue->front;  
69.     for(i = 0; i < _parser->header_size; i++)  
70.     {  
71.         if(node->data != _parser->data_header[i])  
72.             goto DATA_FRAME_FALSE;  
73.         node = node->next_node;  
74.     }  
75.   
76.     if(_parser->resule_pointer == NULL && _parser->result_size > 0)  
77.         _parser->resule_pointer = node;  
78.     if(_parser->parserResult != RESULT_TRUE)  
79.         _parser->parserResult = RESULT_TRUE;  
80.     return _parser->parserResult;  
81.   
82. DATA_FRAME_FALSE:  
83.     if(_parser->resule_pointer != NULL)  
84.         _parser->resule_pointer = NULL;  
85.     if(_parser->parserResult != RESULT_FALSE)  
86.         _parser->parserResult = RESULT_FALSE;  
87.     return _parser->parserResult;  
88.   
89. }  
90.   
91. /** 
92.  * 解析成功后从解析器中取出解析结果 
93.  * 
94.  * @_parser: 解析器 
95.  * @_index: 解析结果集合中的第 _index 个数据 
96.  * 
97.  * @return: 获取解析成功的数据，返回 -1 代表数据获取失败 
98.  */  
99. int parser_get_data(DataParser *_parser, uint8 _index)  
100. {  
101.     Node *node;  
102.     if(_parser == NULL  
103.     || _parser->parserResult != RESULT_TRUE  
104.     || _index >= _parser->result_size  
105.     || _parser->resule_pointer == NULL)  
106.         return -1;  
107.     node = _parser->resule_pointer;  
108.     while(_index > 0)  
109.     {  
110.         node = node->next_node;  
111.         _index--;  
112.     }  
113.     return node->data;  
114. }  
115.   
116. /** 
117.  * 重置解析器 
118.  * 
119.  * @_parser: 解析器 
120.  */  
121. void parser_reset(DataParser *_parser)  
122. {  
123.     uint8 _data_frame_size;  
124.   
125.     if(_parser == NULL)  
126.         return;  
127.   
128.     _data_frame_size = _parser->parser_queue->size;  
129.     while(_data_frame_size-- > 0)  
130.     {  
131.         en_queue(_parser->parser_queue, 0);  
132.     }  
133.     _parser->resule_pointer = NULL;  
134.     _parser->parserResult = RESULT_FALSE;  
135. }  
136.   
137. /** 
138.  * 释放解析器 
139.  * 
140.  * @_parser: 解析器 
141.  */  
142. void parser_release(DataParser *_parser)  
143. {  
144.     if(_parser == NULL)  
145.         return;  
146.     release_queue(_parser->parser_queue);  
147.     free(_parser);  
148.     _parser = NULL;  
149. }  

接下来编写测试代码测试一下：

[cpp] view plain copy

1. /* main.c */  
2.   
3. #include <stdio.h>  
4. #include "parser.h"  
5.   
6. int main()  
7. {  
8.     uint8 i;  
9.     // 数据头  
10.     uint8 data_header[] = {0xAA, 0xAA, 0x04, 0x80, 0x02};  
11.     // 要解析的数据，测试用  
12.     uint8 data[] = {  
13.         0xAA, 0xAA, 0x04, 0x80, 0x02, 0x00, 0x02, 0x7B, 0xAA, 0xAA, 0x04, 0x80,  
14.         0x02, 0x00, 0x08, 0x75, 0xAA, 0xAA, 0x04, 0x80, 0x02, 0x00, 0x9B, 0xE2,  
15.         0xAA, 0xAA, 0x04, 0x80, 0x02, 0x00, 0xF6, 0x87, 0xAA, 0xAA, 0x04, 0x80,  
16.         0x02, 0x00, 0xEC, 0x91, 0xAA, 0xAA, 0x04, 0x80, 0x02, 0x01, 0x15, 0x67,  
17.         0xAA, 0xAA, 0x04, 0x80, 0x02, 0x01, 0x49, 0x33, 0xAA, 0xAA, 0x04, 0x80,  
18.         0x02, 0x00, 0xE7, 0x96, 0xAA, 0xAA, 0x04, 0x80, 0x02, 0x00, 0x68, 0x15,  
19.         0xAA, 0xAA, 0x04, 0x80, 0x02, 0x00, 0x3C, 0x41, 0xAA, 0xAA, 0x04, 0x80,  
20.         0x02, 0x00, 0x66, 0x17, 0xAA, 0xAA, 0x04, 0x80, 0x02, 0x00, 0xA5, 0xD8,  
21.         0xAA, 0xAA, 0x04, 0x80, 0x02, 0x01, 0x26, 0x56, 0xAA, 0xAA, 0x04, 0x80,  
22.         0x02, 0x01, 0x73, 0x09, 0xAA, 0xAA, 0x04, 0x80, 0x02, 0x01, 0x64, 0x18,  
23.         0xAA, 0xAA, 0x04, 0x80, 0x02, 0x01, 0x8B, 0xF1, 0xAA, 0xAA, 0x04, 0x80,  
24.         0x02, 0x01, 0xC6, 0xB6, 0xAA, 0xAA, 0x04, 0x80, 0x02, 0x01, 0x7B, 0x01,  
25.         0xAA, 0xAA, 0x04, 0x80, 0x02, 0x00, 0xCB, 0xB2, 0xAA, 0xAA, 0x04, 0x80,  
26.         0x02, 0x00, 0x2C, 0x51, 0xAA, 0xAA, 0x04, 0x80, 0x02, 0xFF, 0xE5, 0x99  
27.     };  
28.   
29.     /** 
30.      * 初始化一个解析器 
31.      * 第一个参数是数据头 
32.      * 第二个参数是数据头长度 
33.      * 第三个参数是数据尾指针 
34.      * 第四个参数是数据尾大小 
35.      * 第五个参数是一整帧数据的大小 
36.      */  
37.     DataParser *data_parser = parser_init(data_header, sizeof(data_header), NULL, 0, 8);  
38.   
39.     // 将要解析的数据逐个取出，添加到解析器中  
40.     for(i = 0; i < sizeof(data); i++)  
41.     {  
42.         // 解析数据，返回 RESULT_TRUE 代表成功解析出一组数据  
43.         if(parser_put_data(data_parser, data[i]) == RESULT_TRUE)  
44.         {  
45.             printf("成功解析出一帧数据...\n");  
46.   
47.             /* 一位一位取出解析后的数据 */  
48.             printf("第一个数据是：0x%x\n", parser_get_data(data_parser, 0));  
49.             printf("第二个数据是：0x%x\n", parser_get_data(data_parser, 1));  
50.             printf("第三个数据是：0x%x\n\n\n", parser_get_data(data_parser, 2));  
51.         }  
52.     }  
53.   
54.     // 当不再需要解析器时，应该把解析器释放掉，回收内存，避免造成内存泄漏  
55.     parser_release(data_parser);  
56.   
57.     return 0;  
58. }  

测试结果如下：

从上面可以看出，解析的结果与目标一致。

github地址：https://github.com/528787067/DataFrameParser