Controlar ArduPilot con Python
Controla un WAM-V o BlueROV2 en un espacio personal Autopilot con Python. ArduPilot gestiona el modo y la mezcla de actuadores; la función proporciona entradas manuales. No se requiere una flota.
Preparar el entorno
Usa WWW-POSIM 0.6.16 o posterior y SDK 0.4.3. Inicia un mundo personal en modo Autopilot y espera la navegación y las comprobaciones previas al armado. Detén las misiones, libera el control manual y desconecta QGC. Mantén abiertas la aplicación instalada y el espacio de trabajo. Abre el terminal Python preparado en Terminales ROS y conexión e instala el 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
Enviar una orden breve a WAM-V
Comprueba que el agua alrededor del vehículo esté libre. Guarda el código como ardupilot_manual.py y ejecuta python ardupilot_manual.py en ese terminal. Selecciona MANUAL, arma, envía una entrada de avance pequeña durante dos segundos y solicita desarmar al finalizar:
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)
Entradas y autoridad de control
La función recibe los segundos de tiempo real transcurridos y devuelve un diccionario. Los ejes x, y, z, r van de −1 a 1; los omitidos valen cero. WAM-V acepta x y r; BlueROV2 acepta los cuatro. Son entradas normalizadas, no m/s ni newtons. La duración debe ser mayor que cero y como máximo 30 segundos. La ganancia es 0.1–0.35; empieza con 0.25.
El método adquiere el control con entrada neutra, lo actualiza hasta 10 Hz y lo libera con entrada neutra al terminar, interrumpirse o fallar la función. El watchdog detiene la entrada manual tras 0.6 segundos sin actualización válida. sim.stop() y cerrar la sesión liberan la entrada; no desarman ni cambian el modo. El ejemplo solicita desarmar explícitamente. La entrada neutra no elimina la inercia ni las fuerzas de las olas.
Las solicitudes de modo y armado esperan confirmación del controlador. WAM-V admite MANUAL, HOLD y STEERING; BlueROV2 admite MANUAL, STABILIZE y ALT_HOLD. Otro controlador manual, una misión o QGC pueden bloquear una solicitud. Cambiar de mundo o caducar la autoridad termina el control sin readquirirlo automáticamente. Si se rechaza la limpieza, comprueba quién controla el vehículo y su estado antes de reintentar.
Espacio web y telemetría ROS
Para tu espacio web, sustituye la línea with por esta. Introduce la contraseña en el terminal, no en el código:
with ArduPilotSession.remote(email="YOU@example.com", control=True) as sim:
Usa sim.topics y sim.latest(topic) para leer diccionarios de mensajes ROS recientes en ambas conexiones. Leer telemetría no concede autoridad para comandos ROS. Los Controlar un espacio de trabajo local requieren modo ROS 2; este capítulo envía solicitudes mediante ArduPilot. Cierra el controlador Python antes de Controlar con QGC.