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 バックエンド)。

例は 1 つずつ実行してください。wgpu を cpu、cuda、auto に替えると計算方法を選べます。ロボット搭載の例では、適切なソナーワールドで bluerov2_heavy_multibeam_sonar を選びます。

センサーの計算処理

Gazebo はシーンの形状を提供します。ソナーモデルは表面法線を推定し、音響後方散乱、受信応答、距離セルへの圧縮を計算します。音響データと表示画像は同じ観測を表します。解析には生データを使い、ゲインと表示設定も保存してください。

spec/receiveBeamWidth を正の値にすると、ソナーの視野全体を覆う深度カメラで測定した XYZ を使う物理モードになります。形状のサンプル、受信方向、距離出力は独立しています。中心が視野内にあるセルで視野全体の立体角を分担し、投影表面積と符号付きの受信応答から各ビームへの寄与を計算します。帯域幅が固定でピーク値が 1 のベースバンド 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 CSVを保存する間隔、フレーム数。正の整数 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ファイルは、RViz表示用にworldからソナー座標系への恒等変換を配信します。点群の座標はセンサー基準です。この静的変換は機体の動きやソナーの取り付け位置・姿勢を反映しません。ワールド座標で地図を作成する場合は、機体とソナー取り付け部の位置・姿勢を反映する変換チェーンに置き換えてください。

音線の配置

<ray>の既定値は、水平方向256ビーム、垂直方向3本の音線、水平角±π/4、垂直角±π/8、距離範囲0.1–5 mです。角度はラジアンで指定し、degrees="true"の場合は度を使います。<gz:multibeam_sonar>内の任意項目<reference_frame>は、位置と回転が0の姿勢を既定値とします。

<ray>と<spec>の両ブロックを残してください。既定値はブロック内の各項目に適用されます。音線の距離範囲とmaxDistanceをそろえます。パラメーターの読み込みと出力の詳細は実装で確認できます。

実験条件をそろえる

処理性能を測るときは、記録処理も実験対象である場合を除いてCSV保存を無効にします。ソナーの設定と調整を参照し、比較する実験では音響設定と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. サンプル数、角度、距離範囲を設定します。ワールドに上記の2つのシステムを組み込みます。その他の設定はソナー用ワールドの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なしでもインストールできます。ソナー画像と、等間隔に選んだ5本のビームのプロファイルを生成します。ビームが5本未満ならすべて表示します。

オプション 内容
--range-max 表示する最大距離、m
--beam-step N本おきにビームを表示
--dynamic-range 最大値から下の表示範囲、dB。既定値60

色は各フレームの最大値に対する相対値です。実験間の比較にはCSVの値を使ってください。最初の列は距離、残りはビームごとの複素反射データです。対応するビーム角度ファイルを一緒に保管し、ディスク使用量も確認してください。

シーンと観測例

点散乱によるマルチビームソナー処理
点散乱によるマルチビームソナー処理
同じシーンのRGB画像、深度、ソナー画像、点群
同じシーンのRGB画像、深度、ソナー画像、点群
ソナーサンプルの画像変化
ソナーサンプルの画像変化
シーンの変化に伴うソナー観測
シーンの変化に伴うソナー観測
BlueROV2からのソナー観測
BlueROV2からのソナー観測
ソナーによる近傍シーンの探索
ソナーによる近傍シーンの探索

図・動画:POSIM Notion Wiki。DAVEとソナーモデルの出典は引用とライセンスを参照してください。コマンドとトピック名は、このページのコードブロックを使用します。