EGO-Planner: An ESDF-Free Gradient-Based Local Planner for Quadrotors

Xin Zhou,Zhepei Wang,Hongkai Ye,Chao Xu,Fei Gao

DOI: https://doi.org/10.1109/lra.2020.3047728

IF: 5.2

2021-04-01

IEEE Robotics and Automation Letters

Abstract:Gradient-based planners are widely used for quadrotor local planning, in which a Euclidean Signed Distance Field (ESDF) is crucial for evaluating gradient magnitude and direction. Nevertheless, computing such a field has much redundancy since the trajectory optimization procedure only covers a very limited subspace of the ESDF updating range. In this letter, an ESDF-free gradient-based planning framework is proposed, which significantly reduces computation time. The main improvement is that the collision term in penalty function is formulated by comparing the colliding trajectory with a collision-free guiding path. The resulting obstacle information will be stored only if the trajectory hits new obstacles, making the planner only extract necessary obstacle information. Then, we lengthen the time allocation if dynamical feasibility is violated. An anisotropic curve fitting algorithm is introduced to adjust higher order derivatives of the trajectory while maintaining the original shape. Benchmark comparisons and real-world experiments verify its robustness and high-performance. The source code is released as ros packages.

robotics

What problem does this paper attempt to address?

The paper attempts to address the problem of reducing the time required to compute the Euclidean Signed Distance Field (ESDF) in local path planning for quadrotors, thereby improving planning efficiency. Traditional gradient-based planning methods rely on a pre-constructed ESDF to evaluate the magnitude and direction of gradients and use numerical optimization to generate locally optimal solutions. However, constructing the ESDF consumes a significant amount of processing time, approximately 70% of the total processing time, which becomes the main bottleneck limiting the application of these methods on resource-constrained platforms.

To overcome this challenge, the paper proposes a gradient-based local planning framework (EGO-Planner) that does not rely on the ESDF. The main improvement of this framework is the construction of the collision term in the penalty function by comparing collision trajectories with collision-free guiding paths, storing only the necessary obstacle information when the trajectory encounters new obstacles, thereby significantly reducing computation time. Additionally, the paper introduces an anisotropic curve fitting algorithm to adjust the higher-order derivatives of the trajectory while maintaining the original shape to ensure dynamic feasibility. The robustness and high performance of this method are validated through benchmarks and real-world experiments.