WWW-POSIM v0.6.16シミュレーターのドキュメント
ドキュメントメニュー
WWW-POSIM / シミュレーターのドキュメント

インストール版のワークスペースを制御

準備済みのROS 2サンプルをVS Codeで開き、ローカルシミュレーションに短い指令を送ります。

制御するワールドを開始する

  1. インストールの手順でアプリを用意し、VS Codeもインストールします。
  2. WWW-POSIMを開き、確認済みのアカウントでログインしてシミュレーターを開始を選びます。WindowsとUbuntuでは先にDockerを起動します。
  3. ワークスペースで準備済みの地形、WAM-V、ROS 2直接制御を選びます。
  4. ワールドを開始し、機体と新しい位置データが表示されるまで待ちます。アプリとブラウザは開いたままにします。

アプリがシミュレーションを実行し、VS Codeでは制御プログラムを編集・実行します。

VS Codeで準備済みサンプルを開く

VS Codeで開くを選ぶと、作業フォルダーとros_vehicle_command.pyが開きます。初期フォルダーはDocuments/WWW-POSIMです。Pythonプロジェクトを作成は、既存ファイルを上書きせずにサンプルと設定を追加します。VS Codeを開く際も、機体サンプルがなければ追加されます。別のフォルダーはローカル設定 → 作業フォルダーで選べます。作業フォルダーを開くはファイルマネージャーで表示します。

VS Codeから確認されたら、自分のプロジェクトを信頼し、自動タスクWWW-POSIM: ROS terminalを許可します。許可しない場合は、ターミナル → タスクの実行 → WWW-POSIM: ROS terminalから起動できます。新しい統合ターミナルはWWW-POSIM ROSを使います。ROS connectedを待ってください。ファイルを開くだけではサンプルは動きません。

macOSでは、ターミナルとデバッガーがアプリ付属のPythonと準備済みROS環境を使います。このプロジェクト用に別の仮想環境を作る必要はありません。WindowsとUbuntuでは、コマンドは準備済み制御コンテナーで実行され、VS Codeは共有フォルダーを編集します。

MicrosoftのPython、Python Debugger拡張機能をインストールします。WindowsとUbuntuではDev Containersも追加し、Dev Containers: Reopen in Containerでコンテナー内のデバッグを利用します。ROSターミナルを開くは同じフォルダーで外部の準備済みターミナルを起動します。

ROS 2機体サンプルを実行する

ワールドの制御パネルでROS有効を選びます。準備済みターミナルでオプションを確認し、WAM-Vに短い移動を指示します。

python ros_vehicle_command.py --help
python ros_vehicle_command.py --vehicle wamv --forward 0.3 --seconds 2

サンプルは定期的に指令をパブリッシュし、終了時やCtrl+Cで中立指令を送ります。移動前にサブスクライバーの接続を待ちます。1回の実行は最大30秒、WAM-Vは1 m/sと0.5 rad/s、BlueROV2はモーター当たり5 Nに制限されています。

BlueROV2は6つの中立値から始めます。

python ros_vehicle_command.py --vehicle bluerov2 --thrusters 0 0 0 0 0 0 --seconds 2

選択した機体と応答を確認してから入力を増やしてください。中立指令では慣性や波の力は消えません。

Pythonセッションインターフェースを使う

同じパッケージにはPythonのセッションインターフェースもあります。次をcontroller.pyとして保存し、準備済みターミナルでpython controller.pyを実行します。

from www_posim_ros import Session

with Session.local(control=True) as sim:
    topic = next(name for name, kind in sim.topics.items()
                 if kind == "nav_msgs/msg/Odometry")
    print("Before:", sim.latest(topic)["pose"]["pose"]["position"])
    sim.set_velocity(forward=0.3, yaw_rate=0.0, duration=2.0)
    print("After:", sim.latest(topic)["pose"]["pose"]["position"])

新しい位置を読み、2秒間0.3 m/sの前進を要求してから制御を解放します。表示された位置の差が厳密な移動距離になるとは限りません。左旋回にはyaw_rate=0.1を使います。ブラウザの停止操作で制御をすぐに中断できます。

BlueROVの推力を制御する

セッションインターフェースは、モデル本来のジョイント順でBlueROV2の6つの推力値(N)を受け取ります。WAM-Vは左・右の2値です。まず中立入力を送ります。

from www_posim_ros import Session

with Session.local(control=True) as sim:
    sim.set_thrusters([0.0] * 6, duration=1.0)
インターフェースの上限 値
WAM-V速度 前進±1.5 m/s、ヨー±0.5 rad/s
WAM-V推力 モーター当たり±200 N
BlueROV2推力 モーター当たり±50 N
補助関数の実行時間 0秒より長く、最大300秒
指令監視 有効な更新がない状態で0.75秒

これらはros_vehicle_command.pyで小さく設定したサンプル上限とは異なります。補助関数は約10 Hzで指令を繰り返し、最後に制御を解放します。別スレッドからsim.stop()を呼ぶと実行中の補助関数を中断できます。切断すると制御は終わり、ネットワークエラー後に自動再開しません。

サーバーが解放を確認できる場合、各ヘルパーは推力がゼロになり制御権が解放されるまで待機します。controller_busy が表示されたら、先に別のコントローラーを停止してください。評価の正常終了や停止操作では control_lease_ended が発生する場合があります。watchdog_timeout と simulation_or_sensor_unavailable は実行失敗を示します。

課題の評価中の control_service_stalled は、サーバーのネイティブ制御コールバックが0.75秒を超えて停止したことを示します。推進器は安全に停止し、その実行には有効な点数が付きません。ウェブサイトへの提出では完了した評価記録を保持し、中断した評価を自動再試行します。ローカル練習ではシミュレーターを確認してから実行を再開してください。

インストール型アプリの拡張を読み込む

インストール型アプリのローカルワークスペースでは、所有者が承認したworld/model ZIP拡張を読み込めます。ホスト型ワークスペースと評価セッションでは拡張コードを実行しません。

  1. ワークスペースの最終確認で User world/model extensions → Import extension ZIP を開きます。ZIPにはextension.json、入口となるSDF、ハッシュ付きの宣言済みファイルを含めます。インポートはコードを実行せず、検査して保存します。
  2. Declared files and SDK でコード、対象プラットフォーム、ZIP SHA-256、SDK SHA-256を確認します。対象とSDKは実行中のエンジンに一致する必要があります。コードはローカルランタイムの権限でファイルとネットワークにアクセスします。
  3. 信頼するコードだけに Approve code and select を選んで承認し、ワールドを開始します。承認は所有者と正確なZIP・SDKの組合せに結び付き、選択は新しいセッションに適用されます。Clear selected extension を押しても保存済みZIPは残ります。

SDKが不明、または対象・ハッシュが一致しない場合は選択できません。選択したエンジン用にビルドした拡張を使い、そのZIPを承認してください。登録済み航法プロバイダーの入口を持たない一般スクリプトは実行できません。アプリがプロバイダープロセスを管理し、セッション終了時に停止します。

WAM-VとBlueROV2は、アクティブなROS航法プロバイダーを1つ持つ共通インターフェースを使います。ユーザープロバイダーの選択は組み込みプロバイダーの出力を置き換え、生のGNSS受信機を維持します。共通出力は/vehicle/navigation/estimateのnav_msgs/Odometryと、/vehicle/navigation/statusのstd_msgs/String JSONです。位置・姿勢はnavigation_mapのENU、速度はbase_linkの機体FLU座標を使います。一致するシミュレーション時刻、有限の共分散、セッション識別子、WGS 84の地理的原点が必要です。

Autopilotモードでは共通ゲートウェイが出力を検査し、FCUへ外部航法として渡します。GPS fix状態は生のGNSSだけが決定します。校正、グローバル座標への整合、または有効なセンサーデータがない場合、プロバイダーの準備状態はfalseに保ちます。インポートやプロセス起動だけでは航法の準備は完了しません。入力の選択と信号喪失時の動作はGNSSと航法を参照してください。

SDKを更新する

Python SDK 0.4.2 以降では、接続時に安定版をバックグラウンドで確認し、更新手順をターミナルに表示します。公式評価中は確認を省略します。同梱の SDK はアプリを更新し、ROS ターミナルを開き直してください。既存の VS Code Dev Container では、表示されたイメージを .devcontainer/devcontainer.json に設定してコンテナーを再ビルドします。独自の Python 環境では、表示されたコマンドを実行してから Python を再起動してください。手動確認には python -m www_posim_ros.updates を使います。

うまく動かないとき

ROSターミナルと接続、Webワークスペースを制御、RVizとFoxgloveで表示、ROSのトラブルシューティングも参照してください。

ドキュメントを検索