Windows下搭建MavLink通信协议环境,并用C++程序测试

搭建环境

git克隆

git clone https://github.com/mavlink/mavlink.git --recursive

安装python的future库

pip install future

使用可视化工具生成mavlink库

![在这里插入图片描述](https://img-blog.csdnimg.cn/52a95488f3814779a255082c280ff121.png

  • XML是选择消息格式,也可以自定义
  • Out是输出路径
  • Language是生成的语言,我这里是C++
  • Protocol是协议版本
    点击generate生成对应的头文件。

测试

在这里插入图片描述

MavLinkLibrary

是刚才生成的mavlink库

CMakeLists.txt

cmake_minimum_required(VERSION 3.15)
project(MAVLINKTEST)
set(CMAKE_CXX_FLAGS "${CAMKE_CXX_FLAGS} -std=c++11 -pthread -g")
# 当前cmakelist文件所在的目录
message(STATUS "CMAKE_CURRENT_SOURCE_DIR: " ${CMAKE_CURRENT_SOURCE_DIR})
# 项目cmakelist文件所在的目录
message(STATUS "CMAKE_SOURCE_DIR: " ${CMAKE_SOURCE_DIR})

# 添加include文件
set(MAVLINK_INCLUDE_DIRS ${CMAKE_CURRENT_SOURCE_DIR}/MavLinkLibrary)

include_directories(${MAVLINK_INCLUDE_DIRS})

add_executable(test test.cpp)

test.cpp

 
#include "MavLinkLibrary/common/mavlink.h"
#include "MavLinkLibrary/common/mavlink_msg_local_position_ned.h"
#include "MavLinkLibrary/common/mavlink_msg_sys_status.h"
#include<iostream>
using namespace std;
#define BUFFER_LENGTH                                                          \
  2041 // minimum buffer size that can be used with qnx (I don't know why)
 
int main(int argc, char *argv[]) {
 
  mavlink_system_t mavlink_system = {
      1, // System ID (1-255)
      1  // Component ID (a MAV_COMPONENT value)
  };
  char help[] = "--help";
 
  char target_ip[100];
 
  float position[6] = {};
 
  uint8_t buf[BUFFER_LENGTH];
  ssize_t recsize;
  // socklen_t fromlen = sizeof(gcAddr);
  int bytes_sent;
  mavlink_message_t msg2;
 
  // mavlink_message_t msg;
  mavlink_status_t status;
 
  uint16_t len;
  int i = 0;
  unsigned int temp = 0;
  {
    mavlink_msg_local_position_ned_pack(1, 200, &msg2, 123, 2, 33, 35, 43, 52,
                                        62);
    len = mavlink_msg_to_send_buffer(buf, &msg2);
    if(len){
        std::cout<<"message send success!"<<endl;
    }
    for (i = 0; i < len; i++)
      printf("%x ", buf[i]);
    printf("\n--------------------------------------------------------\n");
    mavlink_message_t msg;
    for (i = 0; i < len; i++) {
      temp = buf[i];
      printf("%02x ", (unsigned char)temp);
      if (mavlink_parse_char(12, buf[i], &msg, &status)) {
        // Packet received
        printf("\nReceived --packet: SYS: %d, COMP: %d, LEN: %d, MSG ID: %d\n",
               msg.sysid, msg.compid, msg.len, msg.msgid);
        if (msg.msgid == 32) {
          mavlink_local_position_ned_t local_position_ned;
          mavlink_msg_local_position_ned_decode(&msg, &local_position_ned);
          printf("ned x %f, y%f, z%f\nned vx %f, vy%f, vz%f\n",
                 local_position_ned.x, local_position_ned.y,
                 local_position_ned.z, local_position_ned.vx,
                 local_position_ned.vy, local_position_ned.vz);
        }
      }
    }
 
  }
}

编译

mkdir build
cd build
cmake .. -G "MinGW Makefiles"
mingw32-make.exe

运行结果

在这里插入图片描述

MAVLink是一种轻量级的、可扩展的通讯协议,用于在无人机和地面站之间传输数据。MAVLink协议使用UDP、TCP、串口等传输方式。以下是MAVLink协议的详细介绍。 1. MAVLink协议的数据包格式 MAVLink协议的数据包格式分为两个部分:头部和数据。头部包含了数据包的长度、序列号、系统ID、组件ID、消息ID和CRC校验码。数据部分包含了数据包的内容。 头部的格式如下: ``` typedef struct MAVLink_header_t { uint16_t len; // 数据包长度 uint8_t seq; // 数据包序列号 uint8_t sysid; // 发送者的系统ID uint8_t compid; // 发送者的组件ID uint8_t msgid; // 消息ID uint8_t crc[2]; // CRC校验码 } MAVLink_header_t; ``` 数据部分的格式根据消息ID的不同而不同。MAVLink定义了一系列消息ID,包括心跳消息、状态消息、姿态消息、传感器消息等。每个消息的数据部分都包含了特定的字段,用于描述该消息的内容。 2. MAVLink协议的数据包传输 MAVLink协议支持UDP、TCP、串口等多种传输方式。在使用UDP传输时,MAVLink协议将数据包封装为UDP数据报进行传输。在使用TCP传输时,MAVLink协议将数据包封装为TCP数据流进行传输。在使用串口传输时,MAVLink协议将数据包封装为帧格式进行传输。 3. MAVLink协议的数据包解析 MAVLink协议的数据包解析主要包括以下几个步骤: (1)接收数据包:从传输通道中接收到一个MAVLink数据包。 (2)校验数据包:使用CRC校验码对接收到的数据包进行校验。 (3)解析头部:解析数据包头部,得到数据包的长度、序列号、系统ID、组件ID、消息ID和CRC校验码。 (4)解析数据:根据消息ID解析数据包的数据部分,得到数据包的内容。 以上是MAVLink协议的详细介绍。在使用MAVLink协议进行通讯时,需要根据具体的应用场景选择合适的传输方式,并根据消息ID解析数据包的内容。
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值