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

GNSS 与导航

WAM-V和BlueROV2应用会话默认启用POSIM模拟卫星GNSS接收机。BlueROV2可在设置中明确关闭。两者使用相同的传感器约定、天线连杆和话题。GNSS测量状态与飞控估计位置分别标识。

实现目录

阶段 方法 参数与输出
天线运动学 原生Gazebo插件posim::Gnss观测真实天线连杆,包含机体旋转与杆臂。 link_name、pose;地理位置及有限差分速度。
测量误差 采用有随机种子的独立高斯位置、速度扰动。 horizontal_stddev、vertical_stddev、velocity_stddev、seed;对角协方差。
可用性 波面浸水检查、滞回、连续重捕获与显式遮挡输入。 water_level、wave_topic、dry_margin、reacquire_seconds、enabled;定位、捕获中、浸没、遮挡、不可用。
时序 仿真时间采样与延迟测量队列。 update_rate、latency;保留原始采样时间戳。
ROS与飞控 验证历元、时间和有限值,发布定位/状态,并将接受的测量转换为MAVLink GPS_INPUT。 传感器别名、飞控原始GPS与融合估计保持可区分。
显示与任务 数据新鲜度和EKF状态决定就绪及任务限制。 融合指示是状态解释,不提供每次观测的全部滤波新息。

接收机实现与配置定义传感器;WWW-POSIM增加ROS转换、导航源选择和任务集成。参阅传感器模型与参数。

测量与估计

输出 含义
/model/{robot}/gnss/fix 传感器NavSatFix,带配置噪声的天线位置。
/model/{robot}/gnss/status 接收机状态与原始测量时间,格式为std_msgs/String中的JSON。
/vehicle/gnss/fix、/vehicle/gnss/status 同一测量的当前载具别名,不是第二个GPS注入源。
/mavros/global_position/raw/fix ArduPilot接收并经MAVROS转换的GPS。
/mavros/global_position/global 飞控融合位置估计。
/mavros/local_position/pose 飞控本地融合位姿,ENU。
/model/{robot}/odometry 用于3D显示、地形安全和验证的仿真参考值;不是地图经纬度来源

测量在Gazebo进程中产生,适配器将接受的测量转换为接收机ID 0的GPS_INPUT。ArduPilot配置选择MAV接收机,关闭第二接收机和SITL合成GPS,使用GPS水平位置/速度与罗盘偏航。即使关闭GNSS,也不会向飞控注入基于真值的视觉位姿或速度。单天线不提供静止航向测量,运动中的GPS航迹方向也不同于机体朝向。

GNSS配置根据receiver.velocity_stddev设置水平速度噪声下限EK3_VELNE_M_NSE,并将其限制在文档规定的0.05–5 m/s范围内(默认0.1 m/s)。接收机报告的速度精度可能提高实际下限。此设置调整EKF权重,模拟测量噪声保持不变。

WAM-V的Gazebo IMU经ArduPilot JSON接口提供加速度和角速度,罗盘使用SITL磁场模型。这是理想化仿真依赖,并非从GNSS天线推导静止航向。

航点使用飞控地理EKF原点,到达判定使用估计位置。仿真真值仍用于轨迹评估和地形安全检查,但不会通过对齐消除GNSS水平误差。新鲜定位不能单独证明导航滤波健康;界面另外报告EKF有效性。融合指示综合配置来源、传感器新鲜度与EKF标志,不是逐观测新息日志。

在配置GNSS的任务中,解锁后,任务要求新鲜本地位姿及GNSS或已接受外部导航的融合状态持续2个实际秒,才请求GUIDED。条件丢失会重新计时,35秒内未稳定则停止任务。接收机重捕获使用独立的仿真时间计时器。

Web与安装版在飞控连接后,以仿真时间5 Hz请求EKF状态、系统状态和心跳。超过3个实际秒的状态被拒绝。定位通过时钟验证期间,适配器每0.2个实际秒重发有效状态,但保留原始测量时间戳。每次GPS输入与传感器定位都来自新的已接受测量。时钟停止或测量过期会使接收机无效。

配置与坐标系

posim_gz_gnss/config/profiles.json定义接收机和安装变换。SDF包含base_link → gnss_link → gnss,位姿发布器通过TF暴露真实层级。WAM-V天线在base_link上方1.8 m,BlueROV2天线为0.3 m。该连杆增加0.001 kg质量。

真值使用map与模型连杆,估计使用fcu_map及TF map → fcu_map → fcu_base_link。第一段变换把报告的EKF地理原点投影到地形基准,不会拟合真值。垂向平移假定为零,保留本地气压零点近似,不声称是测绘高程。传感器安装TF属于真值层级;测绘处理应将同一安装外参应用到估计机体位姿,并保留测量时间。

量 默认值
地理坐标 WGS 84纬度/经度,单位度;世界球面坐标定义基准。
本地坐标 ENU:东、北、上;世界朝向0°。
机体坐标 FLU;天线偏移转为FRD时为x、−y、−z。
速度 天线在测量间隔内的位移,旋转到ENU;GPS_INPUT使用北、东、下。
杆臂 测量前按几何应用,并将同一机体偏移交给ArduPilot。
位置标准差 东、北各0.7 m,垂向1.2 m。
速度标准差 每轴0.1 m/s。
协方差 已知ENU对角值0.49、0.49、1.44 m²。
频率/延迟 仿真时间5 Hz/0.2 s。
有效性 拒绝重复、逆序、非有限、未来或超过0.6秒的旧测量;以0.8个实际秒监测仿真时钟推进。

应用保留原始时间戳,中继0.2–0.5个仿真秒前测得的局部波浪单元。缺失单元仍然无效;接收机继续要求局部有限数值并检查天线浸水。 | 时间 | 延迟后仍保留采样时间;确定性的GPS周2296加已过仿真时间。 | | 质量占位值 | 12颗卫星、HDOP 1.0、VDOP 1.5,不计算卫星星座。 | | 随机性 | 种子42,独立高斯位置与速度误差。 |

默认世界使用海面高程0 m和合成零大地水准面差,因此传感器高度与GPS_INPUT的MSL高度一致。MAVROS报告椭球高时应用已安装的EGM96转换,可能与传感器话题不同。绝对垂向大地测量尚不具备测绘资质验证。深度仍相对本地水面。GNSS+IMU+深度的多波束流程必须保留坐标系、采样时刻和垂向基准假设。

浸水、失锁与恢复

接收机比较天线世界高度与本地水面,并包含载具旋转的影响。应用世界使用物理波浪求解器的局部高度场,通过双线性插值取样。水面样本超过0.6个仿真秒时接收机不可用。独立POSIM模型在未提供波浪话题时使用配置的平均水面。

天线处于水面或以下时,定位立即失效,延迟队列被清空。只有高出水面0.05 m才开始捕获,需连续3个仿真秒。已锁定的接收机在干燥余量内仍有效,直到到达浸水边界。滞回与计时避免波浪附近快速反复切换。

无定位时坐标为NaN。适配器发送明确无有效位置的GPS_INPUT,不会给旧坐标附上新的采样时间。重置会清空队列和捕获状态,推进接收机历元并重新验证时钟。

水下失去定位后仍可使用姿态、深度及推力手动控制浮出水面。绝对位置任务需要新鲜有效的传感器驱动FCU导航估计。WAM-V启动要求新GNSS定位或经过验证且已接受的外部来源,并满足其他解锁检查。

Gazebo布尔输入/model/{robot}/gnss/blocked表示人为施加的接收遮挡。风速不是GNSS关闭开关;风可能推动或倾斜载具,并通过波浪淹没天线。卫星几何、建筑、多径、大气传播、射频干扰和天线方向图均未进行物理仿真。高斯误差、遮挡开关和浸水规则是简化测试模型,不是实测射频性能。

BlueROV2设备说明

可选接收机是仿真载荷,不表示标准BlueROV2标配卫星GNSS,也不代表厂商提供该GNSS集成套件。

Water Linked集成结合水面地理参考和水下声学定位,也提供DVL与UGPS组合说明。它们是独立设备与测量通路;此卫星接收机不实现声学UGPS。

GPS.gov说明真实定位精度的影响因素。仿真标准差属于应用设置,不是GPS服务保证。外部页面仅作参考,接收机不附带产品图片、手册或厂商代码。

基于传感器的地图位置

Ground Control使用新鲜GNSS天线测量,或FCU网关接受的有效外部估计,不用仿真坐标补位。GPS fixed显示绿色,GPS lost显示红色,并区分未知、过期和无效。GPS定位与导航就绪是不同状态。

GPS fixed时仅显示GPS标签。GPS lost且存在经过验证的最新估计值时,也显示位置估计 ON。需要水下估计但不可用时,显示位置估计不可用。点击、触摸或用键盘打开ON旁的信息按钮,即可查看方法和文档链接;按Escape关闭。不显示坐标数值。在地图下方展开导航详情,可查看支撑装置、初始基准点和传感器初始化状态。

IMU/DVL估计器使用原始角速度、比力及有效海底相对速度,保留传感器时间、安装变换和协方差,不使用Gazebo姿态。局部里程计本身不能确定地理位置或航向。

内置BlueROV2 · KMOU使用场景指定初始坐标,以及应用配置磁偏角后的磁力计实测航向。初始参考点与GPS分开显示。临时仿真支撑在相机准备和静止初始化期间保持载具。正常ALT_HOLD解锁并接受导航后,解除支撑并确认实际关节已移除。初始坐标不会用仿真真值持续更新。

此静止初始化配置仅用于该内置演示,不自动用于保存载具或任意世界。通用GNSS运动对齐尚未获准输出地理坐标。局部诊断保持navigation_ready=false;公共网关另行检查新鲜数据、有效原点和协方差、来源选择确认及FCU EKF/全球位置遥测,再确定地理估计就绪状态。

DVL丢失、输入过期、重置或新分段会使估计失效。地图移除估计坐标并显示失败。DVL恢复传输不会重新使用初始锚点,需重启仿真。浮出水面后的新GNSS定位可以恢复地图位置,但不会自动重新初始化水下估计器。

ArduPilot、QGC与可替换提供程序

GNSS进入GPS_INPUT和EKF来源1。已接受的外部位置/速度进入MAVROS vision pose/speed和来源2。默认GNSS的WAM-V不会启用未使用的视觉里程计输入。明确选择外部提供程序后,两种载具都使用同一受检查路径。

QGC通过GPS_RAW_INT接收GPS有效性,通过GLOBAL_POSITION_INT接收融合位置。因此GPS无定位时仍可能有有效FCU估计位置。估计不会更改GPS定位标志。使用 QGC 控制在交接控制前要求锁定电机,水下载具可能因浮力上升。

安装版扩展可选择经批准、绑定哈希并在SDF声明的ROS提供程序。/vehicle/navigation/estimate以nav_msgs/Odometry传输ENU位姿和机体FLU速度;/vehicle/navigation/status传输匹配的会话、时间、原点、就绪元数据及来源。网关拒绝过期、不匹配及重复发布者。GNSS有效性仍由接收机决定。参阅控制桌面版工作区。加载提供程序不代表地理精度或任务就绪已获保证。

搜索文档