开源飞控初探(五):MAVLink协议和Java库-创新互联
MAVLink协议是一种(应用层)数据协议,不依赖传输协议。传输层可以是TCP、UDP、RS232串口,甚至基于WebSocket。在定义数据的基础上,补充描述了几种子协议(microservice,直译是微服务)的现有实现。协议不保证送达,客户端需要经常检查机器状态确认命令被执行。
公司专注于为企业提供网站设计、成都网站制作、微信公众号开发、成都商城网站开发,成都微信小程序,软件按需开发等一站式互联网企业服务。凭借多年丰富的经验,我们会仔细了解各客户的需求而做出多方面的分析、设计、整合,为客户设计出具风格及创意性的商业解决方案,创新互联建站更提供一系列网站制作和网站推广的服务。具体的数据定义包括:
数据帧格式,包括协议头和载荷(Payload),协议头包括协议版本、载荷长度、兼容标识、次序号、发送者系统号、发送者组件号、消息号、CRC检验和可选的签名。
消息号枚举和意义,不同的消息号其载荷的长度和意义。
命令子协议(一种特殊的消息),命令枚举和意义
官方提供了数据帧的装帧和解析基础库,支持12种语言,还有非官方的库额外多支持3种语言。官方的基础库是通过脚本解析多个XML生成的,XML原始地描述了所有的消息、命令、枚举。这些XML是包含的关系,按消息数量多少排序是:厂商定制消息集(例如ardupilotmega.xml) >common.xml(常用消息集,有161种消息)>minimal.xml(最小消息集,有2种消息)。生成基础库时可传参给脚本指定消息集。
MAVLink的Java库生成目标为APM板子。源码都在com.MAVLink包中,目录文件结构:
uAvionix/CRC.java。CRC算法,算法的约定整数序列全是0。
enums/
97个java文件,按协议规范定义了各种枚举值。
Messages/
MAVLinkMessage.java。各种消息的抽象基类。每种MAVLink消息都有一个子类。
MAVLinkPayload.java。表示协议载荷,直接操作ByteBuffer。
MAVLinkStats.java。统计收发帧的数量和错误数。主要实现协议中的seq消息次序号。
ardupilotmega/
CRC.java。CRC算法,算法的约定整数序列已设为MAVLink自定义的值。
msg_*.java。63个消息类,APM特有的,都继承MAVLinkMessage。
common/
CRC.java。和ardupilot/CRC.java是一样的。
msg_*.java。136个消息类,都继承MAVLinkMessage。
MAVLinkPacket.java。对一帧数据的封装,有装帧和解析(生成一个具体的消息类)操作。
Parser.java。解析过程的实现类,逐字节传入数据。
数据接收流程:
将底层连接接收的字节流逐个字节传入Parser.mavlink_parse_char(int c)函数,至一帧接收完毕时会返回一个MAVLinkPacket实例,否则返回null。
调用MAVLinkPacket.unpack()函数,即得到一个MAVLinkMessage实例
根据msgid成员变量判断,强制转换成对应子类。
发送流程:
new一个具体的消息,对成员变量赋(业务)值
调用MAVLinkMessage.pack()函数得到一个MAVLinkPacket实例
调用MAVLinkPacket.encodePacket()函数得到byte[]传给底层连接。
协议中各用一个字节(0~255)分别表示消息发送者的系统号(system ID)和组件号(component ID)。系统就两种,飞控和地面站(飞控客户端都叫地面站)。可以同时有多架飞机和多个地面站连接,所以系统号必须唯一。组件可以是飞控(固件)、无线电台、相机、电机、万向节、电池、显示设备、降落伞,地面站控制模块、惯性导航、GPS等,有固定枚举值来表示这些组件。
部分消息的载荷里,有targetSystemID和targetComponentID参数来表示期望执行命令的系统组件。
多架飞机的SystemID从1开始递增。多个地面站的SystemID从255开始递减。
心跳各组件都发出HEARTBEAT ( #0 )消息,被其它系统组件用来判断是否在线。各组件必须有规律地发出心跳消息,即使不发控制命令的也要。通常频率为1Hz,如果连续4或5次没收到消息就认为那个系统掉线了。
参数type
地面站应为6,MAV_TYPE_GCS
飞控是14,MAV_TYPE_OCTOROTOR,4轴8桨飞行器。
飞控客户端可以请求想要的数据以及设置响应频率,这些数据都来自上文的组件。完整的可请求的数据列表在这:https://ardupilot.org/dev/docs/mavlink-requesting-data.html。
涉及4种消息。
获取PARAM_REQUEST_LIST,获取所有参数。地面站发出这个命令,飞控用PARAM_VALUE消息逐个参数回复。PARAM_VALUE消息有param_count参数表示总共有多少个参数以及param_index表示这是第几个。
PARAM_REQUEST_READ,获取单个参数,飞控用PARAM_VALUE消息回复。
设置PARAM_SET,设置单个参数。地面站发出这个命令,飞控用PARAM_VALUE消息再广播一次表示收到。
航线涉及10种消息
上传地面站发出MISSION_COUNT,表示有多少个item
飞控发来MISSION_REQUEST_INT,参数seq表示第几个。
地面站回复MISSION_ITEM_INT,按seq第几个来上传
飞控发来MISSION_ACK表示已接受所有item。
地面站发出MISSION_REQUEST_LIST
然后是上传过程调换角色,即地面站发MISSION_REQUEST_INT,飞控发MISSION_ITEM_INT,最后地面站发MISSION_ACK
流程图如下:
报告飞控发出MISSION_CURRENT消息,当前执行的item:飞控会报告当前执行的mission item seq号
飞控发出MISSION_ITEM_REACHED消息,飞控每到达一个mission item的地点就会报告一次,参数为seq
设置当前item地面站发出MISSION_SET_CURRENT消息。我们不会用。
清除地面站发出MISSION_CLEAR_ALL消息,清除所有任务item
重要的命令MAV_CMD_NAV_WAYPOINT (16 ),航点信息,会直线飞过去。用在MISSION_ITEM_INT消息中
MAV_CMD_NAV_RETURN_TO_LAUNCH (20 ),返航命令。用在MISSION_ITEM_INT消息中
MAV_CMD_NAV_LAND (21 ),着陆命令。用在MISSION_ITEM_INT消息中
MAV_CMD_NAV_TAKEOFF (22 ),起飞命令。用在COMMAND_LOG消息中
MAV_CMD_NAV_SPLINE_WAYPOINT (82 ),航点信息,会延曲线路径飞过去。用在MISSION_ITEM_INT消息中
MAV_CMD_MISSION_START (300 ),开始执行任务。用在COMMAND_LOG消息中
MAV_CMD_COMPONENT_ARM_DISARM (400 ),锁定或解锁。用在COMMAND_LOG消息中
MAV_CMD_SET_MESSAGE_INTERVAL (511 ),设置消息的发送间隔。用在COMMAND_LOG消息中
MAV_CMD_REQUEST_MESSAGE (512 ),511命令的一次性版。用在COMMAND_LOG消息中
MAV_CMD_REQUEST_PROTOCOL_VERSION (519 ),请求对方的MAVLink版本兼容性。对方应该ACK并发回一个PROTOCOL_VERSION消息。用在COMMAND_LOG消息中
MAV_CMD_REQUEST_AUTOPILOT_CAPABILITIES (520 ),获取自动驾驶的能力。用在COMMAND_LOG消息中。
设计原则。https://docs.google.com/document/d/1XtbD0ORNkhZ8eKrsbSIZNLyg9sFRXMXbsR2mp37KbIg/edit
基础知识。MAVLink Basics ‒ Dev documentation
你是否还在寻找稳定的海外服务器提供商?创新互联www.cdcxhl.cn海外机房具备T级流量清洗系统配攻击溯源,准确流量调度确保服务器高可用性,企业级服务器适合批量采购,新人活动首月15元起,快前往官网查看详情吧
当前名称:开源飞控初探(五):MAVLink协议和Java库-创新互联
文章转载:http://cdiso.cn/article/ijhdd.html