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

PythonでArduPilotを制御

個人の Autopilot ワークスペースにあるWAM-VまたはBlueROV2をPythonで制御します。ArduPilotが選択したモードとアクチュエータのミキシングを担当し、コールバックが手動入力を渡します。複数機のワールドは必要ありません。

環境を準備する

WWW-POSIM 0.6.16以降とSDK 0.4.3を使用します。個人ワールドをAutopilotモードで開始し、航法とアーミング前の準備を待ちます。ミッションと手動制御を終了し、QGCを切断してください。インストール版アプリとワークスペースを開いたままにします。ROSターミナルと接続で準備したPythonターミナルでSDKをインストールします:

python -m pip install --upgrade https://github.com/IOES-Lab/homebrew-www-posim/releases/download/v0.6.16/www_posim_ros-0.4.3-py3-none-any.whl

WAM-Vに短い入力を送る

機体周辺の水域に障害物がないことを確認してください。コードを ardupilot_manual.py に保存し、同じターミナルで python ardupilot_manual.py を実行します。MANUALに切り替えてアームし、2秒間小さい前進入力を送り、終了処理でディスアームを要求します:

from www_posim_ros import ArduPilotSession

with ArduPilotSession.local(control=True) as sim:
    sim.set_mode("MANUAL")
    try:
        sim.arm(True)
        sim.control_manual(
            lambda elapsed: {"x": 0.2, "r": 0.0},
            duration=2.0,
            gain=0.25,
        )
    finally:
        sim.arm(False)

入力と制御権

コールバックは経過した実時間の秒数を受け取り、辞書を返します。x、y、z、r は−1~1で、省略した軸は0です。WAM-Vは x と r、BlueROV2は4軸を使用します。正規化された入力であり、m/sやNではありません。実行時間は0秒より長く、最大30秒です。gainは0.1~0.35で、最初は0.25を使用してください。

ヘルパーは中立入力で制御権を取得し、最大10 Hzで更新します。完了、中断、コールバックのエラー時は中立入力で制御権を返します。有効な更新が0.6秒ないとwatchdogが手動入力を停止します。sim.stop() とセッション終了は入力を解放しますが、ディスアームやモード変更はしません。例では別途ディスアームを要求します。中立入力でも慣性や波の力はなくなりません。

モードとアーミングの要求はフライトコントローラーの確認を待ちます。WAM-VはMANUAL、HOLD、STEERING、BlueROV2はMANUAL、STABILIZE、ALT_HOLDを使用できます。他の手動制御、ミッション、QGCが要求を拒否させることがあります。ワールド変更や制御権の期限切れ時は自動取得せず終了します。終了処理が拒否された場合は、現在の制御元と機体状態を確認してから再試行してください。

WebワークスペースとROSテレメトリ

自分のWebワークスペースに接続するにはwith行を次に変更します。パスワードはソースではなくターミナルのプロンプトに入力してください:

with ArduPilotSession.remote(email="YOU@example.com", control=True) as sim:

どちらの接続も sim.topics と sim.latest(topic) で最新のROSメッセージ辞書を読み取れます。テレメトリの読み取りだけではROSコマンドの権限は得られません。インストール版のワークスペースを制御はROS 2モードを使用し、この章はArduPilot経由で要求します。QGCで制御する前にPython制御を終了してください。

ドキュメントを検索