Crazyflie笔记五: CRTP 实时通信协议(一)(转)
源:Crazyflie笔记五: CRTP 实时通信协议(一)
这里详细介绍了 Crazyflie 的 CRTP实时通信协议的相关内容,由于内容很长,分几篇博文来讲述。这里是第一节内容。欢迎交流:30175224@qq.com。新浪长沙@WalkAnt,转载本博客文章,请注明出处,谢谢。
7.1 CRTP通信包
英文参考:http://wiki.bitcraze.se/projects:crazyflie:firmware:comm_protocol
CRTP是Crazyflie的通信协议(Crazy RealTime Protocol)。该协议分3层。
第一层:CRTP Link。负责在PC与Crazyflie之间传输数据包。主要处理包长度,包错误信息。
第二层:CRTP Packet handling。将数据包传递给相应的飞行器子系统和PC控制软件。
第三层:Application/ports。代表发送和接受数据包的相应子系统。
1、数据通道
CRTP Link层对应的数据通道:
UART link |
主要用于早期开发。 |
USB link |
micro USB端口。 |
radio link |
主要使用2.4 GHz NordicSemi的nRF24L01芯片。 |
2、数据端口
当前端口分配:
端口号 Port |
数据端口 |
用途 |
0 |
Console 采用consoleprintf函数可以将调试信息输出到PC端。 |
|
2 |
读写Crazyflie参数,这些参数在源码中用宏来表示。 |
|
3 |
发送roll\pitch\yaw\thrust控制指令。 |
|
5 |
设置日志变量,这些日志变量将会以指定的周期发送。日志变量在源码中用宏来表示。 |
|
14 |
用于调试PC端UI界面程序,只针对Crazyflie Python API。 |
|
15 |
用于控制和访问通信链路层 |
A) 关于console数据端口:
英文参考:http://wiki.bitcraze.se/projects:crazyflie:firmware:console
Console 采用consoleprintf函数可以将调试信息输出到PC端。
Console端口用于Crazyflie飞行器向PC机单向打印信息,采用consoleprintf函数。飞行器端的console缓存长度为31个字节(0-30),当以下任一条件满足则发送。
1)输出缓存满31字节,字符串则自动发送到PC机;
2)字符串带\n或者\r,也触发字符串发送;
3)调用flush命令也会发送。
B) 关于Commander数据端口
英文参考:http://wiki.bitcraze.se/projects:crazyflie:crtp:commander
Commander端口,用来发送roll\pitch\yaw\thrust控制指令。一旦通信连接建立,这些roll\pitch\yaw\thrust数据包将被发送,这些值将会不断更新。
Name |
Byte |
Size |
Type |
Comment |
Roll |
0-3 |
4 |
float |
Roll值 |
Pitch |
4-7 |
4 |
float |
Pitch值 |
Yaw |
8-11 |
4 |
float |
Yaw值 |
Thrust |
12-13 |
2 |
uint16_t |
Thrust值 |
C) 关于LOG数据端口
英文参考:http://wiki.bitcraze.se/projects:crazyflie:firmware:log#communication_protocol
LOG数据端口就是用来在Crazyflie飞行期间,实时将log数据传回PC端显示。每一个日志变量都属于一个group组,并有一个name名字。
在log.h源码中,日志变量通过一系列宏指令来定义。所有的日志变量都被定义在一个log group组里,例如:
LOG_GROUP_START(stabilizer)
LOG_ADD(LOG_FLOAT, roll, &eulerRollActual)
LOG_ADD(LOG_FLOAT, pitch, &eulerPitchActual)
LOG_ADD(LOG_FLOAT, yaw, &eulerYawActual)
LOG_GROUP_STOP(stabilizer)
宏 |
用法 |
LOG_GROUP_START(grp_name) |
开始一个log group的定义,其中grp_name为组名 |
LOG_GROUP_STOP(grp_name) |
停止一个log group的定义 |
LOG_ADD(type, name, address) |
添加一个log变量。 type 是变量类型; name 是发送到地面站的变量名字; address 是源码中真实变量的地址。 |
日志变量的变量类型,列举如下:
类型定义 |
对应的C99变量类型 |
说明 |
LOG_UINT8 |
uint8_t |
|
LOG_UINT16 |
uint16_t |
|
LOG_UINT32 |
uint32_t |
|
LOG_INT8 |
int8_t |
|
LOG_INT16 |
int16_t |
|
LOG_INT32 |
int32_t |
|
LOG_FLOAT |
float |
IEEE 754 binary32 (single precision float) |
LOG_FP16 |
N/A? |
IEEE 754 binary16, intended for log report only (not in memory) |
3、CRTP通信包的结构
CRTP数据包,由一个8-bit header头,和0-30数据字节组成。
bit 7 |
bit 6 |
bit 5 |
bit 4 |
bit 3 |
bit 2 |
bit 1 |
bit 0 |
目标数据端口 Port 例:Log=5; Commander= 3 ; Parameters=2 |
Res 保留 |
目标通道 Channel
|
|||||
DATA 0 |
|||||||
DATA1 |
|||||||
… |
|||||||
… |
|||||||
DATA30 |
目标数据端口,指的是通信子系统。通信子系统可以是Console、Parameters、Commander、Log、Client-side debugging、Link layer等等。
4、物理接口层
下面所讲述的数据通信包适用于有线和无线传输。但是数据包大小为31字节,所以无线传输时最好将所有数据能够完整放在一个数据包以内传输。
对于无线传输接口,会增加额外的CRC数据头。对于串口的参数配置为,波特率115200,8N1。CRTP数据包格式如下。
bit 7 |
bit 6 |
bit 5 |
bit 4 |
bit 3 |
bit 2 |
bit 1 |
bit 0 |
0xAA |
|||||||
0xAA |
|||||||
目标数据端口 Port 例:Log=5; Commander= 3 ; Parameters=2 |
Res 保留 |
目标通道 Channel
|
|||||
Packet length 数据字节长度(DATA长度) |
|||||||
DATA 0 |
|||||||
DATA1 |
|||||||
… |
|||||||
… |
|||||||
DATA30 |
|||||||
Cksum 校验码 |
进一步的解释如下:
0xAA |
0xAA |
Header 数据头 |
Length 数据长度 |
Data0…………………….Data30 |
Cksum |
举例如下:
例1:Commander命令:
0xaa 0xaa 0x30 0x0e 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x3e
其中:0x30表示Commander命令;0x0e表示数据长度为14字节。
例2:数据链路ping指令(类似以太网ping指令)
--> 0xaa 0xaa 0xf0 0x01 0x01 0xf2 # Sent to the copter 发往copter飞行器
<-- 0xaa 0xaa 0xf0 0x01 0x01 0xf2 # Received from the copter 接收自飞行器
其中0xf0表示用于控制和访问通信链路层的link layer数据端口命令。0x01表示数据长度1个字节。
关于Crazyflie笔记的其他文章,请参考http://blog.sina.com.cn/antinformation