POSIM v1.0.1Platform for Ocean Simulation · ドキュメント
ドキュメントメニュー
POSIM / 応用ガイド

ロボットを追加する

構成が似ている POSIM ロボットを出発点にします。SDF は機構とシステムを記述し、ROS 設定は計測と指令を結び付けます。

作業環境

Ubuntu ネイティブ、WSL、Docker の準備済み Linux ターミナルを使います。macOS では RDP デスクトップ内で作業します。編集とビルドもその環境内で行い、POSIM_WS にはワークスペースのパスを設定します。

1. 参考モデルをコピーする

REXROV は Gazebo のスラスタを使います。BlueROV2 は ArduSub/MAVROS と連携します。Slocumでは異なる機体構成を確認できます。

メッシュ、ブリッジ設定、トピック名をまとめて扱えるよう、$POSIM_WS で REXROV を一式コピーします。

cd "$POSIM_WS"

次のプログラムを copy_robot.py として保存し、python3 copy_robot.py で実行します。my_robot が既に存在する場合は停止します。

from pathlib import Path
import shutil

root = Path('src/posim/models/posim_robot_models')
directories = ('description', 'config', 'meshes')
if any((root / directory / 'my_robot').exists() for directory in directories):
    raise SystemExit('my_robot already exists; choose another model name.')
for directory in directories:
    shutil.copytree(root / directory / 'rexrov', root / directory / 'my_robot')
for relative in ('description/my_robot/model.sdf',
                 'description/my_robot/model.config',
                 'config/my_robot/robot_config.py'):
    target = root / relative
    target.write_text(target.read_text().replace('rexrov', 'my_robot'))

作成される構成は次のとおりです。

models/posim_robot_models/
  description/my_robot/model.sdf
  description/my_robot/model.config
  meshes/my_robot/RexROV_no_props.dae
  config/my_robot/robot_config.py

my_robot は任意に選ぶ識別子です。起動ファイルは description/<namespace>/model.sdf と対応する設定を探します。

2. 機構とリソースを定義する

最初の起動ではコピー元の機構を維持します。船体を変更する際は、次をまとめて確認してください。

SDF のパス 単位 確認事項
model/@name、リンク名、ジョイント名 識別子 プラグインと ROS 設定の名前に一致
link/inertial/mass kg 動く各リンクの質量が正であること
link/inertial/pose m, rad 重心と慣性座標系の向き
link/inertial/inertia/ixx, iyy, izz kg·m² 慣性座標系の各軸まわりの慣性モーメント
link/inertial/inertia/ixy, ixz, iyz kg·m² 非対角成分。テンソル全体の物理的な妥当性
link/visual, link/collision m, rad メッシュの縮尺と形状の一致
joint/axis、スラスタ設定 プラグインによる 駆動方向と推力配分

STL が提供するのは形状です。質量と力学は SDF に設定し、メッシュの単位と縮尺を確認します。既存の例に従ってインストール済みリソースの URI を使います。複雑な表示形状が接触計算を重くする場合は、衝突形状を簡略化してください。

3. システムと ROS を接続する

流体力学、浮力、スラスタ軸、センサー姿勢を対象機体に合わせます。係数には実際の物性に合う値を使ってください。

海流、センサーを追加する、各プラグインのリファレンスを参照します。緯度・経度が必要な場合は球面座標で原点を設定します。

config/<namespace>/robot_config.py のエンティティ名、ジョイント名、トピック、座標系、ポートを整合させます。description、meshes、config とリソース検索設定は既存のパッケージがインストールします。生成された install/ 内ではなく、ソースを編集してください。

4. ビルドして試す

環境を読み込んだワークスペースで実行します。

colcon build --merge-install --executor sequential --symlink-install
source install/setup.bash
ros2 launch posim_demos posim_robot.launch.py --show-args
ros2 launch posim_demos posim_robot.launch.py \
  namespace:=my_robot world_name:=posim_ocean_waves z:=-2 paused:=false \
  gui:=true headless:=false use_teleop:=false use_web_joystick:=false

各軸に小さな指令を送り、次を確認します。ソースディレクトリの外からも起動してください。

別の準備済みターミナルで、名前を変更したモデルの状態を読みます。

ros2 topic echo --no-daemon /model/my_robot/odometry nav_msgs/msg/Odometry --once

位置と速度を受信できるはずです。まずコピーを動かし、次に機構、その後にセンサーや推進系を変更します。センサーデータで実験を比較し、リソースが見つからない場合はトラブルシューティングを参照してください。