POSIM v1.0.1Platform for Ocean Simulation · 文档
文档菜单
POSIM / 插件参考

海洋GNSS

posim_gz_gnss 在模型的天线连杆处模拟卫星导航接收机。它将世界位置转换为地理坐标,加入可配置的高斯误差,在同一消息中发布位置、速度、时间戳和状态,支持水下失锁、显式遮挡、重新捕获和延迟。

构建并安装接收机

在按安装方式准备好的终端 A中运行;macOS 使用 RDP 桌面内的 Linux 终端:

cd "$POSIM_WS"
source /opt/ros/lyrical/setup.bash
colcon build --merge-install --packages-select posim_gz_gnss posim_robot_models
source install/setup.bash

模型需要按预期位姿连接到机器人上的实体天线连杆,通常名为 gnss_link。世界需配置 WGS 84 坐标。在模型 SDF 中添加:

<plugin filename="libposim_gnss.so" name="posim::Gnss">
  <link_name>gnss_link</link_name>
  <topic>/model/my_robot/gnss</topic>
  <enabled>true</enabled>
  <water_level>0</water_level>
  <update_rate>5</update_rate>
  <latency>0.2</latency>
  <reacquire_seconds>3</reacquire_seconds>
  <dry_margin>0.05</dry_margin>
</plugin>

按机器人实际情况修改连杆和话题。创建机器人介绍了模型准备与启动方法。

配置文件提供相对 base_link 的安装位置:WAM-V 的 z = 1.8 m,BlueROV2 为 0.3 m,REXROV 为 0.8 m。WAM-V 和三种 BlueROV2 配置启用接收机,REXROV 默认停用。这些是安装配置数据,仍需将天线连杆和插件加入模型。WAM-V 还需要外部 Wave Sim 模型。

BlueROV2、BlueROV2 Heavy 及声呐版本包含接收机和 marine_gnss_input 适配器。启用 ArduSub 时,适配器通过 MAVROS GPSINPUT 提供定位,代替 SITL 合成 GPS。速度从 ENU 转为 NED;安装的 GeographicLib 数据将 WGS 84 椭球高转换为 EGM96 平均海平面高。水下、遮挡、无效、未来或超过 1 s 的过期测量均发送未定位状态。有效定位的卫星数为未知(255),不计算卫星几何和 DOP。示例接收机使用平均水面 z = 0,与显示的波浪独立。

参数

SDF 参数 单位或含义 默认值
update_rate 每仿真秒采样数;大于 0 且不超过 100 Hz 5
latency 测量交付延迟,仿真秒;0–10 s 0.2
reacquire_seconds 持续露出水面的捕获时间,s 3
dry_margin 捕获所需的水面上方净空,m 0.05
horizontal_stddev 水平位置标准差,m 0.7
vertical_stddev 垂直位置标准差,m 1.2
velocity_stddev 速度标准差,m/s 0.1
water_level 未设置波浪话题时的平均水面 z,m 0
seed 接收机随机种子 42
enabled 启用接收机 true
link_name 模型内的天线连杆 gnss_link
topic Gazebo 测量话题 /model/<model-name>/gnss
wave_topic 可选的水面高度话题 空

数值设置必须有限。延迟、捕获时间、净空和标准差必须非负。

局部水面高度

wave_topic 为空时使用平均水面。设置该话题后,必须收到新鲜的局部水面采样;数据缺失或无效时进入 surface unavailable。

gz.msgs.Double_V 按顺序包含:模式版本 1、网格尺寸、X/Y 周期尺寸、风速和风向角、波陡、仿真时间,以及按行排列的高度值。

兼容的发布端需单独配置。风的元数据不控制接收状态。

读取测量与遮挡状态

启动配置好的模型后,在准备好的终端 B 中读取话题:

gz topic -e -t /model/my_robot/gnss

每条消息包含 15 个双精度数,索引从零开始。定位结果延迟到达时,仍应保留其采集时间戳。

索引 字段与单位
0–3 模式版本 1、重置标识 epoch、采集时间(仿真秒)、状态
4–6 纬度(度)、经度(度)、海拔(m)
7–9 向东、向北、向上速度,m/s
10–12 水平/垂直位置方差(m²)、速度方差((m/s)²)
13–14 天线世界坐标 z 与局部水面高度,m

状态:0 disabled(停用)、1 submerged(水下)、2 acquiring(捕获中)、3 fix(定位有效)、4 blocked(遮挡)、5 surface unavailable(水面信息不可用)。

无效测量的坐标与速度为 NaN。接触水面或被遮挡会清除尚未交付的定位结果。重新捕获要求连续保持所需净空。重置会清除计时器和延迟样本,并递增 epoch。

以下输入模拟遮挡;改用 false 可解除:

gz topic -t /model/my_robot/gnss/blocked -m gz.msgs.Boolean -p 'data: true'

解读与检查

比较静止且露出水面的天线、水下天线、被遮挡天线及恢复过程。检查捕获时间、延迟、重置后的 epoch 和递增的测量时间戳。接收端须拒绝过期或未来的定位结果,并处理无效状态。

随附的 BlueROV2 适配器向 ArduSub 提供数据;其他 ROS NavSatFix 使用方及自定义自动驾驶仪仍需适配器。

该模型基于天线位姿,不计算卫星几何、射频传播、物理多径或水声定位。精度配置是仿真输入,并非厂商精度保证。参见实现及软件包指南。