Pianificazione delle rotte e controllo
Il terreno verificato diventa una rotta controllata e poi comandi di propulsione. Il movimento misurato da Gazebo alimenta la decisione successiva.
La pianificazione personale dei punti subacquei usa i Limiti di profondità delle missioni. Un limite di simulazione maggiore mantiene i controlli del terreno e dell’ingombro lungo il percorso descritti di seguito.
Flusso di elaborazione
- 1. Obiettivi, stato misurato e terreno
Trasforma le destinazioni geografiche nel riferimento locale. Unisce le tessere numeriche confermate su una griglia comune; le aree mancanti restano sconosciute.
- 2. Guida geografica e costiera
Trova collegamenti che evitano la terra e corridoi di accesso ai porti. Evitare la terra sulla mappa non basta a verificare la profondità.
- 3. Verifica dell’impronta spazzata
Amplia lo scafo con il margine d’inseguimento. Ritaglia i triangoli del fondale in ogni quadrato interrogato per trovare il punto più alto; scarta terra, distanza insufficiente e dati assenti. Un filtro di massimo accelera le zone chiaramente profonde.
- 4. Segmento diretto e deviazione A*
Prova prima una linea retta verificata. Altrimenti cerca su una griglia a otto vicini con costo di distanza ed euristica euclidea. Rispetta limiti di angoli, raggio, lunghezza e tempo.
- 5. Accorciare e ricontrollare
Le scorciatoie superano la stessa verifica dell’impronta e mantengono i punti protetti di accesso al porto. Restituisce waypoint verificati e distanza minima, oppure un errore se non esiste una rotta ammissibile.
- 6. Velocità e propulsione
Il veicolo guida frena per curve ed errore di rotta, applica una rampa d’accelerazione, un PI di velocità e spinta differenziale. L’inseguitore anticipa sulla traccia misurata della guida; inclinazione e velocità d’avvicinamento limitano i comandi.
- 7. Retroazione e aggiornamento
Gazebo applica le forze e restituisce il movimento. Si controllano avanzamento, stabilità e copertura di terreno e sensori. Prima di aree non verificate il veicolo attende; nuovi obiettivi o condizioni possono richiedere una nuova pianificazione.
Dopo un recupero prolungato senza progressi, LIVE può usare un corridoio di mare aperto verificato. Quando il movimento riprende, cerca periodicamente di tornare alla costa cartografata e seguirla. Ogni tratto richiede ancora la verifica della terra e della profondità numerica. L’accesso portuale fisso rimane obbligatorio ed è raggiunto tramite un corridoio verificato.
La navigazione LIVE usa collegamenti costieri cartografici come guida temporanea. Quando la posizione misurata porta il veicolo almeno 50 m più vicino all’obiettivo di rotta rispetto all’ultimo riferimento del collegamento, la guida viene rilasciata e il percorso successivo viene ripianificato. Ogni nuovo corridoio di propulsione richiede ancora la verifica delle esclusioni terrestri e della profondità numerica.
Dopo ripetuti tentativi di recupero regionale e dieci minuti senza avanzamento misurato, LIVE può cercare un collegamento completo verso la rotta in una finestra di terreno di 16 km. Segue in ordine le svolte selezionate e verifica ogni tratto di propulsione sul terreno nativo corrente e sulle terre cartografate.
Catalogo della pianificazione
| Livello | Metodo e ambito |
|---|---|
| Rotta geografica | Destinazioni, varchi portuali, passaggi e poligoni terrestri producono la guida a lunga distanza. Le coordinate del catalogo porti e gli obiettivi d’arrivo navigabili sono distinti. |
| Campo del terreno | Griglie numeriche confermate in un riferimento comune. Ritaglio esatto dei triangoli per trovare il fondale più alto; limite superiore mediante filtro di massimo SciPy. Zone sconosciute o esterne restano indisponibili; il colore satellitare non viene usato come profondità. |
| Distanza lungo il percorso | Campionamento dei segmenti al massimo ogni 1 m, ampliando l’impronta di metà intervallo. Nei tratti con variazione di profondità si usa l’estremo più profondo. È un inviluppo conservativo, non una previsione completa del futuro movimento a sei gradi di libertà. |
| Ricerca locale | Retta, poi A* a otto vicini con controllo conservativo degli angoli. Valori usuali: passo 4 m, raggio 600 m, rotta 2 000 m e budget 25 s. Il chiamante può scegliere limiti diversi. |
| Margini del veicolo | Superficie: raggio scafo 3,5 m, margine iniziale d’inseguimento 4 m, distanza dal fondo 1,5 m. Subacqueo: 0,5 m, 2 m e 1 m. WAM-V personale può ridurre l’inseguimento a 2 m senza ridurre il margine di profondità. |
| Risultato e sorveglianza | Waypoint verificati, margine scelto, informazioni su griglia/budget e distanza minima rappresentata. Controlli di corridoio e copertura possono arrestare l’esecuzione. Fallimento della ricerca, uscita dal corridoio e dati mancanti sono condizioni distinte. |
I margini valgono sul terreno rappresentato e non certificano l’accuratezza idrografica. Una rotta valida non garantisce un inseguimento riuscito nelle condizioni scelte. Marcatori AIS, navi visibili o un topic LiDAR disponibile non dimostrano evitamento dinamico o conformità COLREG: dipendono dal controllore dell’esperimento.
Recupero costiero sul terreno caricato in LIVE
La ricerca usa il terreno numerico caricato ed esclude la terra cartografata. La fascia ordinaria entro 1,5 km dalla costa limita la ricerca stessa. Se manca una prosecuzione verificata, una deviazione finita può raggiungere 2 km al largo e terminare di nuovo nella fascia ordinaria.
- Avanzamento minimo dell’estremo: 500 m; entro 5 km dall’obiettivo si riduce al 10 % della distanza restante.
- Esclusione delle acque basse: 200 m.
- Profondità minima rappresentata: 2 m.
- Lunghezza massima del corridoio: 12 km.
L’esecuzione nativa ricontrolla ogni tratto limitato. I nuovi estremi evitano zone abbandonate di recente. Un corridoio completo e verificato può attraversarle e proseguire oltre. Se l’avanzamento verso la destinazione è inferiore a 50 m, tutta la rotta evita la zona. Questa memoria del recupero non modifica la verifica fisica dello scafo.
Percorsi di controllo e retroazione
| Percorso | Ingresso, implementazione e uscita | Interpretazione |
|---|---|---|
| ArduPilot personale | Obiettivi guidati o ingressi manuali → ArduRover/ArduSub SITL tramite MAVROS e interfaccia JSON Gazebo → canali degli attuatori. | Contano sorgente di navigazione, EKF, modalità, armamento e associazione degli attuatori. Vedi GNSS e navigazione. |
| ROS 2 diretto | Nodo utente → topic consentiti e attuatori selezionati → forze Gazebo. | L’utente fornisce la legge di controllo. Pubblicare un obiettivo o una velocità non misura il moto ottenuto. |
| Veicolo guida | Waypoint verificati → frenata in curva, riduzione per errore di rotta, rampa d’accelerazione, PI con integrale limitato e spinta differenziale. | Retroazione del moto corporeo misurato; periodo nominale 0,05 s. La perdita dell’heartbeat inibisce i comandi. |
| Veicolo inseguitore | Traccia misurata della guida, distanza e velocità d’avvicinamento → anticipazione, limiti di velocità/virata e frenata → propulsione. | Distanza nominale di 38 m tra le origini degli scafi. Controllore dimostrativo, non prova di sicurezza anticollisione per una flotta. |
| Recupero | Una politica esplicita può richiedere un traino fisico limitato, mantenendo massa, contatti e resistenza. | Registra separatamente questa modalità. Il traino della guida è limitato a 900 N e 0,8 m/s di velocità richiesta. |
Nelle sessioni con GNSS configurato, le missioni convalidano nuovamente la rotta dalla posizione misurata dopo l’armamento e la stabilizzazione della navigazione, prima di inviare la prima destinazione. La stabilizzazione richiede una posa locale FCU recente e una fusione GNSS valida oppure una fusione di sensori esterni accettata. Il fix GPS grezzo del ricevitore resta uno stato separato; vedere GNSS e navigazione.
Le missioni personali WAM-V usano per impostazione predefinita la sagomatura dell’ingresso (GUID_OPTIONS=0). Senza un orientamento esplicito, aggiornano la posizione obiettivo originale ogni due secondi di simulazione fuori dal raggio di arrivo di 0.75 m e richiedono velocità e velocità d’imbardata nulle al suo interno. Un profilo salvato con il bit 64 attivo mantiene il pianificatore di waypoint con curve a S di ArduRover. BlueROV2 aggiorna gli obiettivi ogni due secondi di simulazione tramite il controllore di waypoint di ArduSub. La freschezza della telemetria usa il tempo reale; i controlli di navigazione e distanza dal terreno proseguono durante il percorso.
Quando un’imbarcazione a motore riceve un obiettivo Guided valido con velocità e velocità di imbardata nulle, ArduRover incluso mantiene attivo il PID di velocità per contrastare la deriva in avanti e indietro. Questo controllo regola la velocità; la correzione verso la posizione definita inizia fuori dalla zona di arrivo. Le barche a vela, gli obiettivi scaduti e le altre modalità di controllo mantengono il comportamento di arresto configurato.
Quando il riferimento limitato in accelerazione è zero, il regolatore di velocità azzera l’integrale al primo arresto misurato. Fuori dalla banda di velocità di arresto configurata, azzera anche l’integrale accumulato che accelererebbe la barca nella direzione attuale di deriva. Restano attivi l’integrale di frenata opposto e la compensazione nella banda di arresto.
Il profilo personale predefinito usa WP_SPEED=0.5 m/s, ATC_STOP_SPEED=0.02 m/s e ATC_STR_RAT_I=0.
Il plugin SITL interpola gli stati dei sensori tra passi fisici completati, con frequenze obiettivo di 200 Hz per Rover e 1000 Hz per Sub. Cambiando l’intervallo fisico cambia il numero di campioni intermedi. Ogni intervallo termina nello stato fisico e al timestamp originali. La risoluzione fisica dipende dal passo della simulazione fisica.
La demo pubblica WAM-V seleziona la sagomatura dell’ingresso (GUID_OPTIONS=0) e aggiorna il waypoint originale ogni due secondi simulati. Usa WP_RADIUS=0.2 m, LOIT_RADIUS=0.1 m e LOIT_SPEED_GAIN=1.0 per l’avvicinamento e il mantenimento della posizione con le onde. L’arrivo richiede sempre una precisione orizzontale di 0.75 m. Gli spazi personali mantengono i parametri selezionati.
Ripristino di checkpoint e spostamento dell’origine modificano anche stati o coordinate. Lo spostamento trasforma terreno, rotta e traccia mantenendo le velocità fisiche; non va derivato come viaggio reale. Conserva gli eventi di recupero, reset e cambio d’origine nelle analisi di inseguimento o energia.
La coppia nativa guida/inseguitore appartiene a LIVE. Le sessioni personali usano ArduPilot o ROS 2 secondo la configurazione. WAM-V personale prova un raggio scafo di 3,5 m e un margine d’inseguimento di 4 m; se bloccano partenza o passaggio, riprova con 2 m, mantenendo 1,5 m di profondità libera. Uscire dal corridoio scelto arresta la missione.
Implementazione e letture collegate
POSIM-Routing implementa navigazione, pianificazione e collegamenti costieri/portuali. POSIM-Control contiene Pilot.cc e Follower.cc; le politiche Python gestiscono velocità e stabilità. WWW-POSIM coordina le sessioni, sceglie il controllore e applica i vincoli delle missioni personali. Usa le revisioni selezionate dall’app.
Viaggio intorno al mondo LIVE · Controlla un’area di lavoro locale · Algoritmi di generazione del terreno