移動障害物環境下でのAGVリアルタイム軌道計画:探索後最適化アプローチ
Real-Time Trajectory Planning for AGV in the Presence of Moving Obstacles: A First-Search-Then-Optimization Approach
移動障害物がある環境でAGVの軌道計画を最適制御問題として定式化し、A*探索で初期解を生成してから非線形計画法で最適化することで、リアルタイムに高精度な軌道を求める手法を提案した。
著者: Bai Li, Youmin Zhang, Yakun Ouyang, Yi Liu, Xiang Zhong, Hangjie Cen, Qi Kong
分類: cs.RO
原文アブストラクト
This paper focuses on automatic guided vehicle (AGV) trajectory planning in the presence of moving obstacles with known but complicated trajectories. In order to achieve good solution precision, optimality and unification, the concerned task should be formulated as an optimal control problem, and then discretized into a nonlinear programming (NLP) problem, which is numerically optimized thereafter. Without a near-feasible or near-optimal initial guess, the NLP-solving process is usually slow. With the purpose of accelerating the NLP solution, a search-based rough planning stage is added to generate appropriate initial guesses. Concretely, a continuous state space is formulated, which consists of Cartesian product of 2D configuration space and a time dimension. The rough trajectory is generated by a graph-search based planner, namely the A* algorithm. Herein, the nodes in the graph are constructed by discretizing the aforementioned continuous spatio-temporal space. Through this first-search-then-optimization framework, optimal solutions to unified trajectory planning problems can be obtained fast. Simulations have been conducted to verify the real-time performance of our proposal.
