POSIM v1.0.1Platform for Ocean Simulation · ドキュメント
ドキュメントメニュー
POSIM / プラグインリファレンス

ドップラー速度計

DVL は海底または周囲の水に対する速度を推定します。POSIM は Gazebo の DVL システムと ROS ブリッジを使い、posim_interfaces/msg/DVL を出力します。

センサーを起動する

インストール方法に合わせて準備したターミナル Aで実行します。

ros2 launch posim_demos posim_sensor.launch.py \
  namespace:=nortek_dvl500_300 world_name:=dvl_world z:=-30 \
  paused:=false gui:=true headless:=false
Gazebo で海底と交差する DVL ビーム。
Gazebo で海底と交差する DVL ビーム。

準備済みのターミナル B で Gazebo のデータを確認し、Ctrl+C で表示を終了してから ROS のデータを確認します。

gz topic -e -t /dvl/velocity
ros2 topic echo /dvl/velocity posim_interfaces/msg/DVL --once

別のセンサーを作る場合は、そのモデルで定義したトピックを使ってください。

SDF に組み込む

次のシステムを <world> の直下に置きます。

<plugin filename="gz-sim-sensors-system" name="gz::sim::systems::Sensors">
  <render_engine>ogre2</render_engine>
</plugin>
<plugin filename="gz-sim-dvl-system"
        name="gz::sim::systems::DopplerVelocityLogSystem"/>

POSIM ブリッジはセンサーの <model> 内に置きます。トピックを <link> 内の DVL の <topic> と一致させます。

<plugin filename="DVLBridge" name="posim_ros_gz_plugins::DVLBridge">
  <topic>/dvl/velocity</topic>
</plugin>

DVL500-300 の完全な SDFは type="custom" gz:type="dvl"、4 本のビーム、追跡モードを定義します。ワールドには海底形状があります。

パラメーターと単位

DVLBridge のパラメーターは topic のみで、既定値は /dvl/velocity です。同じパスで Gazebo メッセージを受信し、ROS メッセージを出力します。次の項目は Gazebo センサーの設定で、値は DVL500-300 の例です。

センサーの SDF 項目 意味 例
topic, update_rate 出力先と要求周波数、Hz /dvl/velocity, 8
gz:dvl/type 送受波器の配列 phased_array
arrangement の aperture, rotation, tilt ビーム角度。degrees="true" なら度 開き角 3°、回転 −135/135/45/−45°、傾斜 25°
minimum_range, maximum_range 音響測距範囲、m 0.3, 200
reference_frame 基準姿勢。位置 m、回転 rad 0 0 0 3.14 0 -1.57
tracking/bottom_mode/when, tracking/water_mass_mode/when 対地・対水モードの選択 両方 best
追跡の noise/stddev 速度ノイズの標準偏差、m/s 対地 0.005、対水 0.015
水塊の water_velocity x/y/z 成分、m/s 0/0/0
水塊の boundaries/near, boundaries/far, bins 計測範囲 m とセル数 10, 100, 10
追跡の visualize 計測形状を表示 true

変換の詳細はブリッジ実装にあります。深度センサーは Gazebo の描画を使うため、実行環境の準備を済ませてください。

利用できるモデル

モデル名 系列
nortek_dvl500_300, nortek_dvl500_6000 Nortek DVL500
nortek_dvl1000_300, nortek_dvl1000_4000 Nortek DVL1000
sonardyne_syrinx600 Sonardyne
teledyne_explorer1000, teledyne_explorer4000 Teledyne Explorer
teledyne_whn Teledyne WHN
nortek_dvl500_300_with_multibeam_sonar DVL と ソナー

各 SDF の計測設定とビーム形状を確認してください。

座標系と共分散

この例は <reference_frame> で ENU を前方・右舷・下方の座標系に変換します。ブリッジは Gazebo のフレーム名を保持し、区切りの :: を / に置換します。推定器の座標系をそろえ、対地速度と対水速度を区別してください。

合成速度と各ビームは ROS の 6×6 twist 共分散を持ちます。左上の 3×3 が計測された並進速度の共分散で、単位は m²/s² です。残りは角速度を推定しないため 0 となっており、不確かさゼロの計測値を意味しません。

観測値を確認する

ros2 interface show posim_interfaces/msg/DVL で定義を確認します。停止中と制御された移動中に速度、座標系、状態を調べます。海底形状、距離、ビームの交差位置が計測に影響します。モデルの visualize を有効にするとビームを表示できます。

DVL のビームと出力

海底に向けたDVLの音響ビーム
海底に向けたDVLの音響ビーム
DVLによる速度観測
DVLによる速度観測
GazeboのDVLトピックを確認
GazeboのDVLトピックを確認
ROSのDVLトピックを確認
ROSのDVLトピックを確認

画像の出典:POSIM Notion Wiki。DAVE の帰属は引用とライセンスを参照してください。実行にはこのページのコマンドとトピック名を使います。