Commander ArduPilot avec Python
Pilotez un WAM-V ou BlueROV2 dans un espace personnel Autopilot avec Python. ArduPilot gère le mode et le mixage des actionneurs ; la fonction fournit les entrées manuelles. Une flotte n’est pas nécessaire.
Préparer l’environnement
Utilisez WWW-POSIM 0.6.16 ou ultérieur et le SDK 0.4.3. Démarrez un monde personnel en mode Autopilot et attendez la navigation et les contrôles avant armement. Arrêtez les missions, libérez la commande manuelle et déconnectez QGC. Gardez l’application installée et l’espace de travail ouverts. Ouvrez le terminal Python préparé dans Terminaux ROS et connexion, puis installez le 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
Envoyer une courte commande au WAM-V
Vérifiez que l’eau autour du véhicule est libre. Enregistrez le code dans ardupilot_manual.py, puis lancez python ardupilot_manual.py dans ce terminal. Il sélectionne MANUAL, arme, envoie une faible entrée avant pendant deux secondes, puis demande le désarmement dans le bloc de nettoyage :
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)
Entrées et autorité de commande
La fonction reçoit le temps réel écoulé en secondes et renvoie un dictionnaire. Les axes x, y, z, r vont de −1 à 1 ; les axes omis valent zéro. WAM-V accepte x et r, BlueROV2 les quatre. Ce sont des entrées normalisées, pas des m/s ni des newtons. La durée est supérieure à zéro et au plus de 30 secondes. Le gain vaut 0.1–0.35 ; commencez à 0.25.
La méthode acquiert la commande avec une entrée neutre, la renouvelle jusqu’à 10 Hz et la libère avec une entrée neutre à la fin, à l’interruption ou si la fonction échoue. Le watchdog arrête l’entrée manuelle après 0.6 seconde sans mise à jour valide. sim.stop() et la fermeture de session libèrent l’entrée sans désarmer ni changer le mode. L’exemple demande explicitement le désarmement. Une entrée neutre n’annule ni l’inertie ni les forces des vagues.
Les demandes de mode et d’armement attendent la confirmation du contrôleur. WAM-V accepte MANUAL, HOLD et STEERING ; BlueROV2 accepte MANUAL, STABILIZE et ALT_HOLD. Un autre contrôleur manuel, une mission ou QGC peut bloquer une demande. Un changement de monde ou l’expiration de l’autorité termine la commande sans la reprendre automatiquement. Si le nettoyage est refusé, vérifiez le détenteur de la commande et l’état du véhicule avant de réessayer.
Espace Web et télémétrie ROS
Pour votre espace Web, remplacez la ligne with par celle-ci. Saisissez le mot de passe à l’invite du terminal, pas dans le code :
with ArduPilotSession.remote(email="YOU@example.com", control=True) as sim:
Utilisez sim.topics et sim.latest(topic) pour lire des dictionnaires de messages ROS récents avec les deux connexions. Lire la télémétrie ne donne pas le droit d’envoyer des commandes ROS. Les Commander un espace de travail local nécessitent le mode ROS 2 ; ce chapitre passe par ArduPilot. Fermez le contrôleur Python avant de Commander avec QGC.