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

路径规划与控制算法

系统先根据已验证地形检查路径,再生成推进指令。Gazebo计算得到的实际运动会反馈到下一次规划与控制。

个人水下航点规划使用任务深度限制。更大的仿真上限仍保留以下地形及载具扫掠范围检查。

处理流程

  1. 1. 目标、测量状态与地形

    将地理目标转换到本地坐标系,把已确认的数值地形瓦片拼接到公共网格中。缺失覆盖仍按未知区域处理。

  2. 2. 地理与沿岸引导

    寻找避开陆地的连接和港口进出通道。地图上避开陆地并不能证明水深足够。

  3. 3. 检查船体扫掠范围

    给船体增加跟踪余量,将海底三角形裁剪到每个查询方格内,找出最高底面;拒绝陆地、净空不足和缺失数据。最大值滤波器加速明显深水区域的检查。

  4. 4. 先直线,再A*绕行

    先尝试经过检查的直线,否则在八邻域格点上使用距离代价和欧氏距离启发式进行A*搜索,同时约束拐角、半径、长度和时间。

  5. 5. 缩短并重新验证

    捷径仍需通过同一套扫掠检查,保留受保护的港口进近点。返回已检查航点和最小净空;找不到可用路线则报告错误。

  6. 6. 速度策略与推进

    领航艇在转弯或航向误差较大时减速,再使用加速斜坡、PI速度控制和差动推力。跟随艇沿领航艇实测轨迹前视引导,并按倾斜和接近速度限制指令。

  7. 7. 测量反馈与更新

    Gazebo施加力并返回运动状态。系统监测进度、稳定性以及地形和传感器覆盖,在未验证区域前等待;新目标或条件变化可触发重新规划。

停滞恢复持续较长时间时,LIVE 可使用已检查的外海航道。恢复移动后,系统会定期尝试返回地图海岸并沿岸前进。每段推进仍须通过地图陆地和数值水深检查。固定港口进近点仍为必经点,船只通过已检查的航道接入。

LIVE航行将地图上的沿岸连接用作临时引导。当实测位置比连接的最后一个参考点更接近航路目标至少50 m时,系统解除该引导并重新规划后续路径。每条新的推进通道仍须通过地图陆地排除和数值水深检查。

区域恢复反复尝试后,若十分钟内仍无实测进展,LIVE可在16 km的地形窗口中搜索通向航路的完整连接。系统按顺序经过选定的转折点,并依据当前原生地形和地图陆地逐段核准推进路径。

规划技术目录

层级 方法与适用范围
地理路线 港口目标、到达门点、通道和陆地多边形生成远距离引导。港口目录坐标与可航行到达点相互独立。
地形场 将已确认数值网格统一到公共坐标系。精确裁剪三角形以求最高底面,利用SciPy最大值滤波结果作上界。未知或越界区域仍不可用,卫星颜色不作为水深。
扫掠净空 沿段最多每1 m采样一次,并给查询范围增加半个采样间距。变深度航段采用较深端点。这是保守地形包络检查,不是对未来六自由度船体运动的完整预测。
局部搜索 直线优先,随后使用八邻域A*和保守拐角检查。常用默认值:格距4 m、搜索半径600 m、路线长2,000 m、规划时间预算25 s。调用方可指定其他边界。
载具余量 水面:船体半径3.5 m、初始跟踪余量4 m、离底净空1.5 m。水下:分别为0.5 m、2 m、1 m。个人WAM-V可将跟踪余量缩至2 m,但不放宽深度净空。
结果与监测 返回检查后的航点、所选余量、网格与预算信息、表示地形上的最小净空。走廊或覆盖检查可停止执行。规划失败、跟踪偏离和数据缺失是不同状态。

这些余量基于所表示的地形,并不认证水文测量精度。存在一条有效路线也不保证控制器在所选环境中成功跟踪。AIS标记、画面中的船舶或可用LiDAR话题,都不能证明已实现动态避障或COLREG合规;这取决于实验使用的控制器。

LIVE已加载地形上的沿岸恢复

搜索使用已加载的数值地形并排除地图陆地。常规距岸1.5 km范围会直接限制搜索。如果其中没有验证通过的前进走廊,可进行有限绕行,最远到距岸2 km,并在终点回到常规范围内。

原生执行会再次检查每个有界分段。新的恢复终点避开最近逃离的区域。完整检查过的前进走廊可以穿过该区域并继续向前;如果前进量不足50 m,则全路径都需避开。恢复历史限制不会改变船体物理安全检查。

控制通路与反馈

通路 输入、实现与输出 解释
个人ArduPilot 引导目标或手动输入 → 通过MAVROS和Gazebo JSON接口运行ArduRover/ArduSub SITL → 执行器通道。 导航来源、EKF、模式、解锁状态及执行器映射均会影响结果。见GNSS 与导航。
ROS 2直接控制 用户节点 → 允许的话题和选定执行器映射 → Gazebo作用力。 控制律由用户提供。发布目标或速度不等于测得已实现的运动。
航海领航艇 检查后的航点 → 弯道制动、航向误差减速、加速斜坡、积分限幅PI和差动推力。 使用实测机体运动反馈,标称周期0.05 s;心跳丢失时抑制指令。
航海跟随艇 领航艇实测轨迹、间距与接近速度 → 前视引导、速度/转弯限制和制动 → 推进。 船体原点间标称间距38 m。这是演示控制器,不是船队避碰证明。
恢复 显式恢复策略可请求有界物理拖曳,保留质量、接触和阻力。 应单独记录此模式。领航艇拖曳上限为900 N,请求恢复速度0.8 m/s。

在配置了 GNSS 的会话中,任务会在解锁和导航稳定后,从测量位置重新验证路线,再发送第一个目的地。稳定条件要求新鲜的 FCU 局部位姿,以及有效的 GNSS 融合或已接受的外部传感器融合。接收机的原始 GPS 定位状态单独保留,见GNSS 与导航。

个人 WAM-V 任务默认使用输入整形(GUID_OPTIONS=0)。未明确指定航向时,在 0.75 m 到达半径外每隔 2 秒仿真时间更新原始位置目标,在半径内请求零速度和零偏航角速度。已启用位 64 的保存配置保留 ArduRover 的 S 曲线航点规划器。BlueROV2 使用 ArduSub 航点控制器,每隔 2 秒仿真时间更新位置目标。遥测新鲜度按实际经过时间判断;航行期间持续检查导航状态和地形间距。

动力船收到速度和偏航角速度均为零的有效 Guided 目标时,随包提供的 ArduRover 会持续运行速度 PID,抑制前后方向的漂移。该控制调节速度;朝指定位置的修正仍在到达范围之外开始。帆船、已过期的目标和其他控制模式保留各自配置的停止行为。

当加速度限制后的目标速度为零时,速度控制器在首次测得停止时清除积分值。在设定的停止速度范围外,还会清除将船舶沿当前漂移方向加速的累积积分值。与漂移方向相反的制动积分和停止速度范围内的补偿保持有效。

个人默认配置使用 WP_SPEED=0.5 m/s、ATC_STOP_SPEED=0.02 m/s 和 ATC_STR_RAT_I=0。

SITL 插件在已计算完成的物理状态之间插值传感器数据,Rover 的目标频率为 200 Hz,Sub 为 1000 Hz。改变物理时间间隔会改变中间样本数量。每个区间都以原始物理状态和时间戳结束。物理分辨率仍由物理仿真步长决定。

公开WAM-V演示选择输入整形方式(GUID_OPTIONS=0),每两个仿真秒更新原始航点。演示使用WP_RADIUS=0.2 m、LOIT_RADIUS=0.1 m和LOIT_SPEED_GAIN=1.0进行接近和波浪中的定点保持。任务到达仍要求水平误差在0.75 m以内。个人工作区保留所选控制器参数。

检查点恢复和浮动原点变化也会改变状态或坐标。原点平移会转换地形、路线和轨迹位置,但保持物理速度;不能把坐标跳变微分成真实航行速度。分析跟踪误差或能耗时,应保留恢复、重置和原点变化事件。

原生领航/跟随算法用于LIVE航海。个人会话使用所选ArduPilot或ROS 2通路。个人WAM-V先按3.5 m船体半径加4 m跟踪余量规划;若起点或通道被阻挡,则以2 m跟踪余量重试,仍保持1.5 m深度净空。离开所选走廊会停止任务。

实现与相关文档

POSIM-Routing实现导航、规划和沿岸/港口连接。POSIM-Control包含Pilot.cc和Follower.cc,其Python策略负责速度与稳定性。WWW-POSIM协调会话、选择控制器并实施个人任务限制。请使用应用选定的修订版。

LIVE 全球航行 · 控制桌面版工作区 · 地形生成流程与算法

搜索文档