Système de docking autonome pour ROV BlueROV2 utilisant un sonar imageur Oculus M750d. Le robot doit détecter et entrer dans une cage sous-marine en s'appuyant uniquement sur les données sonar, sans vision optique.
Ce projet implémente un pipeline complet de perception et contrôle permettant à un BlueROV2 d'effectuer un docking autonome :
- Acquisition sonar - Driver Oculus M750d (données polaires)
- Traitement d'image - Filtrage et conversion polaire → cartésien
- Détection - Tracking des bords de cage (CSRT, Hough)
- Localisation - Estimation de pose relative (range, bearing, orientation)
- Contrôle - Asservissement PID (surge, sway, yaw)
- Mission - Machine d'états supervisée (7 états)
┌──────────────┐ ┌─────────────┐ ┌──────────────┐
│ Sonar Oculus │────▶│ Traitement │────▶│ Tracking │
│ M750d │ │ (Filtres) │ │ (Bords cage) │
└──────────────┘ └─────────────┘ └───────┬──────┘
│
┌──────────────────────────────────────────┘
│
▼
┌──────────────┐ ┌─────────────┐ ┌──────────────┐
│ Localisation │────▶│ Contrôle │────▶│ Mission │
│ (Pose 3D) │ │ (PID x/y/ψ)│ │ (États FSM) │
└──────────────┘ └─────────────┘ └──────────────┘
Docking_guerledan/ # Racine du dépôt GitHub
├── ros2_bluerov/ # Workspace ROS 2 principal
│ ├── src/
│ │ ├── sonar/ # Driver et simulation sonar Oculus
│ │ ├── traitement/ # Filtrage images sonar (polar/cartesian)
│ │ ├── tracking/ # Détection bords cage (CSRT, Hough)
│ │ ├── localisation/ # Estimation pose relative
│ │ ├── control/ # Contrôleurs PID
│ │ ├── mission/ # Machine d'états docking
│ │ ├── affichage/ # IHM Qt/PyQtGraph
│ │ ├── bringup/ # Launch files orchestration
│ │ ├── docking_msgs/ # Messages ROS custom
│ │ └── docking_utils/ # Utilitaires communs
│ ├── build/ # Dossier de compilation (généré)
│ └── install/ # Dossier d'installation (généré)
│
├── simulation/ # Simulation 2D Python (tests contrôle)
├── docs/ # Documentation et rapport LaTeX
├── divers/ # Archives codes expérimentaux
├── bluerov2/ # Description URDF et contrôleurs
└── bluerov_sim/ # Simulateur simple
- Ubuntu 22.04 LTS
- ROS 2 Humble (guide installation)
- Python 3.10+
- QGroundControl (téléchargement)
# MAVROS2 pour communication BlueROV
sudo apt install ros-humble-mavros ros-humble-mavros-extras
# Joystick support
sudo apt install ros-humble-joy
# Outils supplémentaires
sudo apt install sshpass ffmpegpip install numpy==1.24.0 opencv-python==4.2.0 opencv-contrib-python \
scipy pyautogui imutils vidgear brping PyQt5 pyqtgraph# Cloner le dépôt
git clone https://github.com/<votre-organisation>/Docking_guerledan.git
cd Docking_guerledan
# Compiler le workspace ROS 2
cd ros2_bluerov
colcon build --symlink-install
source install/setup.bash
# Ajouter au ~/.bashrc pour persistance
echo "source $(pwd)/install/setup.bash" >> ~/.bashrc# Script fourni dans le dépôt (depuis la racine du projet)
cd Docking_guerledan
bash install_geographiclib_datasets.shLance tous les nœuds avec le sonar Oculus physique :
ros2 launch bringup complete_pipeline.launch.pyNœuds lancés : sonar_driver, traitement, tracking, localisation, contrôle, mission, affichage
Rejoue des données sonar enregistrées :
ros2 launch bringup rosbag_pipeline.launch.pyIdéal pour développement sans matériel :
ros2 launch bringup user_pipeline.launch.pySonar mock : génère une cage synthétique avec bruit gaussien (configurable)
Une fois le pipeline lancé, démarrer la mission :
# Via topic ROS
ros2 topic pub /docking/mission/start std_msgs/Bool "data: true"
# Annuler la mission
ros2 topic pub /docking/mission/abort std_msgs/Bool "data: true"# État de la mission
ros2 topic echo /docking/mission/state
# Pose estimée
ros2 topic echo /docking/localisation/pose
# Commandes contrôle
ros2 topic echo /cmd_vel
# Graphe des nœuds
rqt_graph| Topic | Type | Description |
|---|---|---|
/docking/sonar/raw |
docking_msgs/Frame |
Données sonar brutes (polaire) |
/docking/sonar/filtered |
docking_msgs/Frame |
Image filtrée (cartésien) |
/docking/tracking/borders |
docking_msgs/Borders |
Bords cage détectés |
/docking/localisation/pose |
docking_msgs/PoseRelative |
Pose 3D estimée (x, y, ψ) |
/docking/mission/state |
docking_msgs/State |
État machine FSM |
/cmd_vel |
geometry_msgs/Twist |
Consignes vélocité ROV |
Chaque package possède son fichier de paramètres YAML :
sonar/config/sonar_params.yaml # Fréquence, résolution
traitement/config/traitement_params.yaml # Filtres (Gaussian, CLAHE, etc.)
tracking/config/tracking_params.yaml # Algorithmes détection
localisation/config/localisation_params.yaml # Modèle géométrique
control/config/control_params.yaml # Gains PID (Kp, Ki, Kd)
mission/config/mission_params.yaml # Timeouts, seuils FSM
Exemple : modifier les gains PID
# control/config/control_params.yaml
pid_surge:
kp: 0.5
ki: 0.01
kd: 0.1Test rapide des lois de commande du module bluerov_control0 (même dossier que utils_0.py) :
# Depuis la racine du projet
cd Docking_guerledan/ros2_bluerov/src/bluerov_basics/bluerov_control0/bluerov_control0
python3 test_simu_oriented.pyFonctionnalités :
- Simulation d'approche orientée vers la cage (
OrientedApproachController) - Affichage multi-robots avec trajectoires, cap et état du contrôleur
- Phases de mission : approche, orbite d'alignement, approche finale
- Utilise
plot_bluerov.pyetcontrol.pylocalement dans le packagebluerov_control0
# Depuis la racine du projet
cd Docking_guerledan/ros2_bluerov
colcon test
colcon test-result --verbosesonar_driver_node: Interface Oculus M750d (TCP)sonar_mock_node: Générateur cage synthétique
traitement_polar_node: Filtres sur données polairestraitement_cartesian_node: Conversion polar→cartesian + filtres
csrt_tracker_node: Tracking CSRT (OpenCV) [Utilisé]hough_lines_node: Détection Hough + filtrage [Utilisé]
localisation_node: Triangulation géométrique (range/bearing → pose 3D)
control_node: PID cascade (surge, sway, yaw)utils_0.py: utilitaires de pilotage BlueROV (gestion joystick, armement MAVROS, saturation commandes RC, modes de maintien cap/profondeur, aide au suivi de cible)test_simu_oriented.py: script de simulation locale pour valider l'approche orientée (hors pipeline ROS)
mission_node: FSM 7 états (IDLE, LOCK_ON, APPROACH, DOCKING, DOCKED, RECOVERY, ABORT)
ihm_node: Interface Qt temps réel (sonar, tracking, pose, graphes)
IDLE → LOCK_ON → APPROACH → DOCKING → DOCKED
↓ ↓ ↓
RECOVERY ←────┴──────────┘
↓
ABORT
Transitions :
IDLE→LOCK_ON: Cage détectéeLOCK_ON→APPROACH: Pose valide acquise (timeout 10s sinon RECOVERY)APPROACH→DOCKING: Distance < 1m ET aligné (|ψ| < 6°)DOCKING→DOCKED: Contact (y < 0.3m)*→RECOVERY: Perte pose (timeout 30s sinon ABORT)*→ABORT: Commande manuelle ou erreur critique
- Créer le nœud dans
tracking/tracking/ - Hériter de
rclpy.node.Node - Souscrire à
/docking/sonar/filtered - Publier sur
/docking/tracking/borders - Ajouter l'entry point dans
tracking/setup.py - Rebuild :
colcon build --packages-select tracking
# Activer logs détaillés
ros2 run tracking csrt_tracker_node --ros-args --log-level debug
# Enregistrer topics pour replay
ros2 bag record /docking/sonar/raw /docking/tracking/borders# Vérifier connexion réseau (IP : 10.0.0.1)
ping 10.0.0.1
# Tester driver
ros2 run sonar sonar_driver_node- Vérifier paramètres tracking dans
tracking/config/tracking_params.yaml - Visualiser l'image filtrée dans l'IHM
- Réduire seuils de détection
- Réduire gains PID dans
control/config/control_params.yaml - Vérifier orientation ROV (yaw)
- Tester en simulation 2D d'abord
- Rapport complet :
docs/Rapport_Docking/rapport.pdf - READMEs détaillés : Chaque package contient son propre README
- Analyse transformations :
ANALYSE_TRANSFORMATIONS.md
Projet académique ENSTA Bretagne - Guerlédan 2025/2026
Auteurs : Bourgeois Thomas, Dunot Clément, Lefèvre Maxime, Vidal Robin
Apache License 2.0
Contact : thomas.bourgeois@ensta.fr, clement.dunot@ensta.fr, maxime.lefevre@ensta.fr, robin.vidal@ensta.fr
Ressources :