22 December 2025 in IEEE Access
Trajectory planning in dynamic environments is crucial for safe and efficient navigation of UAVs, particularly in scenarios involving unknown dynamic obstacles. The Trajectory Planner in Multiagent and Dynamic Environments (MADER) algorithm has been successfully used for this purpose; however, it assumes perfect knowledge of the future trajectories of the dynamic obstacles. In practical scenarios, the future trajectory of the obstacles may not be known in advance. To address this limitation, we propose POF+MADER, an enhanced version that integrates a probabilistic obstacle filter with adaptive prediction horizons based on obstacle velocity. Our approach integrates a decentralized real-time Kalman Filter-based trajectory estimation with MADER’s planning core, eliminating the need for perfect a priori knowledge. We validate our approach through simulations with sensor noise (σ = 0.2 − 0.5m) to simulate realworld localization uncertainty, with performance benchmarked against the MADER, Robust-MADER, and Ego-Swarm planner baselines. To further demonstrate its practical applicability, we conducted real-world experiments on the Crazyflie UAV platform, comparing its performance to the original MADER algorithm. Results show a 38.75% collision rate reduction in simulation and a 25% reduction in real-world experiments, without a significant increase in average navigation time. Furthermore, even in the presence of real-time sensor-induced noise in obstacle position measurements, our approach consistently outperforms the baseline planners, demonstrating its robustness in trajectory planning under perception uncertainty.