Dynamic Mission Planning Framework for Collaborative Underwater Operations Using Behavior Trees

Abstract

This paper presents a behavior tree-based control architecture for end-to-end mission planning of an autonomous underwater vehicle (AUV) collaborating with a moving mothership in dynamic marine environments. The framework is organized into three phases—prepare and launch, execute the mission, and retrieval and docking—each encapsulated in an independent sub-tree to enable modular error handling and seamless phase transitions. The AUV and mothership operate entirely underwater, with real-time docking to a moving platform. An extended Kalman filter (EKF) fuses data from inertial, pressure, and acoustic sensors for accurate navigation and state estimation. At the same time, obstacle avoidance leverages forward-looking sonar (FLS)-based potential field methods to react to unpredictable underwater hazards. The system is implemented on the robot operating system (ROS) and validated in the Stonefish physics engine simulator. Simulation results demonstrate reliable mission execution, successful dynamic docking under communication delays and sensor noise, and robust retrieval from injected faults, confirming the validity and stability of the proposed architecture.