WWW-POSIM v0.6.16仿真器文档
文档菜单
WWW-POSIM / 仿真器文档

使用 Python 控制 ArduPilot

使用 Python 控制个人 Autopilot 工作区中的一台 WAM-V 或 BlueROV2。ArduPilot 负责所选模式和执行器混控,回调函数提供手动输入。无需多载具世界。

准备环境

使用 WWW-POSIM 0.6.16 或更新版本及 SDK 0.4.3。以 Autopilot 模式启动个人世界,等待导航和解锁前检查就绪。停止任务、释放手动控制并断开 QGC。保持桌面版应用和工作区打开。在ROS 终端与连接中准备的 Python 终端内安装 SDK:

python -m pip install --upgrade https://github.com/IOES-Lab/homebrew-www-posim/releases/download/v0.6.16/www_posim_ros-0.4.3-py3-none-any.whl

向 WAM-V 发送短时输入

确认载具周围水域畅通。将代码保存为 ardupilot_manual.py,在同一终端运行 python ardupilot_manual.py。它切换为 MANUAL、解锁,发送两秒的小幅前进输入,并在清理阶段请求锁定:

from www_posim_ros import ArduPilotSession

with ArduPilotSession.local(control=True) as sim:
    sim.set_mode("MANUAL")
    try:
        sim.arm(True)
        sim.control_manual(
            lambda elapsed: {"x": 0.2, "r": 0.0},
            duration=2.0,
            gain=0.25,
        )
    finally:
        sim.arm(False)

输入与控制权

回调接收已过去的实际秒数并返回字典。x、y、z、r 轴范围为 −1 到 1,省略的轴为零。WAM-V 支持 x 和 r,BlueROV2 支持四个轴。这些是归一化输入,不是 m/s 或牛顿。持续时间大于零且不超过30秒。gain 范围为0.1–0.35,建议先用0.25。

辅助方法以中立输入获取控制权,以最高10 Hz更新;完成、中断或回调出错时发送中立输入并释放控制权。0.6秒没有有效更新时,watchdog 会停止手动输入。sim.stop() 和退出会话会释放输入,但不会锁定或切换模式。示例会另外请求锁定。中立输入不会消除惯性或波浪作用力。

模式和解锁请求会等待飞控确认。WAM-V 支持 MANUAL、HOLD、STEERING;BlueROV2 支持 MANUAL、STABILIZE、ALT_HOLD。其他手动控制器、任务或 QGC 可能阻止请求。世界变更或控制权过期后会终止控制,不会自动重新获取。若清理请求被拒绝,请先在工作区确认当前控制方和载具状态,再重试。

网页工作区与 ROS 遥测

连接自己的网页工作区时,将 with 行替换如下。密码应在终端提示中输入,不要写入源代码:

with ArduPilotSession.remote(email="YOU@example.com", control=True) as sim:

两种连接均可使用 sim.topics 和 sim.latest(topic) 读取最新 ROS 消息字典。读取遥测不会授予 ROS 指令权限。控制桌面版工作区需要 ROS 2 模式;本章通过 ArduPilot 发送请求。使用 QGC 控制之前请关闭 Python 控制器。

搜索文档