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

多波束声呐

POSIM 多波束声呐采用点散射模型,生成随距离变化的回波强度和声呐图像。同一个插件支持 CPU、WGPU 和 CUDA 计算。WGPU 通过 Linux 的 Vulkan 或 macOS 原生环境的 Metal 使用不同厂商的 GPU。请参阅计算环境配置与选择。

运行示例

准备好终端 A 和 B;若尚未安装声呐包,请先编译声呐包。在 A 中启动仿真,在 B 中查看输出。第一条命令自动选择计算后端;专用示例指定 WGPU,并同时启动 RViz。

ros2 launch posim_demos posim_sensor.launch.py \
  namespace:=blueview_p900 world_name:=posim_multibeam_sonar \
  paused:=false x:=4 z:=2.0 yaw:=3.14 gui:=true headless:=false

posim_multibeam_sonar_demo 也提供独立示例:

ros2 launch posim_multibeam_sonar_demo multibeam_sonar_demo.launch.py \
  compute_backend:=wgpu
RViz 中的实时声呐扇形图像、点云和相机画面(CUDA 后端)。
RViz 中的实时声呐扇形图像、点云和相机画面(CUDA 后端)。

一次只运行一个示例。将 wgpu 改为 cpu、cuda 或 auto 即可切换后端。若需搭载声呐的机器人,请选择 bluerov2_heavy_multibeam_sonar 和合适的声呐世界。

传感器计算流程

Gazebo 提供场景几何。声纳模型估计表面法线,计算声学后向散射,应用接收响应,并将回波压缩到距离单元。声学数据与显示图像对应同一次观测。分析时使用原始数据,并保存增益和显示设置。

将 spec/receiveBeamWidth 设为正值可启用物理模式,使用覆盖整个声纳视场的深度相机测得的 XYZ。几何采样、接收方向和距离输出彼此独立。中心位于视场内的单元分担整个视场的立体角,根据投影表面积和保留符号的接收响应计算各波束贡献。模型使用固定带宽、单位峰值的基带 Hamming 脉冲,内部计算区间长于发布的距离区间。输出距离间隔为 soundSpeed / (2 × bandwidth),计算长度不决定脉冲增益。内部保护区间不发布,也不改变输出间隔。

ray/scan/horizontal/samples 指定几何列数,ray/scan/vertical/rays 指定图像行数,beams 指定接收方向数。物理模式要求视场对称,且每个轴的宽度均小于 180°。距离限制按径向距离计算;视场或距离限制之外的像素在有序点云中使用无效 XYZ。spec/receiveBeamWidth 以弧度指定功率半高全宽,spec/receiveGain 设置线性声压增益(默认 1)。省略宽度或设为 0 时使用默认网格模式。物理模式支持 CPU 和 WGPU,不支持 CUDA。频率采样数没有固定的 4096 上限,但大网格仍受后端资源和可表示维度的限制。散射系数按帧和几何单元生成。模型描述基带回波,不提供载波相位传播或硬件振幅校准。

查看输出

在终端 B 中运行:

ros2 topic list -t
ros2 topic echo /sensor/multibeam_sonar/sonar_image \
  sensor_msgs/msg/Image --once --no-arr --qos-reliability reliable

配置传感器

将以下系统直接放在 <world> 中:

<plugin filename="gz-sim-sensors-system" name="gz::sim::systems::Sensors">
  <render_engine>ogre2</render_engine>
</plugin>
<plugin filename="libmultibeam_sonar_system" name="custom::MultibeamSonarSystem"/>

将 P900 传感器放在模型的 <link> 中:

<sensor name="multibeam_sonar" type="custom" gz:type="multibeam_sonar">
  <always_on>true</always_on>
  <update_rate>30.0</update_rate>
  <topic>/sensor/multibeam_sonar</topic>
  <visualize>true</visualize>
  <gz:multibeam_sonar>
  <ray degrees="false">
    <scan>
      <horizontal>
        <beams>512</beams>
        <min_angle>-1.13447</min_angle>
        <max_angle>1.13447</max_angle>
      </horizontal>
      <vertical>
        <rays>300</rays>
        <min_angle>-0.10472</min_angle>
        <max_angle>0.10472</max_angle>
      </vertical>
    </scan>
    <range>
      <min>0.1</min>
      <max>10.0</max>
    </range>
  </ray>
    <spec>
        <!-- Sonar properties -->
      <verticalFOV>12</verticalFOV>
      <sonarFreq>900e3</sonarFreq>
      <bandwidth>29.9e3</bandwidth>
      <soundSpeed>1500</soundSpeed>
      <sourceLevel>220</sourceLevel>
      <maxDistance>10</maxDistance>
      <raySkips>10</raySkips>
      <sensorGain>0.02</sensorGain>
      <blazingSonarImage>true</blazingSonarImage>
      <writeLog>false</writeLog>
      <debugFlag>false</debugFlag>
      <writeFrameInterval>5</writeFrameInterval>
      <!-- ROS publication topics -->
      <pointCloudTopicName>point_cloud</pointCloudTopicName>
      <sonarImageRawTopicName>sonar_image_raw</sonarImageRawTopicName>
      <sonarImageTopicName>sonar_image</sonarImageTopicName>
      <frameName>forward_sonar_optical_link</frameName>
    </spec>
  </gz:multibeam_sonar>
</sensor>

此示例设置了 512 个水平波束,覆盖约 130°;300 条垂直声线,覆盖约 12°;距离范围为 0.1–10 m。频率为 900 kHz,带宽为 29.9 kHz,声速为 1500 m/s。30 Hz 是设定的更新频率,实际接收频率取决于计算和渲染开销。完整配置见传感器模型。

<spec> 参数

参数 含义 代码默认值 P900 示例
verticalFOV 声学波束的垂直宽度,度 10 12
sonarFreq 声学频率,Hz 900000 900000
bandwidth 信号带宽,Hz 29500000 29900
soundSpeed 声速,m/s 1500 1500
sourceLevel 声源级,dB 220 220
maxDistance 处理距离,m;应与声线距离范围一致 60 10
raySkips 垂直采样步长,正整数 10 10
sensorGain 默认 CPU 网格模式的回波幅值增益;物理模式及 WGPU/CUDA 不使用此参数 0.02 0.02
blazingSonarImage 根据实际时钟生成随机种子;false 时固定为 1234 false true
pointCloudTopicName Gazebo 点云话题后缀 point_cloud 相同
sonarImageRawTopicName ROS 原始声学数据话题后缀 sonar_image_raw 相同
sonarImageTopicName ROS 图像话题后缀 sonar_image 相同
frameName 光学坐标系 ID forward_sonar_optical_link 相同
writeLog 将 CSV 写入每次运行的独立目录 false false
writeFrameInterval 两次写入之间的帧数,正整数 10 5
debugFlag 控制台诊断输出 false false
plotScaler 读取并输出,但不参与图像生成 10 未设置

话题与坐标系

各后缀会追加到传感器的 <topic> 后面,本例为 /sensor/multibeam_sonar。Gazebo 点云类型为 gz.msgs.PointCloudPacked,需要使用随附的 ROS 桥接配置转换为 sensor_msgs/msg/PointCloud2。将 pointCloudTopicName 与 sensor_config.py 中的路径对应,并在 frameName 中指定声呐的光学坐标系。

BlueView P900 和 BlueROV2 声呐的 launch 文件会发布从 world 到声呐坐标系的恒等变换,供 RViz 显示使用。点云坐标仍以传感器为基准。此静态变换不会跟随载体运动,也不包含声呐的安装位姿。若要在世界坐标系中建图,请将其替换为同时包含载体位姿和声呐安装位姿的变换链。

声线的几何范围

<ray> 的默认值为 256 个水平波束、3 条垂直声线、水平角 ±π/4、垂直角 ±π/8,以及 0.1–5 m 的距离范围。角度默认使用弧度;设置 degrees="true" 后使用度。<gz:multibeam_sonar> 中的可选项 <reference_frame> 默认为位置与旋转均为零的位姿。

请保留完整的 <ray> 和 <spec> 块:默认值适用于块内字段。声线的距离范围应与 maxDistance 一致。参数解析和数据发布方式见实现代码。

保持实验可比

测量处理性能时应关闭记录功能,除非记录本身也是实验的一部分。按照声呐配置与调优设置实验,并保存声学参数及 blazingSonarImage 的取值,以便比较多次运行。

计算后端

选项 行为
auto 依次尝试 CUDA、WGPU、CPU;默认选项
wgpu 使用兼容的 Vulkan/Metal 适配器;不可用时传感器初始化失败
cuda 需要 NVIDIA GPU 及已编译安装的 CUDA 后端;不可用时初始化失败
cpu 在 CPU 上计算声学回波;仍需 Gazebo 渲染环境

专用启动命令接受 compute_backend,其他启动命令读取环境变量 POSIM_SONAR_COMPUTE_BACKEND。请在启动输出中查看 Using sonar compute backend:。有关适配器选择、运行条件和数值差异,请参阅声呐配置与调优。

添加新的声呐传感器

  1. 将 models/posim_sensor_models/description/blueview_p900/ 复制为新的传感器目录。
  2. 准备对应的 config/<传感器标识>/sensor_config.py,统一模型、连杆、坐标系名称和桥接话题。
  3. 调整采样数、角度和距离范围。在世界中加载上面的两个系统;其他配置可参考声呐世界 SDF。
  4. 准备计算后端和渲染环境,重新编译工作空间并加载环境,然后用启动参数选择新传感器。

记录和绘制原始数据

设置 writeLog=true 后,每个传感器会在仿真器的工作目录下创建独立的 SonarRawData_<run>_<suffix>/,并输出其路径。目录内包含带序号的 CSV 和 SonarRawData_beam_angles.csv,已有记录会保留。写入间隔小于 1 时会调整为 1;无法创建目录时则关闭记录并报告错误。

进入输出的记录目录,打开第一帧:

ros2 run posim_multibeam_sonar_demo plotdata.py SonarRawData_000001.csv

保存为 PNG:

ros2 run posim_multibeam_sonar_demo plotdata.py SonarRawData_000001.csv \
  --output-dir plots --no-show

绘图工具也可以在没有 CUDA 的环境中安装。它生成一幅声呐图像及五个等间隔选取的波束剖面;波束少于五个时全部绘制。

选项 作用
--range-max 最大显示距离,m
--beam-step 每隔 N 个波束取一个
--dynamic-range 低于峰值的显示范围,dB;默认为 60

颜色表示相对于当前帧峰值的回波强度;比较不同运行时应使用 CSV 数值。第一列是距离,其余列是各波束的复数回波。请将对应的波束角度文件与数据一同保存,并注意磁盘占用。

场景与观测示例

基于点散射的多波束声呐处理
基于点散射的多波束声呐处理
同一场景的RGB图像、深度、声呐图像与点云
同一场景的RGB图像、深度、声呐图像与点云
声呐示例中的图像变化
声呐示例中的图像变化
场景变化时的声呐观测
场景变化时的声呐观测
BlueROV2的声呐观测
BlueROV2的声呐观测
使用声呐搜索近处场景
使用声呐搜索近处场景

图片和视频来自 POSIM Notion Wiki。DAVE 与声呐模型的出处见引用与许可证。执行时请使用本页代码块中的命令和话题名。