A Rapid Trajectory Planning Method for Heterogeneous Swarms via Fusion of Visual Navigation and Explainable Decision Trees

For complex tasks such as search and recovery in uncharted maritime areas, the use of heterogeneous unmanned swarms (UAVs and USVs) is highly promising, yet effective cross-domain cooperative trajectory planning remains a key challenge, often leading to mission delays. This paper proposes a rapid Cooperative Cross-domain Path Planning framework (CCPP) and its associated algorithm for heterogeneous UAV–USV swarms. The framework first establishes a visual-fusion modeling pipeline, converting visual pose estimation, uncertainties, and semantic dynamic obstacles into a planning representation with robust safety margins and time-varying risk fields. A hybrid velocity-path co-optimization algorithm is then designed to simultaneously generate curvature-feasible trajectories and speed profiles under heterogeneous kinematics and explicit temporal constraints. In the end, an adaptive interpretable decision tree acts as a meta-strategy for online replanning and real-time adjustment of modes and weights. To address the critical issue of uneven arrival time distribution, this paper introduces, inspired by economic inequality analysis, a normalized Gini coefficient-based arrival time consistency index to quantify and optimize coordination timing. Comprehensive experiments validate the effectiveness of the proposed approach in enhancing cooperative efficiency and real-time adaptability.