Planification des trajectoires et commande
Le terrain vérifié sert à calculer une route contrôlée, puis des commandes de propulsion. Le mouvement mesuré par Gazebo alimente la décision suivante.
La planification personnelle des points sous-marins utilise les Limites de profondeur des missions. Une limite de simulation supérieure conserve les vérifications du terrain et de l’enveloppe balayée décrites ci-dessous.
Chaîne de traitement
- 1. Objectifs, état mesuré et terrain
Transforme les destinations géographiques dans le repère local. Assemble les tuiles numériques confirmées sur une grille commune ; les zones absentes restent inconnues.
- 2. Guidage géographique et côtier
Établit les liaisons évitant la terre et les couloirs d’accès aux ports. Éviter la terre sur la carte ne suffit pas à garantir la profondeur.
- 3. Vérifier l’empreinte balayée
Élargit la coque de la marge de suivi. Découpe les triangles du fond dans chaque carré interrogé pour trouver le fond le plus haut ; rejette terre, dégagement insuffisant et données manquantes. Un filtre de maximum accélère les zones nettement profondes.
- 4. Segment direct, puis détour A*
Teste d’abord une ligne droite vérifiée. Sinon, cherche sur une grille à huit voisins avec coût de distance et heuristique euclidienne. Respecte les limites de coins, rayon, longueur et durée.
- 5. Raccourcir et revérifier
Les raccourcis passent le même test d’empreinte balayée et conservent les points d’approche portuaire protégés. Renvoie points vérifiés et dégagement minimal, ou une erreur si aucune route admissible n’existe.
- 6. Vitesse et propulsion
Le meneur du voyage freine pour les virages et l’erreur de cap, applique une rampe d’accélération, un PI de vitesse et une poussée différentielle. Le suiveur anticipe sur la trace mesurée du meneur ; inclinaison et vitesse de rapprochement bornent les commandes.
- 7. Retour mesuré et mise à jour
Gazebo applique les forces et restitue le mouvement. Progression, stabilité et couverture du terrain et des capteurs sont surveillées. Le véhicule attend avant une zone non vérifiée ; de nouveaux objectifs ou conditions peuvent imposer une replanification.
Après une récupération prolongée sans progression, LIVE peut utiliser un corridor de haute mer vérifié. Une fois le mouvement repris, il cherche périodiquement à rejoindre la côte cartographiée et à la suivre. Chaque tronçon exige encore les contrôles de terre et de profondeur numérique. L’approche portuaire fixe reste obligatoire et son entrée est rejointe par un corridor vérifié.
La traversée LIVE utilise des liaisons côtières cartographiques comme guidage temporaire. Lorsque la position mesurée rapproche le bateau de la cible de route d’au moins 50 m de plus que le dernier repère de la liaison, ce guidage est libéré et la suite est recalculée. Chaque nouveau couloir de propulsion exige toujours la vérification des exclusions terrestres et de la profondeur numérique.
Après plusieurs tentatives de récupération régionale et dix minutes sans progrès mesuré, LIVE peut chercher une liaison complète vers la route dans une fenêtre de terrain de 16 km. Il suit les virages retenus dans l’ordre et valide chaque tronçon de propulsion sur le terrain natif courant et les terres cartographiées.
Catalogue de planification
| Couche | Méthode et portée |
|---|---|
| Route géographique | Destinations, portes d’arrivée, passages et polygones terrestres produisent le guidage longue distance. Les coordonnées du catalogue portuaire diffèrent des cibles d’arrivée navigables. |
| Champ de terrain | Grilles numériques confirmées dans un repère commun. Découpage exact des triangles pour trouver le fond le plus haut ; borne supérieure par filtre de maximum SciPy. Les zones inconnues ou hors limites restent indisponibles ; la couleur satellite ne fournit pas une profondeur. |
| Dégagement balayé | Échantillonnage des segments au plus tous les 1 m, avec une demi-distance supplémentaire sur l’empreinte. Pour un tronçon changeant de profondeur, utilise l’extrémité la plus profonde. C’est une enveloppe conservative, pas une prédiction complète du mouvement futur à six degrés de liberté. |
| Recherche locale | Segment direct, puis A* à huit voisins et contrôle conservatif des coins. Valeurs usuelles : maille de 4 m, rayon de 600 m, route de 2 000 m et budget de 25 s. L’appelant peut définir d’autres limites. |
| Marges du véhicule | Surface : rayon de coque 3,5 m, marge de suivi initiale 4 m, dégagement du fond 1,5 m. Sous-marin : 0,5 m, 2 m et 1 m. Le WAM-V personnel peut réduire le suivi à 2 m sans réduire le dégagement en profondeur. |
| Résultat et surveillance | Points vérifiés, marge retenue, informations de grille/budget et dégagement minimal représenté. La surveillance du couloir ou de la couverture peut arrêter l’exécution. Échec de planification, sortie de couloir et absence de données restent distincts. |
Les marges portent sur le terrain représenté ; elles ne certifient pas la précision hydrographique. Une route valide ne garantit pas non plus son suivi dans les conditions choisies. Marqueurs AIS, bateau visible ou topic LiDAR disponible ne prouvent ni évitement dynamique ni conformité COLREG : cela dépend du contrôleur de l’expérience.
Récupération côtière sur terrain chargé dans LIVE
La recherche utilise le terrain numérique chargé et exclut les terres cartographiées. La bande habituelle de 1,5 km depuis la côte contraint la recherche elle-même. Sans continuation vérifiée dans cette bande, un détour borné peut atteindre 2 km au large, puis se terminer à nouveau dans la bande habituelle.
- Avancée minimale du point final : 500 m ; à moins de 5 km de la cible, 10 % de la distance restante.
- Exclusion des hauts-fonds : 200 m.
- Profondeur représentée minimale : 2 m.
- Longueur maximale du couloir : 12 km.
L’exécution native revérifie chaque portion bornée. Les nouveaux points finaux évitent les zones récemment quittées. Un couloir complet et vérifié peut les traverser puis continuer au-delà. Une route avançant de moins de 50 m les évite sur tout son trajet. Cette mémoire de récupération ne modifie pas le contrôle physique de sécurité de la coque.
Voies de commande et retour d’état
| Voie | Entrée, implémentation et sortie | Interprétation |
|---|---|---|
| ArduPilot personnel | Cibles guidées ou entrées manuelles → ArduRover/ArduSub SITL via MAVROS et l’interface JSON Gazebo → canaux d’actionnement. | Source de navigation, EKF, mode, armement et affectation des actionneurs influencent le résultat. Voir GNSS et navigation. |
| ROS 2 direct | Nœud utilisateur → topics autorisés et affectation choisie → forces Gazebo. | L’utilisateur fournit la loi de commande. Publier une cible ou une vitesse ne mesure pas le mouvement obtenu. |
| Meneur du voyage | Points vérifiés → freinage en virage, réduction selon l’erreur de cap, rampe d’accélération, PI à intégrale bornée et poussée différentielle. | Retour du mouvement mesuré dans le repère du corps ; période nominale 0,05 s. La perte du signal de présence inhibe les commandes. |
| Suiveur du voyage | Trace mesurée du meneur, séparation et rapprochement → anticipation, limites de vitesse/virage et freinage → propulsion. | Écart nominal de 38 m entre origines des coques. Contrôleur de démonstration, pas preuve d’évitement pour une flotte. |
| Récupération | Une politique explicite peut demander un remorquage physique borné, conservant masse, contacts et traînée. | Consigner ce mode séparément. Le remorquage du meneur est limité à 900 N et à une vitesse demandée de 0,8 m/s. |
Dans les sessions où le GNSS est configuré, les missions revalident la route depuis la position mesurée après l’armement et la stabilisation de la navigation, avant d’envoyer la première destination. La stabilisation exige une pose locale récente de la FCU et une fusion GNSS valide ou une fusion externe de capteurs acceptée. Le fix GPS brut du récepteur reste un état distinct ; voir GNSS et navigation.
Les missions personnelles WAM-V utilisent par défaut la mise en forme des entrées (GUID_OPTIONS=0). Sans cap explicite, elles renouvellent la position cible d’origine toutes les deux secondes de simulation hors du rayon d’arrivée de 0.75 m et demandent une vitesse et une vitesse de lacet nulles à l’intérieur. Un profil enregistré dont le bit 64 est activé conserve le planificateur de points de passage à courbes S d’ArduRover. BlueROV2 renouvelle ses positions cibles toutes les deux secondes de simulation avec le contrôleur de points de passage d’ArduSub. La fraîcheur de la télémétrie est mesurée en temps réel ; les contrôles de navigation et de dégagement du terrain restent actifs pendant le trajet.
Lorsqu’un bateau à moteur reçoit une consigne Guided valide avec une vitesse et une vitesse de lacet nulles, ArduRover inclus maintient son PID de vitesse actif pour contrer la dérive vers l’avant et l’arrière. Cette commande régule la vitesse ; la correction vers la position définie commence hors de la zone d’arrivée. Les voiliers, les consignes expirées et les autres modes de commande conservent leur comportement d’arrêt configuré.
Lorsque la consigne limitée en accélération est nulle, le contrôleur de vitesse efface son intégrale au premier arrêt mesuré. Hors de la bande de vitesse d’arrêt configurée, il efface aussi l’intégrale conservée qui accélérerait le bateau dans le sens de sa dérive. L’intégrale de freinage opposée et la compensation dans la bande d’arrêt restent actives.
Le profil personnel par défaut utilise WP_SPEED=0.5 m/s, ATC_STOP_SPEED=0.02 m/s et ATC_STR_RAT_I=0.
Le greffon SITL interpole les états des capteurs entre les étapes physiques terminées, avec des fréquences cibles de 200 Hz pour Rover et 1000 Hz pour Sub. Modifier l’intervalle physique change le nombre d’échantillons intermédiaires. Chaque intervalle se termine à l’état physique et à l’horodatage d’origine. La résolution physique dépend du pas de simulation physique.
La démonstration publique WAM-V sélectionne la mise en forme d’entrée (GUID_OPTIONS=0) et actualise le point de passage d’origine toutes les deux secondes simulées. Elle utilise WP_RADIUS=0.2 m, LOIT_RADIUS=0.1 m et LOIT_SPEED_GAIN=1.0 pour l’approche et le maintien de position dans les vagues. L’arrivée exige toujours une précision horizontale de 0.75 m. Les espaces personnels conservent leurs paramètres sélectionnés.
Restaurer un point de reprise ou déplacer l’origine modifie aussi états ou coordonnées. Le changement d’origine transforme terrain, route et trace tout en conservant les vitesses physiques ; il ne faut pas le dériver comme un déplacement réel. Conservez les événements de récupération, réinitialisation et changement d’origine lors de l’évaluation du suivi ou de l’énergie.
La paire native meneur/suiveur appartient à LIVE. Les sessions personnelles utilisent ArduPilot ou ROS 2 selon leur configuration. Le WAM-V personnel essaie un rayon de coque de 3,5 m et une marge de suivi de 4 m ; si le départ ou le passage est bloqué, il réessaie avec 2 m sans diminuer le dégagement de profondeur de 1,5 m. Quitter le couloir retenu arrête la mission.
Implémentation et lectures associées
POSIM-Routing fournit navigation, planification et liaisons côtières/portuaires. POSIM-Control contient Pilot.cc et Follower.cc ; ses politiques Python règlent vitesse et stabilité. WWW-POSIM coordonne les sessions, sélectionne le contrôleur et applique les garde-fous des missions personnelles. Utilisez les révisions retenues par l’application.
Tour du monde en direct · Commander un espace de travail local · Algorithmes de génération du terrain