Controllare ArduPilot con Python
Controlla un WAM-V o BlueROV2 in un’area personale Autopilot con Python. ArduPilot gestisce la modalità e il mixer degli attuatori; la funzione fornisce gli ingressi manuali. Non serve una flotta.
Preparare l’ambiente
Usa WWW-POSIM 0.6.16 o successivo e SDK 0.4.3. Avvia un mondo personale in modalità Autopilot e attendi navigazione e controlli prima dell’armamento. Ferma le missioni, rilascia il controllo manuale e scollega QGC. Tieni aperti app installata e area di lavoro. Apri il terminale Python preparato in Terminali ROS e connessione e installa il 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
Inviare un breve comando a WAM-V
Verifica che l’acqua attorno al veicolo sia libera. Salva il codice in ardupilot_manual.py ed esegui python ardupilot_manual.py nello stesso terminale. Seleziona MANUAL, arma, invia un piccolo ingresso in avanti per due secondi e richiede il disarmo nel blocco finale:
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)
Ingressi e autorità di controllo
La funzione riceve i secondi reali trascorsi e restituisce un dizionario. Gli assi x, y, z, r vanno da −1 a 1; quelli omessi valgono zero. WAM-V accetta x e r, BlueROV2 tutti e quattro. Sono ingressi normalizzati, non m/s o newton. La durata deve essere maggiore di zero e al massimo 30 secondi. Il guadagno è 0.1–0.35; inizia da 0.25.
Il metodo acquisisce il controllo con ingresso neutro, lo aggiorna fino a 10 Hz e lo rilascia con ingresso neutro al termine, all’interruzione o in caso di errore della funzione. Il watchdog ferma l’ingresso manuale dopo 0.6 secondi senza aggiornamenti validi. sim.stop() e la chiusura della sessione rilasciano l’ingresso, senza disarmare o cambiare modalità. L’esempio richiede esplicitamente il disarmo. L’ingresso neutro non elimina inerzia e forze delle onde.
Le richieste di modalità e armamento attendono conferma dal controllore. WAM-V supporta MANUAL, HOLD e STEERING; BlueROV2 MANUAL, STABILIZE e ALT_HOLD. Un altro controllore manuale, una missione o QGC può bloccare una richiesta. Un cambio di mondo o un’autorità scaduta termina il controllo senza riacquisirlo automaticamente. Se il rilascio viene rifiutato, verifica chi controlla il veicolo e il suo stato prima di riprovare.
Area web e telemetria ROS
Per la tua area web, sostituisci la riga with come segue. Inserisci la password al prompt del terminale, non nel codice:
with ArduPilotSession.remote(email="YOU@example.com", control=True) as sim:
Usa sim.topics e sim.latest(topic) per leggere dizionari di messaggi ROS aggiornati con entrambe le connessioni. Leggere telemetria non concede autorità per comandi ROS. Gli Controlla un’area di lavoro locale richiedono modalità ROS 2; questo capitolo invia richieste tramite ArduPilot. Chiudi il controllore Python prima di Controllare con QGC.