ヒューリスティック誘導による動作プリミティブ枝刈りと疎帯構造を用いた経路最適化に基づく効率的動作計画E³MoP
E$ \mathbf{^3} $MoP: Efficient Motion Planning Based on Heuristic-Guided Motion Primitives Pruning and Path Optimization With Sparse-Banded Structure
大規模で部分的に未知な複雑環境での自律ナビゲーションのため、大域経路計画・局所経路最適化・時間最適速度計画の3層からなる動作計画フレームワークを提案し、動作プリミティブのヒューリスティック枝刈りと疎帯構造を活用した最適化で計算効率を大幅に改善した。
著者: Jian Wen, Xuebo Zhang, Haiming Gao, Jing Yuan, Yongchun Fang
分類: cs.RO
原文アブストラクト
To solve the autonomous navigation problem in complex environments, an efficient motion planning approach is newly presented in this paper. Considering the challenges from large-scale, partially unknown complex environments, a three-layer motion planning framework is elaborately designed, including global path planning, local path optimization, and time-optimal velocity planning. Compared with existing approaches, the novelty of this work is twofold: 1) a novel heuristic-guided pruning strategy of motion primitives is proposed and fully integrated into the state lattice-based global path planner to further improve the computational efficiency of graph search, and 2) a new soft-constrained local path optimization approach is proposed, wherein the sparse-banded system structure of the underlying optimization problem is fully exploited to efficiently solve the problem. We validate the safety, smoothness, flexibility, and efficiency of our approach in various complex simulation scenarios and challenging real-world tasks. It is shown that the computational efficiency is improved by 66.21% in the global planning stage and the motion efficiency of the robot is improved by 22.87% compared with the recent quintic B\'{e}zier curve-based state space sampling approach. We name the proposed motion planning framework E$ \mathrm{^3} $MoP, where the number 3 not only means our approach is a three-layer framework but also means the proposed approach is efficient in three stages.
