AnyMath 文档

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")

容器中运行两个进程:

  1. ArduPilot SITL(n.弓形,弓形)在计算模拟的物理参数的模式中 AnyMath . 在这种模式下,自动驾驶仪不计算设备本身的物理:它发送 AnyMath PWM电机控制帧通过UDP每个端口 9002 并期望响应具有传感器数据的JSON帧。 交换是同步的(锁步);交换频率在自动驾驶仪参数文件中设置(参见自动驾驶仪参数)。

  2. 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 (диагностика)

港口

港口 方向感 委任事宜

UDP9002

阿杜皮洛*西特尔? AnyMath

PWM帧从Ardupilot SITL在 AnyMath ,JSON传感器帧从 AnyMath 在Ardupilot SITL

UDP14550

MAVProxy→GCS

地面站的MAVLink遥测

UDP14551

MAVProxy→ AnyMath

用于MAVLink块的MAVLink遥测

UDP14552

MAVProxy→ AnyMath

诊断学

需要安装什么

码头工人

窗户* — Docker桌面。 WSL2是自动安装的,不需要手动配置任何东西。 Linux*-Docker引擎和compose插件:

+

sudo apt-get update
sudo apt-get install -y docker.io docker-compose-v2

AnyMath 具有硬件支持包

安装或更新*Engee子系统。集成*,如图所示 文章,-它是必需的块 Ardupilot*及 *MAVLink.

推出

窗户

  1. 安装并运行Docker Desktop,等待就绪状态。

  2. 推出 windows\build_and_run。蝙蝠 从目录 阿杜皮洛至锡特尔航线. 第一次构建大约需要30分钟(由ArduPilot克隆并编译),随后的运行需要几秒钟。

  3. 检查容器是否已提起:

    docker ps -a

在容器处 ap_物理学 必须有一个状态 最多X分钟.

Linux操作系统

  1. 使脚本可执行并运行它:

    chmod +x linux/build_and_run.sh
    bash linux/build_and_run.sh
  2. 检查容器的状态:

    docker ps -a

容器日志: docker logs-f ap_physics.

定制化 AnyMath

  1. 在 AnyMath 打开示例模型 example_engee_ardupilot_flight。工程师 从支持包示例目录(例子_ardupilot).

  2. 执行脚本 Quadcopter_Parameters。ngscript -它设置了设备物理参数:质量,电机相对于质心的位置,螺钉的速度限制和调节器的系数。

  3. 运行模拟。 该模型包含一个子系统 Ardupilot控制 与块 Ardupilot Setup, *Ardupilot RX*及 *Ardupilot TX*配置为UDP 127.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_主机)-共享文件不需要更改。

诊断学

问题 检查什么

货柜 ap_物理学 处于退出状态

docker日志ap_physics -Ardupilot SITL的构建或启动错误

模型停止并出现错误 ArduPilot锁步超时等待PWM

容器是否在运行;UDP端口是否忙 9002 通过另一个进程;on*Windows*—防火墙中是否允许流量

地面站(GCS)中没有遥测

GCS是否监听UDP 14550;容器状态(码头工人ps-a)