创建世界场景
先创建一个小型世界,在已知深度放置压力传感器。加入地形和移动机器人之前,先观察环境设置如何影响测量结果。
准备工作环境
使用 Ubuntu 原生安装、WSL 或 Docker 中准备好的 Linux 终端。macOS 用户使用 RDP 桌面内的终端。编辑和编译都在该环境内完成;POSIM_WS 表示其工作空间路径。
保存完整世界
将以下内容保存为 calm_water.sdf。它使用基本几何形状和已安装的插件,不需要下载网格模型。
<?xml version="1.0"?>
<sdf version="1.12">
<world name="calm_water">
<physics name="physics" type="ignored">
<max_step_size>0.001</max_step_size>
<real_time_factor>1.0</real_time_factor>
</physics>
<gravity>0 0 -9.80665</gravity>
<plugin filename="gz-sim-physics-system" name="gz::sim::systems::Physics"/>
<plugin filename="gz-sim-user-commands-system" name="gz::sim::systems::UserCommands"/>
<plugin filename="gz-sim-scene-broadcaster-system" name="gz::sim::systems::SceneBroadcaster"/>
<scene>
<ambient>0.4 0.5 0.6 1</ambient>
<background>0.05 0.15 0.25 1</background>
</scene>
<light name="sun" type="directional">
<direction>-0.5 0.2 -1</direction>
<diffuse>0.8 0.8 0.8 1</diffuse>
</light>
<model name="seabed">
<static>true</static>
<pose>0 0 -20 0 0 0</pose>
<link name="ground">
<collision name="collision">
<geometry><box><size>40 40 0.2</size></box></geometry>
</collision>
<visual name="visual">
<geometry><box><size>40 40 0.2</size></box></geometry>
<material><diffuse>0.6 0.5 0.3 1</diffuse></material>
</visual>
</link>
</model>
<model name="pressure_station">
<static>true</static>
<pose>0 0 -2 0 0 0</pose>
<link name="base_link">
<visual name="marker">
<geometry><box><size>0.2 0.2 0.2</size></box></geometry>
</visual>
</link>
<plugin filename="sea_pressure_sensor"
name="posim_gz_sensor_plugins::SubseaPressureSensorPlugin">
<namespace>pressure_station</namespace>
<topic>sea_pressure</topic>
<standard_pressure>101.325</standard_pressure>
<kPa_per_meter>9.80638</kPa_per_meter>
<estimate_depth_on>true</estimate_depth_on>
<update_rate>10</update_rate>
</plugin>
</model>
</world>
</sdf>
这个世界包含:
- 物理设置: 最大步长 0.001 秒,目标实时因子 1,重力向下。
- 光源与场景: 平行太阳光、环境光和背景色。
- 海底: 固定在 z = −20 m 的长方体,视觉几何与碰撞几何一致。
- 压力观测点: 固定在 z = −2 m 的标记物。模型级压力插件输出压力和估计深度。
压力基准是世界的 z = 0 平面。确认此基础案例正常后,再加入波浪、浮力和机器人运动。
校验并启动
在终端 A 中进入文件所在目录,执行:
gz sdf -k calm_water.sdf
gz sim -r calm_water.sdf
校验应成功,随后打开 Gazebo。-r 启动仿真时钟。在实体树中选择 pressure_station,将视角聚焦到该模型。
在加载了相同环境的另一个终端中执行:
ros2 topic echo --no-daemon /model/pressure_station/sea_pressure sensor_msgs/msg/FluidPressure \
--once
ros2 topic echo --no-daemon /model/pressure_station/sea_pressure_depth geometry_msgs/msg/PointStamped \
--once
预期结果约为 120,938 Pa 和 2 m。该插件直接发布 ROS 消息,本例无需额外桥接。
改变深度
- 在终端 A 按 Ctrl+C 停止仿真。
- 将观测点位姿从
0 0 -2 0 0 0改成0 0 -4 0 0 0。 - 再次校验并启动。
- 再次运行两个话题查询命令,预期约为 140,551 Pa 和 4 m。
保持压力系数不变。压力应增加 19,612.76 Pa。将修改前后的文件与观测结果一起保存。
找到各项设置
| SDF 路径 | 单位 | 用途 |
|---|---|---|
world/physics/max_step_size |
s | 最大积分步长:0.001 |
world/physics/real_time_factor |
— | 仿真时间与实际时间的目标比值:1.0 |
world/gravity |
m/s² | 重力向量 |
world/scene, world/light |
RGBA / 方向 | 背景和照明 |
model/pose |
m, rad | 位置和姿态 |
model/static |
布尔值 | 固定观测点与海底 |
model/plugin |
依插件而定 | 压力参数 |
实际速度取决于运行负载。传感器定义与世界系统的作用范围不同。添加传感器将进一步为此文件加入 IMU 和 ROS 桥接。
扩展世界
需要分发的世界保存在 models/posim_worlds/worlds,资源放在同一功能包中。添加后重新编译并加载环境;分享世界时使用已安装资源的 URI。