ArduPilot mit Python steuern
Steuern Sie einen WAM-V oder BlueROV2 in einem persönlichen Autopilot-Arbeitsbereich mit Python. ArduPilot übernimmt Modus und Aktuatormischung; die Rückruffunktion liefert manuelle Eingaben. Eine Flotte ist nicht erforderlich.
Umgebung vorbereiten
Verwenden Sie WWW-POSIM 0.6.16 oder neuer und SDK 0.4.3. Starten Sie eine persönliche Welt im Autopilot-Modus und warten Sie auf Navigation und Startfreigabe. Beenden Sie Missionen und manuelle Steuerung und trennen Sie QGC. Lassen Sie installierte App und Arbeitsbereich geöffnet. Öffnen Sie das vorbereitete Python-Terminal aus ROS-Terminals und Verbindung und installieren Sie das 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
Kurzen WAM-V-Befehl ausführen
Prüfen Sie, ob das Wasser um das Fahrzeug frei ist. Speichern Sie den Code als ardupilot_manual.py und führen Sie python ardupilot_manual.py im selben Terminal aus. Er wählt MANUAL, aktiviert die Motoren, sendet zwei Sekunden eine kleine Vorwärtseingabe und fordert im Aufräumblock die Motorabschaltung an:
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)
Eingaben und Steuerungsrecht
Die Rückruffunktion erhält verstrichene reale Sekunden und gibt ein Dictionary zurück. Die Achsen x, y, z, r liegen zwischen −1 und 1; fehlende Achsen sind null. WAM-V akzeptiert x und r, BlueROV2 alle vier. Dies sind normierte Eingaben, keine m/s oder Newton. Die Dauer ist größer als null und höchstens 30 Sekunden. Der Gain beträgt 0.1–0.35; beginnen Sie mit 0.25.
Die Methode übernimmt die Steuerung mit neutraler Eingabe, erneuert sie mit bis zu 10 Hz und gibt sie bei Ende, Unterbrechung oder Rückruffehler neutral frei. Der Watchdog stoppt manuelle Eingaben nach 0.6 Sekunden ohne gültige Aktualisierung. sim.stop() und das Sitzungsende geben Eingaben frei, schalten aber weder Motoren ab noch ändern sie den Modus. Das Beispiel fordert die Abschaltung ausdrücklich an. Neutrale Eingaben beseitigen weder Trägheit noch Wellenkräfte.
Modus- und Aktivierungsanfragen warten auf die Bestätigung des Flugcontrollers. WAM-V unterstützt MANUAL, HOLD und STEERING; BlueROV2 MANUAL, STABILIZE und ALT_HOLD. Andere manuelle Steuerungen, Missionen oder QGC können Anfragen blockieren. Ein Weltwechsel oder abgelaufenes Steuerungsrecht beendet die Steuerung ohne automatische Neuübernahme. Prüfen Sie bei abgewiesenem Aufräumen die aktuelle Steuerung und den Fahrzeugzustand vor einem neuen Versuch.
Web-Arbeitsbereich und ROS-Telemetrie
Ersetzen Sie für Ihren Web-Arbeitsbereich die with-Zeile wie folgt. Geben Sie das Passwort an der Terminalabfrage ein, nicht im Quelltext:
with ArduPilotSession.remote(email="YOU@example.com", control=True) as sim:
Mit sim.topics und sim.latest(topic) lesen Sie bei beiden Verbindungen aktuelle ROS-Nachrichten als Dictionaries. Telemetriezugriff erteilt keine ROS-Befehlsrechte. Die Einen lokalen Arbeitsbereich steuern benötigen ROS-2-Modus; dieses Kapitel sendet Anfragen über ArduPilot. Beenden Sie Python vor der Mit QGC steuern.