FAPP: Fast and Adaptive Perception and Planning for UAVs in Dynamic Cluttered Environments

Minghao Lu,Xiyu Fan,Han Chen,Peng Lu
2023-12-14
Abstract:Obstacle avoidance for Unmanned Aerial Vehicles (UAVs) in cluttered environments is significantly challenging. Existing obstacle avoidance for UAVs either focuses on fully static environments or static environments with only a few dynamic objects. In this paper, we take the initiative to consider the obstacle avoidance of UAVs in dynamic cluttered environments in which dynamic objects are the dominant objects. This type of environment poses significant challenges to both perception and planning. Multiple dynamic objects possess various motions, making it extremely difficult to estimate and predict their motions using one motion model. The planning must be highly efficient to avoid cluttered dynamic objects. This paper proposes Fast and Adaptive Perception and Planning (FAPP) for UAVs flying in complex dynamic cluttered environments. A novel and efficient point cloud segmentation strategy is proposed to distinguish static and dynamic objects. To address multiple dynamic objects with different motions, an adaptive estimation method with covariance adaptation is proposed to quickly and accurately predict their motions. Our proposed trajectory optimization algorithm is highly efficient, enabling it to avoid fast objects. Furthermore, an adaptive re-planning method is proposed to address the case when the trajectory optimization cannot find a feasible solution, which is common for dynamic cluttered environments. Extensive validations in both simulation and real-world experiments demonstrate the effectiveness of our proposed system for highly dynamic and cluttered environments.
Robotics,Systems and Control
What problem does this paper attempt to address?
### Problems the Paper Aims to Solve This paper aims to address the obstacle avoidance problem for Unmanned Aerial Vehicles (UAVs) in dynamic and complex environments. Specifically, existing UAV obstacle avoidance technologies mainly focus on static or environments with only a few dynamic objects. However, in dynamic and complex environments (i.e., environments where dynamic objects are the main obstacles), traditional perception and planning methods face significant challenges. These challenges include: 1. **Increased Perception Difficulty**: It is necessary to distinguish multiple dynamic objects, and different objects have different motion patterns, making a single motion model difficult to apply. 2. **High Planning Efficiency Requirements**: To avoid fast-moving objects, the path planning algorithm must be efficient. 3. **Replanning Needs**: In highly dynamic and complex environments, path optimization may not find a feasible solution, thus requiring an adaptive replanning strategy. To address the above issues, this paper proposes a Fast Adaptive Perception and Planning (FAPP) system. The main innovations of this system include: - Proposing a novel and efficient point cloud segmentation strategy that can effectively distinguish between static and dynamic objects. - Developing an adaptive estimation method that can quickly and accurately predict the motion of multiple dynamic objects. - Designing an adaptive replanning method to handle situations where path optimization cannot find a feasible solution. - Validating the effectiveness of the system in both simulated and real experiments, especially in highly dynamic and complex environments.