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制御を終了してください。