CrazePony飞行器--通信部分介绍【转】

简介: 转自:http://www.crazepony.com/wiki/comm-protocol.html 作者:nieyong 通信协议指的是遥控端和主控之间交互数据的封装,是一种自行约定的数据封装格式。

转自:http://www.crazepony.com/wiki/comm-protocol.html

作者:nieyong

通信协议指的是遥控端和主控之间交互数据的封装,是一种自行约定的数据封装格式。我们采用的是Crazyflie项目中定义的CRTP协议

遥控端和主控之间数据的交互,物理层可以有下面几种方式:

  • 单片2.4G无线射频收发芯片,通过SPI接口和MCU连接
  • 蓝牙2.1透传模块,通过串口UART和MCU连接
  • 蓝牙4.0低功耗BLE透传模块,通过串口UART和MCU连接

这几种不同的物理层通信方式在同一时刻只能够选择其中的一种。并且蓝牙2.1和蓝牙BLE根据安装的透传模块不一样进行选择。

crazyflie task

ESky Protocol

在上面示意图的的通信方式选择上,最左边为EskyLink,对应使用宏USE_ESKYLINK来开启是否选择该种链接方式。

# Make copter firmware to be used with the bootloader, CF controlled with eSky ET6i transmitter

$ make clean && make USE_ESKYLINK=1 CLOAD=1 all 

所谓的Esky Protocol,其实就是ESky公司遥控器使用的通信协议。所以如果选用这种通信方式,那么可以使用ESky航模公司的遥控器进行控制。Crazyflie官网支持ESKY ET6I Remote Control遥控器。

关于ESky公司的2.4G遥控器设备的通信协议,参考ArduinoRCLib项目中的描述:

The Esky 2.4 GHz equipment uses the Nordic NRF2401AG in both the transmitter and receiver. A compatible alternative to this chip is the NRF24L01+ (which is widely available).

ESky相关协议内容暂时不研究。

串口

使用串口作为物理层指的是蓝牙透传模块(包括蓝牙2.1或者蓝牙4.0 BLE模块)。串口配置为115200 8N1,收发异步。

一个可供主控解析的数据包格式,约定如下:

  7   6   5   4   3   2   1   0
  +---+---+---+---+---+---+---+---+
  |     Port      |  Res. | Chan. | 
  +---+---+---+---+---+---+---+---+
  |            DATA 0             |
  +---+---+---+---+---+---+---+---+
  :   :   :   :   :   :   :   :   :
  +---+---+---+---+---+---+---+---+
  |            DATA 31            |
  +---+---+---+---+---+---+---+---+

开始为一个字节的头,该字节中包括port字段,reserve字段,channel字段。紧跟着该自己,就是0-31个字节的数据,数据的长度是任意的。

头字节中的port字段用来区分该数据包的功能,常见的包括下面几个

  • 0x0 : console
  • 0x2 : parameter,表示后面的数据是系统的参数
  • 0x3 : commander,操作命令,控制飞机的飞行,包括pitch/yaw/roll等
  • ……

对于串口传输,在上面数据包的最前面需要加上两个字节0xaaaa的起始数据,在最后加上一个字节的checksum数据。格式如下:

  7   6   5   4   3   2   1   0
  +---+---+---+---+---+---+---+---+
  |             0xAA              |
  +---+---+---+---+---+---+---+---+
  |             0xAA              |
  +---+---+---+---+---+---+---+---+
  |      Port     |  Res  | Chan. |
  +---+---+---+---+---+---+---+---+
  |         Packet length         |
  +---+---+---+---+---+---+---+---+
  |            DATA 0             |
  +---+---+---+---+---+---+---+---+
  :   :   :   :   :   :   :   :   :
  +---+---+---+---+---+---+---+---+
  |            DATA 30            |
  +---+---+---+---+---+---+---+---+
  |            Cksum              |
  +---+---+---+---+---+---+---+---+

  +--------+--------+--------+--------+--------+--....--+--------+
  |  0xAA  |  0xAA  | Header | Length | Data0  | Packet | Cksum  |
  +--------+--------+--------+--------+--------+--....--+--------+

注意,紧跟在头后面的第一个data字节,表示后面数据的长度。

操作命令

操作命令是指用于控制飞行器起飞,前后左右运动的命令,英文commander。操控命令是遥控器最基本,也是最常用的命令。数据包头中port字段为0x3表示操作命令。Crazyflie操作数据格式约定如下。

+-------+-------+-------+-------+
| ROLL  | PITCH |  YAW  |THRUST |
+-------+-------+-------+-------+
0       4       8       12      14 bytes

操作数据一共14个字节,前12个字节分别表示Roll,Pitch,Yaw的值,每个值使用4个字节。后2个字节表示Thrust的值,使用2个字节。

所以,使用串口发送的一个操作命令示例如下:

0xaa 0xaa 0x30 0x0e 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x00 0x3e
【作者】 张昺华
【新浪微博】 张昺华--sky
【twitter】 @sky2030_
【facebook】 张昺华 zhangbinghua
本文版权归作者和博客园共有,欢迎转载,但未经作者同意必须保留此段声明,且在文章页面明显位置给出原文连接,否则保留追究法律责任的权利.
目录
相关文章
|
安全 机器人 测试技术
带你读《无人机网络与通信》之一:无人机系统概述
本书针对无人机系统两个关键问题—通信组网和管控体系做了比较全面和深入的描述和探讨,特别是以大量笔墨分析了现有无线通信解决方案,对比了不同通信协议,得出了很有价值的研究结论。无人机的跨越式发展将涉及公共安全管理的问题,构建管控体系是当务之急,分级管理以及制定相应的适航标准是一件大事情,本书对此也进行了系统的、建设性的讨论。未来,高档无人机和无人机集群将对环境具有更强的感知能力和自适应能力,还有对任务的自规划和学习、调整能力,本书讨论的内容将为它们的发明、部署和监督提供宝贵的信息。
|
13小时前
|
传感器 监控 物联网
LabVIEW使用ZigBee无线传感器开发住宅负载电力应用
LabVIEW使用ZigBee无线传感器开发住宅负载电力应用
|
19小时前
|
存储 传感器 编解码
LabVIEW风力涡轮机的雷电流测量系统中集成高速摄像机
LabVIEW风力涡轮机的雷电流测量系统中集成高速摄像机
|
10月前
|
5G
【Matlab代码实现】电动过滤器:LPF和HPF、模拟调制:调幅和调频、WiFi、蓝牙和蜂窝网络的容量分析.....
【Matlab代码实现】电动过滤器:LPF和HPF、模拟调制:调幅和调频、WiFi、蓝牙和蜂窝网络的容量分析.....
|
10月前
|
机器学习/深度学习 传感器 算法
【无人机通信】基于粒子群和基于行为控制实现无人机最佳多跳网络部署附matlab代码
【无人机通信】基于粒子群和基于行为控制实现无人机最佳多跳网络部署附matlab代码
|
11月前
|
机器学习/深度学习 传感器 自动驾驶
无人驾驶飞行器 (UAV) 以飞行基站 (FBS) 的形式辅助 5G 通信附matlab代码
无人驾驶飞行器 (UAV) 以飞行基站 (FBS) 的形式辅助 5G 通信附matlab代码
|
存储 监控
西门子S7-1500 PLC之间、PLC与HMI如何建立通信
西门子S7-1500关于通信的功能非常完善,可以说通信无处不在,这其中包括PLC之间的通信,PLC与人机界面的通信。在博途软件中,支持拖拽方式,通过变量的拖拽自动建立通信,这极大的提高了工程效率。今天我们从三个方面介绍S7-1500的通信。看完本文您会发现通信也是如此简单与高效。
西门子S7-1500 PLC之间、PLC与HMI如何建立通信
|
存储 索引
西门子S7-200SMART与变频器的通信如何设置?USS通信协议如何组态?
今天我们来介绍西门子S7-200SMART与变频器的通信如何设置,USS通信协议如何组态,下面先介绍一下变频器参数设置。
西门子S7-200SMART与变频器的通信如何设置?USS通信协议如何组态?
|
传感器 存储
多通道振弦传感器无线采发仪VS-BOX通讯接口与电源接口定义
VS-Box 是以振弦、温度传感信号为主的多通道无线采发仪,并可扩展其它模拟(电流、电压、电阻)信号和数字信号( RS485、 RS232)传感器通道,内置电池,可外接太阳能电池板。最多可实现 32 通道的全自动采集存储和无线发送,支持内部及外部 U 盘数据存储; 1 路程控电源输出可为其它传感器供电;RS232/RS485 数据接口。
多通道振弦传感器无线采发仪VS-BOX通讯接口与电源接口定义
|
传感器 存储 机器学习/深度学习
【WSN通信】基于最佳簇半径的无线传感器网络分簇路由算法附matlab代码
【WSN通信】基于最佳簇半径的无线传感器网络分簇路由算法附matlab代码