APM 仿真遥控指南

地面站开发了一段时间了,由于没有硬件,所以一直在 APM 模拟器中验证。我们已经实现了 MAVLink 消息接收和解析,显示无人机状态,给无人机发送消息,实现一键起飞,飞往指定地点,降落,返航等功能,本期我们来看看如何在模拟器中实现对无人机的遥控。

【注意】

  1. 本期所说的遥控无人机都是指遥控无人机模拟器,不涉及硬件在环。
  2. 前方有坠机风险,请谨慎驾驶。

遥控的基本知识

遥控分为发送端和接收端,发送端自然是遥控器,接收方自然就是无人机。遥控信号一般是一系列数值,通过无线电传输。每个数值被称为一个通道(channel),所以在无人机中,遥控信号一般也称为 Radio Channel,简称 RC。通道个数以及每个通道的作用取决于软件实现,比如 APM 共有18个通道。

无人机收到 RC 控制信号后,会通过飞控将其转换为 PWM 信号,然后输出给电调来控制电机转速。飞控就是飞行控制模块,是一个集成了多种传感器的嵌入式系统,配有飞控固件,可以通过地面站设置固件参数,简化了无人机的开发流程。

RC 信号可以理解为一个整数数组,其中有些来自摇杆,有些来自按钮,通过遥控器发送给无人机。当然,除了遥控,地面站也能发送这个数组来模拟遥控控制,所以 RC 信号的来源是可以不唯一的。此外,遥控和地面站是不同的东西,虽然在物理上可以把它们封装在一个盒子里。因为我用的是 AMP 模拟器,所以本期所讲的内容也都是基于 APM 飞控平台。

通过mavproxy遥控无人机

由于没有无人机硬件,我首先想到的是能不能通过 mavproxy 来模拟遥控控制。mavproxy 的确提供了 rc 命令来手动控制无人机,但是官网上这部分资料不够详细,对新手不太友好。简单来说就是我们可以通过 rc <channel> <value> 命令来修改某个 RC 通道的值,APM 共有 18 个通道,每个通道的范围都是 0~65535 (2字节无符号整数),有效范围是 1000~2000,对于摇杆,1500 表示中立位置,而 0 和 65536 具有特殊含义。

  • 0 表示将该通道的值释放回遥控器。什么意思呢?也就是采用遥控器上对应通道的值,或者说将该通道的控制权交还给遥控器,为什么呢?因为 RC 输入的来源可以不止是遥控器。
  • 65535 表示忽略该通道的值,通过地面站模拟遥控时,如果不想修改某些通道的值,就可以将这些通道的值都设置为 65535。

在 mavproxy 的控制台,我们可以通过以下命令来查看各个通道的最小值,最大值和中立值,其中 x 是通道编号,取值为 1,2,3…等。

  • param fetch RCx_MIN :最小值。
  • param fetch RCx_MAX :最大值。
  • param fetch RCx_TRIM :中立值。

对于我现在的需求,用不到所有的通道,主要用到的是前4个通道,分别控制无人机的姿态和油门。至于为什么俯仰和偏航不是连着的,我也表示很好奇。

通道含义
RC11000~2000滚转(roll)
RC21000~2000俯仰(pitch)
RC31000~2000油门(throttle)
RC41000~2000偏航(yaw)

首先我们还是通过一键起飞的方式让无人机先飞起来,用 mavproxy 命令行或者 QGC 都可以。一键起飞之后,无人机会处于 guided 模式,这个模式下无人机会飞往地图上点击的位置或者指定的某个经纬度。 guided 模式不支持手动控制,手动模式是 manual ,在 APM 中,它等价于 stabilize 模式,也就是模拟器启动时的默认模式。

不过在使用 mode 切换模式之前,我们需要先使用 rc 3 1500 命令将油门置于中立位置。因为 APM 模拟器启动时,油门默认是处于最低位置的,也就是1000。如果此时直接切换到手动模式,无人机就会因失去动力而坠机,再现经典的“黑鹰坠落”。

Mayday, Mayday! Black Hawk is going down!

现在我们可以使用 mode stabilize 切换到手动模式了。然后我们可以通过 rc 3 1600 让无人机上升, rc 3 1400 下降,或者通过 rc 1 1800 转向。RC1 到 RC4 你可以都试试,如果你还开着 QGroundControl 地面站,可以通过姿态仪和指南针查看无人机状态,因为 mavproxy 的地图没有姿态仪和指南针,所以 QGC 上会看得比较直观。唯一需要注意的就是,小心坠机!

mode guided
arm throttle
takeoff 40rc 3 1500
mode stabilizerc 3 1600
rc 1 1800
... ...

我们已经学会了手动控制无人机飞行,那么能否直接手动起飞呢?

答案是肯定的。因为 APM 模拟器启动时默认就出于 stabilize 模式,因此我们可以直接解锁,然后轰油门起飞。

arm throttle
rc 3 1600

throttle 就是油门的意思, arm 是武装的意思, arm throttle 就是解锁油门。注意在无人机领域,系统状态不是用”已上锁“和”未上锁“来描述,而是用”武装“和”解除武装“来描述。”锁“表示安全,”武装“表示危险,因此他们对状态的表述是相反的,“武装”的含义是解锁,“解除武装”是上锁。

但是在实操上有个需要注意的点,那就是解锁后需要马上轰油门才能成功起飞,否则无人机会重新上锁,导致起飞失败。这个间隔时间很短,这可能跟我调快了仿真速度有关。这其实是因为无人机的自动锁定机制,当无人机落地,电机停转之后,会自动解除武装,是无人机的一种安全保护机制。

如果来不及输入命令,我们还可以先将油门设置为 1500,然后使用 arm throttle force 强制解锁。

rc 3 1500
arm throttle force
rc 3 1600

如果不强制解锁,而是使用 arm throttle ,模拟器就会报错 Arm: Throttle (RC3) is not neutral ,意思是油门处于不正常位置,这也是出于对无人机的保护,防止弹射起步。如果在连续的操作过程中导致油门没有处于最低位,在一键起飞的时候也会看到这个报错,只需要用 rc 3 1000 将油门置于最低位即可。有时候报的错可能不是 RC3,而是其他通道,也是通过 rc 命令将其设置到中立位置(1500)即可。曾经在网上看到过某些无人机在起飞之前要先将油门挡杆扒到最左,其实也是这个原因。

如果想查看 RC 输入和电机输出,可以点击 mavproxy 图形命令窗口(Console)菜单栏的 Tools 菜单。

在这里插入图片描述

然后在弹出菜单中选择 RC Inputs 或 Servo Outputs 就能看到每个 RC 通道的值和电机输出了。

在这里插入图片描述

上图左边就是初始时各 RC 通道的值。

通过代码遥控无人机

知道如何手动控制无人机之后,我们还要知道是怎么实现的。我想知道 rc 命令是如何发送给无人机的呢?首先想到的是抓包,如果我们观察 mavproxy 的启动命令,会发现它设置了三个通信地址:

  • --sitl 127.0.0.1:5501
  • --master tcp:127.0.0.1:5760
  • --out 127.0.0.1:14550

14550 我们已经很熟悉了,这是 mavproxy 转发 mavlink 消息的地址,也是其他地面站连接的地址。 5760 是与模拟器通信的地址, 5501 是与仿真环境通信的地址,也是 UDP 协议。

为了弄清 rc 命令背后的原理,我对 55015760 两个端口进行了抓包,结果显示 rc 命令是通过 5501 端口发送出去的。但问题是发送的数据并不是 mavlink 格式,而是下面这么一串数据。

在这里插入图片描述

为了一探究竟,也只好去看看 mavproxy 的源码了。 rc 命令的源码在 MAVProxy/modules/mavproxy_rc.py 文件中,我们找到 cmd_cr 这个函数。

def cmd_rc(self, args):'''handle RC value override'''if len(args) > 0 and args[0] == 'set':self.rc_settings.command(args[1:])returnif len(args) == 1 and args[0] == 'clear':channels = self.overridefor i in range(self.count):channels[i] = 0self.set_override(channels)returnif len(args) == 1 and args[0] == "status":self.cmd_rc_status()returnif len(args) == 1 and args[0] == "guiin":if not mp_util.has_wxpython:print("No wxpython detected. Cannot show GUI")elif sys.version_info >= (3, 10) and sys.modules['wx'].__version__ < '4.2.1':print("wxpython needs to be >=4.2.1 on Python >=3.10. Cannot show GUI")elif not self.rcin_gui:from MAVProxy.modules.lib import wxrcself.rcin_gui = wxrc.RCStatus(panelType=wxrc.PanelType.RC_IN)returnif len(args) == 1 and args[0] == "guiout":if not mp_util.has_wxpython:print("No wxpython detected. Cannot show GUI")elif sys.version_info >= (3, 10) and sys.modules['wx'].__version__ < '4.2.1':print("wxpython needs to be >=4.2.1 on Python >=3.10. Cannot show GUI")elif not self.servoout_gui:from MAVProxy.modules.lib import wxrcself.servoout_gui = wxrc.RCStatus(panelType=wxrc.PanelType.SERVO_OUT)returnif len(args) != 2:print("Usage: rc <set|channel|all|clear|status|guiin|guiout> <pwmvalue>")returnvalue = int(args[1])if value > 65535 or value < -1:raise ValueError("PWM value must be a positive integer between 0 and 65535")if value == -1:value = 65535channels = self.overrideif args[0] == 'all':for i in range(self.count):channels[i] = valueelse:channel = int(args[0])if channel < 1 or channel > self.count:print("Channel must be between 1 and %u or 'all'" % self.count)returnchannels[channel - 1] = valueself.set_override(channels)

从这个函数中,能看到 rc 命令有很多子命令, channel 就是我们上一节提到的用法, all 可以用来设置所有通道的值。 rc status 可以打印出每个通道的值,但是注意它不是打印的真实通道值,而是本地的副本,默认都是0,如果通道没有修改过,那么打印出来就会是0。而 rc guiinrc guiout 对应的其实就是上一节中 Tools 菜单下的 RC Inputs 和 Servo Outputs 两个子菜单,用这两个命令也能弹出对应的窗口。

回到函数的后半段,函数将命令中设置的 value 首先记录到本地 channels 副本,然后调用了 set_override 函数设置通道值,该函数定义如下。

def set_override(self, newchannels):'''this is a public method for use by drone API or other scripting'''self.override = newchannelsself.override_counter = 10self.send_rc()def send_rc(self):'''send RC override packet'''if self.sitl_output:chan16 = self.override[:16]buf = struct.pack('<HHHHHHHHHHHHHHHH', *chan16)self.sitl_output.write(buf)else:chan18 = self.override[:18]self.master.mav.rc_channels_override_send(self.target_system,self.target_component,*chan18)

set_override 最终调用了 send_rc 函数,而在 send_rc 函数中,将 channels 发送了出去。因为我们启动 mavproxy 时设置了 sitl 参数,所以这里会进入 if 分支,也就是将 RC 通道的值发送到了 5501 端口。而且这里对数据的序列化方式也是直接使用了 struct.pack'<HHHHHHHHHHHHHHHH' 是序列化方式, < 表示采用小端序,每个 H 表示两个字节,也就是 chan16 数组里每个整数用两字节表示,所以我们抓包时抓到 32 字节也就不足为奇了,将它们按每两个字节拆开如下。

dc05 dc05 dd05 dc05 0000 0000 0000 0000 0000 0000 0000 0000 0000 0000 0000 0000

0x05dc 刚好就是十进制的 1500 ,第三个 0x05dd,而我测试用的命令正是 rc 3 1501

下一步我们需要在地面站中通过 mavlink 协议发送遥控信号实现手动控制无人机,这里有两个消息比较重要。一是 RC_CHANNELS (65) ,他是 无人机向地面站发送的当前 RC 通道值。二是 RC_CHANNELS_OVERRIDE (70) ,它是地面站发送给无人机的 RC 控制消息。

一是 RC_CHANNELS (65) ,他是 无人机向地面站发送的当前 RC 通道值。

二是 RC_CHANNELS_OVERRIDE (70) ,它是地面站发送给无人机的 RC 控制消息。要实现手动控制无人机,发送这个消息就行了。

这里给出两篇官方参考文章:

  • RC Input (aka Pilot Input) — Dev documentation
  • https://mavlink.io/zh/messages/common.html#RC_CHANNELS

看吧,一点都不难。


本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:http://www.mzph.cn/web/73049.shtml

如若内容造成侵权/违法违规/事实不符,请联系多彩编程网进行投诉反馈email:809451989@qq.com,一经查实,立即删除!

相关文章

C语言入门教程100讲(4)输入输出

文章目录 1. 什么是输入输出&#xff1f;2. 标准输入输出函数2.1 printf 函数2.2 scanf 函数 3. 格式化占位符4. 示例代码代码解析&#xff1a;输出结果&#xff1a; 5. 常见问题问题 1&#xff1a;scanf 中的 & 是什么作用&#xff1f;问题 2&#xff1a;printf 和 scanf …

《信息系统安全》(第一次上机实验报告)

实验一 &#xff1a;网络协议分析工具Wireshark 一 实验目的 学习使用网络协议分析工具Wireshark的方法&#xff0c;并用它来分析一些协议。 二实验原理 TCP/IP协议族中网络层、传输层、应用层相关重要协议原理。网络协议分析工具Wireshark的工作原理和基本使用规则。 三 实…

城市街拍人像自拍电影风格Lr调色教程,手机滤镜PS+Lightroom预设下载!

调色教程 城市街拍人像自拍的电影风格 Lr 调色&#xff0c;是利用 Adobe Lightroom 软件&#xff0c;对在城市街景中拍摄的人像自拍照片进行后期处理&#xff0c;使其呈现出电影画面般独特的视觉质感与艺术氛围。通过一系列调色操作&#xff0c;改变照片的色彩、明暗、对比等元…

自学Python创建强大AI:从入门到实现DeepSeek级别的AI

人工智能&#xff08;AI&#xff09;是当今科技领域最热门的方向之一&#xff0c;而Python是AI开发的首选语言。无论是机器学习、深度学习还是自然语言处理&#xff0c;Python都提供了丰富的库和工具。如果你梦想创建一个像DeepSeek这样强大的AI系统&#xff0c;本文将为你提供…

Qt/C++项目积累:4.远程升级工具 - 4.1 项目设想

背景&#xff1a; 桌面程序一般都支持远程升级&#xff0c;也是比较常用的场景设计。如酷狗音乐的升级&#xff0c;会提供两个选项&#xff0c;自动帮助安装或是新版本提醒&#xff0c;由用户来决定是否升级&#xff0c;都属于远程升级的应用及策略。 看看经过这块的功能了解及…

(一)丶Windows安装RabbitMQ可能会遇到的问题

一丶可能会忘了配置ERLang的环境变量 二丶执行命令时报错 第一步 rabbitmq-plugins enable rabbitmq_management 第二部 rabbitmqctl status 三丶修改.erlang.cookie 文件 1.找到C盘目下的.erlang.cookie文件 C:\Users\admin\.erlang.cookie C:\Windows\System32\config\sys…

Amdahl 定律

Amdahl 定律是用来表示&#xff0c;当提高系统某部分性能时对整个系统的影响&#xff0c;其公式如下&#xff1a; a表示我们提升部分初始耗时比例&#xff0c;k是我们的提升倍率&#xff0c;通过这个公式我们可以轻松的得知对每一部分的提醒&#xff0c;对整个系统带来的影响…

HW华为流程管理体系精髓提炼华为流程运营体系(124页PPT)(文末有下载方式)

资料解读&#xff1a;HW华为流程管理体系精髓提炼华为流程运营体系&#xff08;124页PPT&#xff09; 详细资料请看本解读文章的最后内容。 华为作为全球领先的科技公司&#xff0c;其流程管理体系的构建与运营是其成功的关键之一。本文将从华为流程管理体系的核心理念、构建…

Powershell WSL导出导入ubuntu22.04.5子系统

导出Linux子系统 导出位置在C盘下,根据自己的实际情况更改即可Write-Host "export ubuntu22.04.5" -ForegroundColor Green wsl --export Ubuntu-22.04 c:\Ubuntu-22.04.tar 导入Linux子系统 好处是目录可用在任意磁盘路径,便于迁移不同的设备之间Write-Host &quo…

【Attention】SKAttention

SKAttention选择核注意力 标题&#xff1a;SKAttention 期刊&#xff1a;IEEE2019 代码&#xff1a; https://github.com/implus/SKNet 简介&#xff1a; 动机:增大感受野来提升性能、多尺度信息聚合方式解决的问题&#xff1a;自适应调整感受野大小创新性:提出选择性内核…

解决Popwindow宽高的问题。

问题 在使用Popwindow进行自定义的过程中&#xff0c;需要设置popwindow的宽高。但是宽高很多时候容易出问题。比如下面的例子。 布局文件如下 <?xml version"1.0" encoding"utf-8"?> <LinearLayout xmlns:android"http://schemas.andr…

MySQL数据库精研之旅第二期:库操作的深度探索

专栏&#xff1a;MySQL数据库成长记 个人主页&#xff1a;手握风云 目录 一、查看数据库 二、创建数据库 2.1. 语法 2.2. 示例 三、字符集编码和校验(排序)规则 3.1. 查看数据库支持的字符集编码 3.2. 查看数据库支持的排序规则 3.3. 不同的字串集与排序规则对数据库的…

基于deepseek的智能语音客服【第四讲】封装milvus数据库连接池封装

通过工厂模式创建链接 static {// 创建连接池工厂BasePooledObjectFactory<MilvusServiceClient> factory new BasePooledObjectFactory<MilvusServiceClient>() {Overridepublic MilvusServiceClient create() throws Exception {return new MilvusServiceClient…

STM32基础教程——定时器

前言 TIM定时器&#xff08;Timer&#xff09;:STM32的TIM定时器是一种功能强大的外设模块&#xff0c;通过时基单元&#xff08;包含预分频器、计数器和自动重载寄存器&#xff09;实现精准定时和计数功能。其核心原理是&#xff1a;内部时钟&#xff08;CK_INT&#xff09;或…

OpenCV旋转估计(4)生成一个字符串表示的匹配图函数 matchesGraphAsString()

操作系统&#xff1a;ubuntu22.04 OpenCV版本&#xff1a;OpenCV4.9 IDE:Visual Studio Code 编程语言&#xff1a;C11 算法描述 matchesGraphAsString 函数是OpenCV库中的一部分&#xff0c;位于 cv::detail 命名空间下。这个函数的主要作用是生成一个字符串表示的匹配图&am…

Android 根据Url使用Retrofit框架进行文件下载

一、背景 根据后端返回的url下载地址,去执行文件下载&#xff0c;将文件保存到SD卡。这里使用Retrofit网络框架。 二、代码实现 2.1、定义一个DownloadFileService interface DownloadFileService {StreamingGETsuspend fun downloadFile(Url fileUrl: String):ResponseBody…

NVMe(Non-Volatile Memory Express)详解

一、NVMe的定义与核心特性 NVMe&#xff08;非易失性内存主机控制器接口规范&#xff09;是一种 基于PCIe总线的高性能存储协议&#xff0c;专为固态硬盘&#xff08;SSD&#xff09;设计&#xff0c;旨在替代传统的AHCI协议&#xff08;如SATA&#xff09;。其核心特性包括&a…

机器学习——KNN超参数

sklearn.model_selection.GridSearchCV 是 scikit-learn 中用于超参数调优的核心工具&#xff0c;通过结合交叉验证和网格搜索实现模型参数的自动化优化。以下是详细介绍&#xff1a; 一、功能概述 GridSearchCV 在指定参数网格上穷举所有可能的超参数组合&#xff0c;通过交叉…

稳定运行的以Oracle NoSQL数据库为数据源和目标的ETL性能变差时提高性能方法和步骤

提高基于Oracle NoSQL数据库的ETL&#xff08;提取、转换、加载&#xff09;性能时&#xff0c;主要从多个角度进行优化。 提高基于Oracle NoSQL数据库的ETL性能需要综合考虑多个方面&#xff0c;关键是减少不必要的I/O操作、优化数据转换和加载过程、合理配置Oracle NoSQL数据…