无需建图,用双KD树加速MPC实现高精度避障飞行。
Mapless Collision-Free Flight via MPC using Dual KD-Trees in Cluttered Environments
- 用双KD树动态优化避障路径,提升MPC求解效率。
- 实测最高速度达6米/秒,仿真中可达12米/秒。
- 适合追求实时性与鲁棒性的无人机自主飞行场景。
在复杂环境中实现无碰撞飞行是自主四旋翼的重要能力。传统方法依赖于详细3D地图构建、轨迹生成与跟踪,但该流水线易引入累积误差和计算延迟,限制飞行敏捷性与安全性。本文提出一种新方法,无需显式构建3D地图或生成跟踪避障轨迹,直接利用模型预测控制(MPC)从稀疏航点和深度相机获取的点云中生成安全动作。航点在线根据点云检测到的邻近障碍物动态调整。为此,我们引入双KD树机制:障碍物KD树快速识别最近障碍物用于避障,边缘KD树为MPC求解器提供鲁棒初始猜测,避免陷入局部最优。通过大量仿真与真实实验验证,本方法显著优于基于地图的方法,并超越基于模仿学习的方法,在仿真中实现最高12米/秒、真实测试中达6米/秒的可靠避障性能。代码已开源:https://github.com/SJTU-ViSYS-team/avoid-mpc。
原文摘要 · Abstract (English)
Collision-free flight in cluttered environments is a critical capability for autonomous quadrotors. Traditional methods often rely on detailed 3D map construction, trajectory generation, and tracking. However, this cascade pipeline can introduce accumulated errors and computational delays, limiting flight agility and safety. In this paper, we propose a novel method for enabling collision-free flight in cluttered environments without explicitly constructing 3D maps or generating and tracking collision-free trajectories. Instead, we leverage Model Predictive Control (MPC) to directly produce safe actions from sparse waypoints and point clouds from a depth camera. These sparse waypoints are dynamically adjusted online based on nearby obstacles detected from point clouds. To achieve this, we introduce a dual KD-Tree mechanism: the Obstacle KD-Tree quickly identifies the nearest obstacle for avoidance, while the Edge KD-Tree provides a robust initial guess for the MPC solver, preventing it from getting stuck in local minima during obstacle avoidance. We validate our approach through extensive simulations and real-world experiments. The results show that our approach significantly outperforms the mapping-based methods and is also superior to imitation learning-based methods, demonstrating reliable obstacle avoidance at up to 12 m/s in simulations and 6 m/s in real-world tests. Our method provides a simple and robust alternative to existing methods. The code is publicly available at https://github.com/SJTU-ViSYS-team/avoid-mpc.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。