Mavlink协议理解

来源：blog.csdn.net/super_mice/article/details/44836585

以前看了mavlink协议，网上关于mavlink的资料很少。本文大概总结了下对mavlink协议的理解。如下如不说明都是说mavlink v1.0版本。

首先附上mavlink的各个消息的简介https://pixhawk.ethz.ch/mavlink/（这里的内容不少，建议大概了解mavlink后再去浏览），

mavlink协议介绍http://qgroundcontrol.org/mavlink/start

以后会在个人资源里上传一份为初学者准备的mavlink资料（转载）已经上传至笔者资源，免费下载。mavlink 纯小白教程(英文)它用通俗的说法帮助新人理解什么是mavlink，mavlink能干吗等等。资料只有第一部分，第二部分笔者没有找到（多是原做者没继续第二部分吧）。

先简单介绍下mavlink协议。Mavlink协议最先由 苏黎世联邦理工学院 计算机视觉与几何实验组 的 Lorenz Meier 于2009年发布，并遵循LGPL开源协议。Mavlink协议是在串口通信基础上的一种更高层的开源通信协议，主要应用在微型飞行器（micro aerial vehicle）的通信上。Mavlink是为小型飞行器和地面站（或者其余飞行器）通信时经常用到的那些数据制定一种发送和接收的规则并加入了校验 （checksum）功能。

【1】下面开始说介绍mavlink所发送的数据结构。Mavlink传输时的基本单位是消息帧。

如图所示，每一个消息帧都是上述的结构，除了灰色外，其余的格子都表明了一个字节的数据。

红色的是起始标志位（stx），在v1.0版本中以“FE”做为起始标志。这个标志位在mavlink消息帧接收端进行消息解码时有用处。

第二个格子表明的是灰色部分（payload，称做有效载荷，要用的数据在有效载荷里面）的字节长度（len），范围从0到255之间。在mavlink消息帧接收端能够用它和实际收到的有效载荷的长度比较，以验证有效载荷的长度是否正确。

第三个格子表明的是本次消息帧的序号（seq），每次发完一个消息，这个字节的内容会加1，加到255后会从0从新开始。这个序号用于mavlink消息帧接收端计算消息丢失比例用的，至关因而信号强度。

第四个格子表明了发送本条消息帧的设备的系统编号（sys），使用PIXHAWK刷PX4固件时默认的系统编号为1，用于mavlink消息帧接收端识别是哪一个设备发来的消息。

第五个格子表明了发送本条消息帧的设备的单元编号（comp），使用PIXHAWK刷PX4固件时默认的单元编号为50，用于mavlink消息帧接收端识别是设备的哪一个单元发来的消息（暂时没什么用） 。

第六个格子表明了有效载荷中消息包的编号（msg），注意它和序号是不一样的，这个字节很重要，mavlink消息帧接收端要根据这个编号来肯定有效载荷里到底放了什么消息包并根据编号选择对应的方式来处理有效载荷里的信息包。

  最后两 个 字节是16位校验位，ckb是高八位，cka是低八位。校验码由crc16算法获得，算法将整个消息（从起始位开始到有效载荷结束，还要额外加上个 MAVLINK_CRC_EXTRA字节）进行crc16计算，得出一个16位的校验码。以前提到的每种有效载荷里信息包（由消息包编号来代表是哪一种消息 包）会对应一个MAVLINK_CRC_EXTRA，这个 MAVLINK_CRC_EXTRA 是由生成mavlink代码的xml文件生成的，加入这个额外的东西是为了当飞行器和地面站使用不一样版本的mavlink协议时，双方计算获得的校验码会 不一样，这样不一样版本间的mavlink协议就不会在一块儿正常工做，避免了因为不一样版本间通信时带来的重大潜在问题。

为了方便叙述，消息包将称做包，包所表明的信息称做消息。上图中的sys将称为sysid，comp将称为compid，msg将称为msgid。

官方的介绍以下图：

 

【2】下面主要介绍mavlink里消息的种类和如何看懂开始时提到的那个官方的mavlink消息介绍。

（一）中已经提到了在mavlink消息帧里最重要的两个东西，一个是msgid；一个是payload，前者是payload中内容的编号，后者则存放了消息。消息有许多种类型，在官网的网页中中以蓝色的“#”加数字的方式来表示消息的编号如 “#0”（这样的表示方法应该是为了方便在网页中查找相应编号消息的定义）。在官网介绍网页里往下拉，大概拉到二分之一的位置处，开始出现“MAVLink Messages”的介绍，往下看是各类消息的数据组成说明。下面将以几个消息为例，讲解mavlink消息。

先以 #0 消息为例，这个消息叫心跳包（heartbeat）。它通常用来代表发出该消息的设备是活跃的，飞行器和地面站都会发出这个信号（通常以1Hz发送），地面站和飞行器会根据是否及时收到了心跳包来判断是否和飞行器或地面站失去了联系。

                         

从图上能够看出，心跳包由6个数据组 成，第一个是占一个字节的飞行器类型数据（type），这个数据表示了当前发消息的是什么飞行器，好比四旋翼，固定翼等等。type的取值如何与飞行器类 型对应，这要在官方的mavlink消息介绍网页上找，位于网页开始出的数据枚举中。以下图所示：

  这里只是一部分的类型，第一个是通用 飞行器，对应的type数值是0；第二个是固定翼类型，对应的数值是1；第三个对应的是四旋翼，对应的数值是2.这个飞行器类型，其实对于发心跳包的地面 站来讲可能没什么意义（不一样飞控对该消息的处理方法不一样，至少刷了PX4固件的Pixhawk飞控对地面站发来的心跳包里的这个参数并不关心，如无特殊说 明，以后所说的Pixhawk飞控都是指刷PX4固件的飞控），对于飞行器端来讲表明了当前飞行器的类型，地面站能够根据这个参数来判断飞行器的类型并做 出其余的反应。

第二个参数是自驾仪（即一般所说的飞控）类型，好比apm，ppz，Pixhawk等飞控，具体定义查找和以前查找飞行器类型时的方法同样。一样的，对于发送心跳包的飞行器来讲表明了本身的飞控类性，对地面站发出的心跳包来讲意义不大。

第三个参数是基本模式（base mode），是指飞控如今处在哪一个基本模式，对于发心跳包的地面站来讲没有意义，对于发送心跳包的飞控来讲是有意义的。这个参数要看各个飞控本身的定义方 式，mavlink介绍网页并不会给出具体的模式。在Pixhawk中基本模式能够分为使用用户模式（custom mode）仍是基本模式（这里有点绕，实际上是就是是否使用用户模式）。使用用户模式将在讲下个参数时说明，使用基本模式又会分为自动模式（auto），位 置控制模式（posctl）和手动模式（manual）。通常状况下都会使用用户模式，普通用户不用关心这个参数。开发者在使用mavlink修改飞行器 模式时须要注意基本模式的设置，具体请看PX4代码。

第四个参数是用户模式（custom mode），大概说一下Pixhawk的用户模式。以多轴为例。它分为主模式（main mode）和子模式（sub mode），两种模式组合在一块儿成为最终的模式，主模式分为3种，手动（manual），辅助（assist），自动（auto）。手动模式相似apm的姿态模式。在辅助模式中，又分为高度控制模式（altctl）和位置控制模式（posctl）两个子模式，高度控制模式就相似apm的定高模式，油门对应到飞行器高度控制上。位置模式控制飞行器相对地面的速度，油门和高度控制模式同样，yaw轴控制和手动模式同样。自动模式里又分为3个子模式，任务模式（mission），留待模式（loiter），返航模式（return）， 任务模式就是执行设定好的航点任务，留待模式就是gps悬停模式，返航模式就是直线返回home点并自动降落。在apm里这个参数貌似是没有用的，注意这 个数据占了4个字节，在Pixhawk中，前两个字节（低位）是保留的，没有用，第三个字节是主模式，第四个字节是子模式。普通用户请无视，开发者请注意：官网给出的经过程序设置模式的代码是错误的。如图，最后一行代码有误，应该为：

  第五个是系统状态（system status），查定义就行了，其中的standby状态在Pixhawk里就是还没解锁的状态，active状态就是已经解锁，准备起飞的状态。

第六个是mavlink版本（mavlink version），如今是“3”版本。

其他的消息也是相似的结构，各个数据的定义能够查看mavlink官方网页的说明，这些说明通常在网页的前面部分。具体说明以飞控为准，mavlink仅提供基本的定义。

有几个相对特殊和容易混淆的消息再特别说明下：

#76消 息（command long），该消息是发送长命令，通常是地面站发送给飞控命令用的。该消息组成以下图。目标系统（命令的接收方，就是目标系统编号sysid），目标单元 （命令的接收单元，就是目标单元编号compid）。command数据是这条命令的编号，用于区别不一样的命令。confirmation数据，笔者还不 是很明白，大概是是否须要收到命令后回复确认信号的意思。接下去有七个参数，这些参数是执行这条命令所须要告诉飞控的，许多命令都用不到七个参数，多余的 参数清0就能够了。

  Pixhawk支持的命令有许多种 （但不是全部mavlink命令都支持）。要看mavlink提供了哪些命令请在介绍mavlink的官网查询mav_cmd，在网页的中上部分。好比： 第176号命令 MAV_CMD_DO_SET_MODE。这条命令用于改变飞行器的飞行模式，第一个参数就是设置飞控的base_mode，第二个是设置 custom_mode。想要经过这条命令正确设置pixhawk的模式须要查看PX4代码，mavlink对参数的描述不够具体。

现 在应该对介绍mavlink官网的布局有所了解了吧。网页前面主要讲了各种数据的取值和含义，好比飞控类型（mav_autopilot）,飞行器类型 （mav_type）等，其中mav_cmd是比较特殊和重要的一种数据。网页的后半部分主要讲了mavlink消息的种类和数据组成，这里会用到各类数 据，具体数据定义的能够回到前半部分去找。可是mavlink是个通用的通信协议，不一样的飞控支对mavlink支持方式不同，通常都只支持一部分mavlink消息，还会本身扩展一些mavlink协议所没有定义的消息（pixhawk和apm都是如此），具体都以飞控代码为准。

大概说说地面站和飞控的通信流程，由 于没看过地面站的代码，因此极可能有误，还望发评论指正！通常飞控在链接上地面站后都会主动向地面站发送心跳包，飞行器姿态，系统状态，遥控器信号等组成 的数据流。各个数据都会以必定的频率发送，好比心跳包通常是1Hz，姿态信息会快些，pixhawk用数传链接QGC时的姿态数据发送频率在7-8Hz左 右。通常地面站会在刚链接上飞控时发送命令，请求飞控传回全部参数（QGC就是这样），飞控根据本身的状况判断是否接受地面站的请求，并根据不一样的命令执 行相应的操做（有些命令须要飞控回复地面站确认信号）。以后地面站根据用户的操做会发送相应的mavlink消息给飞控，好比设置航点，改写飞控参数等。 听说数传是半双工的（在同一时刻只能选择发送或者选择接受数据，不能同时收发数据），地面站和飞控之间如何避免数据冲突（即双方同时向对方发送消息）的机 制笔者并不清楚，但愿能抛砖引玉。

mavlink有不少的版本，虽然都是mavlink v1.0，但仍是有不少不同的地方，不一样飞控，不一样时间的mavlink文件都会不同，笔者讲的mavlink是在这里下载的https://github.com/mavlink/c_library。mavlink代码所有由头文件组成，能够很方便的添加到你本身的代码中。  

  能够看到，里面有多个文件夹和几个头 文件。pixhawk，ardupilotmega（apm），matrixpilot这类的文件夹里都是各个飞控本身定义的mavlink消息类型，原 始的mavlink消息放在common文件夹里面（大部分消息都在common文件夹中）。checksum.h中存放的是计算校验码的代码。 mavlink_helper.h里面是将各个消息包补充完整（调用checksum.h中的函数计算校验码并补上消息帧的头，好比sysid和 compid等）成为mavlink消息帧再发送。最主要的功能集中在这两个文件夹中。mavlink_conversions.h里是dcm，欧拉角， 四元数三种姿态表示方法之间的转换代码。

下面以发送心跳包 （heartbeat）为例，说明下如何使用mavlink头文件来发送心跳包。首先打开common文件夹中的 mavlink_msg_heartbeat.h 头文件。这个头文件能够分为两部分，一部分用来打包、发送heartbeat消息，另外一部分用来接收到heartbeat消息时解码消息。 heartbeat.h定义了heartbeat消息对应的数据类型：

     
     
     
     

      
      
      
      

      
      
      
      

      
      
      
      

      
      
      
      

      
      
      
      

      
      
      
      

      
      
      
      

      
      
      
      

      
      
      
      

     
     
     
     
typedef struct __mavlink_heartbeat_t{ uint32_t custom_mode; ///< A bitfield for use for autopilot-specific flags. uint8_t type; ///< Type of the MAV (quadrotor, helicopter, etc., up to 15 types, defined in MAV_TYPE ENUM) uint8_t autopilot; ///< Autopilot type / class. defined in MAV_AUTOPILOT ENUM uint8_t base_mode; ///< System mode bitfield, see MAV_MODE_FLAG ENUM in mavlink/include/mavlink_types.h uint8_t system_status; ///< System status flag, see MAV_STATE ENUM uint8_t mavlink_version; ///< MAVLink version, not writable by user, gets added by protocol because of magic data type: uint8_t_mavlink_version} mavlink_heartbeat_t;

若是mavlink的发送方式可使用（串口发送，函数接口也兼容），则能够调用 【1】

     
     
     
     

      
      
      
      

     
     
     
     
static inline void mavlink_msg_heartbeat_send(mavlink_channel_t chan, uint8_t type, uint8_t autopilot, uint8_t base_mode, uint32_t custom_mode, uint8_t system_status)

其中的chan是channel的缩写，用于选择发送的串口或者usb口。type就是飞行器类型，其他参数不明的能够看看本博客的上面文章。

该函数功能是将传入的各个参数按照对应的格式放到heartbeat消息包中（即打包）

这个函数内部有一句预处理：

     
     
     
     

      
      
      
      

     
     
     
     
#if MAVLINK_CRC_EXTRA

是说是否使用额外的crc校验字符（默认使用），详情请看第一篇博客中对于两个校验字节的说明。

函数中会调用函数【2】

      
      
      
      

       
       
       
       

      
      
      
      
_mav_finalize_message_chan_send(chan, MAVLINK_MSG_ID_HEARTBEAT, buf, MAVLINK_MSG_ID_HEARTBEAT_LEN, MAVLINK_MSG_ID_HEARTBEAT_CRC);

       
       
       
       

        
        
        
        

       
       
       
       
MAVLINK_MSG_ID_HEARTBEAT//这个是心跳包消息对应的编号 这里=0

        
        
        
        

         
         
         
         

        
        
        
        
MAVLINK_MSG_ID_HEARTBEAT_LEN//这个是心跳包的长度 注意这个长度仅仅是payload的长度，不包括帧的头尾。

         
         
         
         

          
          
          
          

         
         
         
         
MAVLINK_MSG_ID_HEARTBEAT_CRC//这个是heartbeat消息对应的额外的crc校验码 这里=50

这个函数位于mavlink_helper.h中，用于更新消息帧的编号（seq 每发送一帧加1）并将消息帧的头和计算校验码，使得成为完整的一个mavlink消息帧。最后调用串口发送函数进行消息帧的发送。

若是只是想将对应的心跳包参数按照心跳包的格式存放好，则能够只调用

      
      
      
      

       
       
       
       

       
       
       
       

      
      
      
      
static inline uint16_t mavlink_msg_heartbeat_pack(uint8_t system_id, uint8_t component_id, mavlink_message_t* msg, uint8_t type, uint8_t autopilot, uint8_t base_mode, uint32_t custom_mode, uint8_t system_status)

将参数打包为heartbeat消息帧，待以后使用。

解码消息帧时能够调用mavlink_helper.h中的

      
      
      
      

       
       
       
       

      
      
      
      
MAVLINK_HELPER uint8_t mavlink_parse_char(uint8_t chan, uint8_t c, mavlink_message_t* r_message, mavlink_status_t* r_mavlink_status)

它会将收到的字符一个个进行解码，会检验收到的校验码是否正确；有效载荷的长度小于最大长度而且和该消息的长度一致。若是一切顺利，将会获得解码到的消息，放在解码获得的消息帧类型中

      
      
      
      

       
       
       
       

       
       
       
       

       
       
       
       

       
       
       
       

       
       
       
       

       
       
       
       

       
       
       
       

       
       
       
       

       
       
       
       

       
       
       
       

      
      
      
      
typedef struct __mavlink_message { uint16_t checksum; ///< sent at end of packet uint8_t magic; ///< protocol magic marker uint8_t len; ///< Length of payload uint8_t seq; ///< Sequence of packet uint8_t sysid; ///< ID of message sender system/aircraft uint8_t compid; ///< ID of the message sender component uint8_t msgid; ///< ID of message in payload uint64_t payload64[(MAVLINK_MAX_PAYLOAD_LEN+MAVLINK_NUM_CHECKSUM_BYTES+7)/8];}

其中的magic是一帧的起始标志（FE=254），就是mavlink_stx的值。

其他的mavlink消息也是相似 的，旧的mavlink代码中有些类型的消息类型可能会找不到，使用时要注意接受和发送方使用的mavlink版本是否兼容。common文件夹中的 common.h里面包含了要用到的数据类型和全部消息的头文件，使用时直接包含进来便可。

来自为知笔记(Wiz)