ワールドを作る
小さなワールドを作り、深度が分かっている位置に圧力センサーを置きます。地形や動くロボットを追加する前に、設定変更と計測結果の関係を確認しましょう。
作業環境を準備する
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に変更します。 - 再検証して起動します。
- 2 つのトピックを再度読みます。期待値は約 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 を使います。