这段时间一直在研究多旋翼飞行器,以及其它的事情,博客好外没更新,再不坚持怕真荒废了哦。0 ^. f- \9 V& e6 C/ s
|9 D: q3 b1 D; n% X
在上篇简单实现 MAVLink 协议的解析,并演示按照设计好的命令执行对应的事件处理,以及又加入 CRC 校验,实现更稳定的通信,但在上文结束时也提到当对一个包进行解析及对应事件处理时,是不能接收新的数据,直到事件处理完成,Msg_Rev.Get 状态设置为 RECEIVING 后方能再接收新的数据。这时,当事件处理需要一定时间,而又有新的数据不断发送过来时,很容易造成数据丢失现象。
2 Q) ^, D6 N: b" l
如何提高串口通信效率,并避免丢包现象了?
: X: a" t/ }3 }% o6 e# d8 S! r
为提高效率,首先想到采用 DMA 方式,然而考虑下发现,接收的数据包是不固定的;并且即使采用 DMA,若 MAVLink 接收缓存仍设计成只接收一条消息大小,丢包问题仍然还是会有滴。 , ]# Y$ s [% ?* E7 ]
这样就想有没方法软件来实现,就相到如果开辟一个缓存空间,不断接收的数据都放到那儿,而包的解析处理函数可从这里面依次取出一定数据,来作处理。这样只要设计比较合理,因软件阻塞造成的丢包现象就容易解决了。那么要设计一个怎样的缓存呢 ? 其实很容易想到队列(先进先出的特性),而为了更有效且合理的利用空间,又就会想到环形队列这种数据结构 。( X3 o i, n3 Y, j) v
. ?0 ?, {* n; T) c. u m0 q
首先是其数据结构设计,以及插入删除操作,不多说,如下代码: - #define MAX_QUEUE_LEN (4096) // 4K% H9 J* \' S" B1 V, Z0 H
- #define RW_OK 0) S( J9 m9 d, h% X. q* l
- #define FULL_ERROR 1
, A) N/ M& ]/ B - #define EMPTY_ERROR 2( z' Z2 }6 }1 W5 n2 ?" j: o
- , q, M$ J5 I% M* K& l- ^
- typedef uint8_t boolean;
M6 ^( p j& c. _7 s' w! n# U - * a+ Y( Q% y, x, B5 {' F( b! \
- typedef struct
' c2 R8 b0 A" ]: Q+ Z7 G+ r - {
( c5 S" f+ O1 C4 s1 ^ - u16 MemFrontSendIndex ;% G# a$ o, l& @4 O' [! w" W
- u16 MemRearRecvIndex ;
' v& W+ u( k( `3 g - u16 MemLength ;( C9 t4 t5 ~, [( P; U/ `
- u8 MemDataBuf[MAX_QUEUE_LEN];
! {/ q3 R% l9 ~5 ~ - } Queue_Mem_Struct , * Queue_Mem_Struct_p ;
" s" H; ` ~# S6 y, M - 5 \& _1 u1 }2 o! J" X" C% ^
- Queue_Mem_Struct Queue_Recv ;
, a* Z% k' I) \) V# E* h - 1 g' V! S3 {9 n2 Q0 h9 T+ [
- boolean QueueMemDataInsert(u8 data)
( ^+ ~4 i6 e# g- l: p! w1 y - {
% J8 g" N# r: x; X' M- H5 q - if (MAX_QUEUE_LEN == Queue_Recv.MemLength), x/ y, g f# s, w; W9 Q$ m
- {8 M/ v+ v+ v( o+ @
- return FULL_ERROR;6 D$ z7 E" o- v5 g" ?
- }+ [7 O( D! Q) K" p& k5 o; I2 g
- else
# b/ s8 B( D# T9 `' C2 D0 ]- v - {
6 U0 E! v5 B- r1 \2 j - Queue_Recv.MemDataBuf[Queue_Recv.MemRearRecvIndex] = data ;8 k" X L, `3 W5 d1 _
- // if(++Queue_Recv.MemRearRecvIndex >= MAX_QUEUE_LEN){Queue_Recv.MemRearRecvIndex = 0;}# ^+ G' E+ e7 H, s
- Queue_Recv.MemRearRecvIndex = (Queue_Recv.MemRearRecvIndex + 1) % MAX_QUEUE_LEN;
\0 n1 L5 B5 x1 X0 H9 u - Queue_Recv.MemLength ++ ;) E, g& g. K* M" B* Q7 c1 q
- return RW_OK;2 ~: x6 Y! y) D- J
- }
$ N) @8 U S$ { u( q - }
* z3 p ~% g# _2 O2 S. y! {( X - 3 r2 y7 b5 Q3 {' ^
- boolean QueueMemDataDel(u8 *data)
* [$ B6 Y9 V& t+ X - {
; `2 g1 k" j3 g - if (0 == Queue_Recv.MemLength)
. o! p7 Y' ^% l - {
; i1 z6 S6 e# g c, ~* t+ d9 m - return EMPTY_ERROR;
. F' V% k. i4 G8 K# C- v) w( [. q - }
1 ]0 A7 H6 a$ G. V - else3 T: _) n: ]; ?- s! t7 x
- {
7 M, c2 }( i7 |0 M- }2 }/ I3 v - *data = Queue_Recv.MemDataBuf[Queue_Recv.MemFrontSendIndex] ;
% g: t0 ], a- d - Queue_Recv.MemFrontSendIndex = (Queue_Recv.MemFrontSendIndex + 1) % MAX_QUEUE_LEN;
6 }0 ~( T! v1 H) [/ t# D( { - Queue_Recv.MemLength -- ;2 Y9 V+ M& }6 }/ o/ C# L
- return RW_OK;
8 u! `/ S6 m _ - }8 @& q6 O( }2 ?) I0 {% _7 a4 W E/ B
- }
复制代码
; y! \ j# }5 ?$ b) z) F这样,只需通过 QueueMemDataInsert 函数把串口接收的数据依次填充到缓冲区 Queue_Recv.MemDataBuf 中去。而在处理时调用 QueueMemDataDel 函数取出对应个数的数据来处理。这样就避免整个处理过程中无法同时接收数据而产生丢包的问题。当然此时要保证缓冲区的数据及时处理完,否则,尤其当数据量很大时队列填充满后,又会造成数据无法再填充进来。
% N/ y* F, P2 @- T' u0 ^
另外至此又会发现,如上设计可结合采用 DMA 方式。设计的好的话,可以进一步大幅度提升 STM32 利用率及系统运行效率!
* s7 x5 H1 X7 J! v5 W( F
转载自:以太快跑
3 Z* b- A2 Y/ E |