センサーの追加と設定
センサーには、モデル内の定義、更新を行うシステム、受信側へのデータ経路が必要です。1 つずつ追加し、計測値を確認してから次に進みます。
作業環境
Ubuntu ネイティブ、WSL、Docker の準備済み Linux ターミナルを使います。macOS では RDP デスクトップ内で作業します。編集とビルドもその環境で行い、POSIM_WS にはワークスペースのパスを使います。
組み込む場所を選ぶ
| 計測 | モデル内の配置 | ワールドのシステム / ROS 接続 |
|---|---|---|
| IMU | link/sensor type="imu" |
IMU システム、gz.msgs.IMU から ROS Imu へのブリッジ |
| 水中カメラ | RGBD センサーと画像効果プラグイン | 描画エンジンを使う Sensors システム、カメラトピック |
| DVL | DVL センサーとビーム設定 | DVL システム、付属の音響メッセージブリッジ |
| 圧力 | model 直下のプラグイン |
圧力と深度を ROS に直接出力 |
| 海洋 GNSS | ロボットモデルの受信機プラグイン | Gazebo の gz.msgs.Double_V メッセージ。ROS への接続には別途アダプターが必要 |
| USBL | 送受信器とトランスポンダーのプラグイン | 対応する音響 ID と ROS インターフェース |
| マルチビームソナー | リンク下のカスタムセンサー | Sensors の描画、ワールドのマルチビームシステム、CPU/WGPU/CUDA |
各リファレンスの SDF とパラメーター表を参照してください。配置には意味があります。ワールドのシステムはワールドに、モデル用プラグインは対象モデルに置きます。
サンプルワールドに IMU を追加する
ワールドを作るの calm_water.sdf を開きます。物理システムと同じく <world> 直下に追加します。
<plugin filename="gz-sim-imu-system" name="gz::sim::systems::Imu"/>
pressure_station モデルの <link name="base_link"> 内に次を追加します。
<sensor name="imu" type="imu">
<pose>0 0 0.1 0 0 0</pose>
<always_on>true</always_on>
<update_rate>20</update_rate>
<topic>/tutorial/imu</topic>
<imu/>
</sensor>
取り付け姿勢はリンク基準で、位置は m、角度は rad です。更新周波数はシミュレーション時間基準です。観測点は固定されているため、角速度はほぼゼロになり、加速度には重力への応答が含まれます。
接続して計測する
前のワールドを停止し、ターミナル A で検証して再起動します。
gz sdf -k calm_water.sdf
gz sim -r calm_water.sdf
環境を読み込んだ ターミナル B でブリッジを起動し、そのまま動かしておきます。
ros2 run ros_gz_bridge parameter_bridge \
'/tutorial/imu@sensor_msgs/msg/Imu[gz.msgs.IMU'
同様に準備した ターミナル C で計測値を読みます。
ros2 topic echo --no-daemon /tutorial/imu sensor_msgs/msg/Imu --once
時刻、フレーム ID、角速度、加速度を確認します。連続表示するには --once を外し、表示を止めるには Ctrl+C を押します。作業後はブリッジとシミュレーターも停止してください。ROS のターミナルとトピックで環境の共有方法を説明しています。
更新周波数を変える
update_rate を 20 から 5 に変え、ワールドとブリッジを再起動します。時刻の間隔は、シミュレーション時間で約 0.05 秒から 0.2 秒に変わります。実時間での受信周波数は、シミュレーションの進行速度と転送にも依存します。
カメラでは解像度、視野角、近距離・遠距離の範囲をまとめて確認します。走査型センサーではビーム配置と測定範囲を確認します。センサーを動かす前に、基準リンクの座標系と向きを確かめてください。
組み込み結果を確認する
- モデル:正しい取り付け姿勢、設定、一意のトピック。
- ワールド:必要なシステムと、画像センサー用の描画エンジン。
- ROS:ブリッジ方向、メッセージ型、座標系、QoS。
- 計測:新しい時刻と、制御したシーン変更への応答。
海底の配置はハイトマップ地形で確認します。ソナーの比較には設定と性能とパラメーターリファレンスを使ってください。