ArduPilot SITL:运行cosimulation的基础设施
Ardupilot支持包的例子包括现成的ArduPilot SITL环境:ArduPilot自动驾驶仪(copter) n.弓形,弓形),组装用于计算物理模拟参数的环路(SITL)模式的软件,以及用于遥测传输的MAVProxy。
文章中使用的基本概念: *SITL(循环中的软件)是一个模拟器,允许您在没有硬件飞行控制板的个人电脑上运行ArduPilot自动驾驶仪固件。 在仿真模式下,SITL不计算设备本身的物理场,而是从外部接收。
共仿真是一个联合计算,其中设备的物理计数 *AnyMath ,且控制逻辑为ArduPilot SITL;各方通过UDP同步交换数据。
锁步-同步交换 «一帧一帧» 在进行下一步计算之前,双方都等待对方的响应。 *PWM帧是一组电机的控制信号(脉冲宽度调制),由SITL发送到 *AnyMath . JSON传感器帧响应 *AnyMath 使用JSON序列化的虚拟传感器数据(位置,方向,速度)。 *MAVProxy是在命令行上运行的开源轻量级地面控制站(GCS),专为使用MAVLink协议(例如,ArduPilot)的系统而设计;它在此基础架构中将遥测中继到外部。 *Gcs(地面控制站)是地面计算机上的软件应用程序,与自动驾驶仪无线通信,用于参数设置,任务规划,实时监控和手动飞行控制。
基础设施如何运作
运行模拟的基础设施是Docker容器。
容器位于支持包示例目录中(例子_ardupilot/ardupilot-sitl). 获取支持包的示例 AnyMath 您可以使用命令:
engee.package.getdemos("Engee-Device-Manager")
容器中运行两个进程:
-
ArduPilot SITL(
n.弓形,弓形)在计算模拟的物理参数的模式中 AnyMath . 在这种模式下,自动驾驶仪不计算设备本身的物理:它发送 AnyMath PWM电机控制帧通过UDP每个端口9002并期望响应具有传感器数据的JSON帧。 交换是同步的(锁步);交换频率在自动驾驶仪参数文件中设置(参见自动驾驶仪参数)。 -
MAVProxy*连接到Ardupilot SITL并将MAVLink遥测中继到外部。 这种方法允许单个遥测流一次到达多个使用者:在UDP端口上。
14550-对于地面站(GCS),在14551-为 *AnyMath ,上14552-用于诊断。
交换计划:
ArduPilot SITL (контейнер) Engee
ШИМ-кадр, UDP 9002 ---------> Ardupilot Setup / Ardupilot RX
<--------- JSON-кадр сенсоров, UDP 9002 (Ardupilot TX)
MAVProxy (контейнер)
телеметрия MAVLink ----------> UDP 14550 (наземная станция GCS)
UDP 14551 (блоки MAVLink в Engee)
UDP 14552 (диагностика)
推出
定制化 AnyMath
-
在 AnyMath 打开示例模型
example_engee_ardupilot_flight。工程师从支持包示例目录(例子_ardupilot). -
执行脚本
Quadcopter_Parameters。ngscript-它设置了设备物理参数:质量,电机相对于质心的位置,螺钉的速度限制和调节器的系数。 -
运行模拟。 该模型包含一个子系统
Ardupilot控制与块 Ardupilot Setup, *Ardupilot RX*及 *Ardupilot TX*配置为UDP127.0.0.1:9002;模型计算步骤的频率根据来自参数文件的自动驾驶仪周期的频率设置。
启动顺序:首先是容器,然后是模型 AnyMath -区块 *Ardupilot Setup*等待从Ardupilot SITL的第一个PWM帧期间 5 模拟开始后几秒钟。
地面站(GCS)
地面站是可选的模拟: AnyMath 通过UDP直接与自动驾驶仪通信 9002. 但是,MAVProxy将MAVLink遥测中继到外部:到UDP端口 14550 -对于地面站,上 14551 -为 AnyMath ,上 14552 -用于诊断。 由于这一点,几个消费者可以在同一时间连接到遥测:例如,从地面站监控飞行和控制设备,而相同的数据继续流向 AnyMath 前往港口 14551.
要接收遥测,请将地面站配置为使用ArduPilot协议并通过端口上的UDP接收数据。 14550.
自动驾驶仪设置
ArduPilot的行为由参数文件配置 common/engee_physics。帕尔姆,其安装在容器中。 参数文件是ArduPilot的标准配置方法:它设置仿真循环和主控制回路的频率,调节器的系数(角度,角速度,位置轮廓),电机参数,加固条件和其他自动驾驶仪设置。
档案 engee_physics。帕尔姆,容器自带的,属于demo模型 example_engee_ardupilot_flight。工程师 从支持包的示例目录:它是为设备和这个特定模型的物理配置的。 对于自己的模型,创建自己的参数文件。 其中的交换频率应与计算模型的步骤相对应,自动驾驶仪设置应与设备的类型和设计相对应。
在该文件中设置了仿真模式下的交换频率,这是计算模型的步骤。 AnyMath 必须匹配它。
要更改参数,请编辑 common/engee_physics。帕尔姆 并重新启动容器(再次运行 build_and_run。蝙蝠 / build_and_run.sh).
设备的默认归属点: -35.363261, 149.165237, 584, 0 (纬度,经度,高度,方向)。 它可以通过环境变量进行更改。 首页_LOC 在文件中 码头工人组成。yml.
网络
互动 AnyMath 并且容器不需要手动端口配置: AnyMath 始终侦听UDP端口 9002 在你的车上(地址 127.0.0.1),容器自行将其包裹运送到那里。
Windows*—容器在Docker Desktop bridge网络上运行,并通过以下方式访问主机 主机。码头工人。内部;所有流量都是出站的,因此容器数据包最终在UDP上 9002 汽车与 AnyMath .
Linux*-容器在主机网络上运行并与 AnyMath 及地面站直接经 127.0.0.1.
平台之间的差异已经被考虑在内 码头工人组成。yml 对于他们每个人(变量 SIM_主机 和 GCS_主机)-共享文件不需要更改。