3次元非ホロノミックロボットのための新しいベクトル場に基づく運動計画アルゴリズム
A Novel Vector-Field-Based Motion Planning Algorithm for 3D Nonholonomic Robots
3次元空間で動く非ホロノミックロボットに対し、目標位置と最終姿勢角の両方を指定できるベクトル場ベースの運動計画法を提案し、障害物や複数ロボットとの衝突回避も実現した。
著者: Xiaodong He, Weijia Yao, Zhiyong Sun, Zhongkui Li
分類: cs.RO, cs.SY, eess.SY
原文アブストラクト
This paper focuses on the motion planning for mobile robots in 3D, which are modelled by 6-DOF rigid body systems with nonholonomic kinematics constraints. We not only specify the target position, but also bring in the requirement of the heading direction at the terminal time, which gives rise to a new and more challenging 3D motion planning problem. The proposed planning algorithm involves a novel velocity vector field (VF) over the workspace, and by following the VF, the robot can be navigated to the destination with the specified heading direction. In order to circumvent potential collisions with obstacles and other robots, a composite VF is designed by composing the navigation VF and an additional VF tangential to the boundary of the dangerous area. Moreover, we propose a priority-based algorithm to deal with the motion coupling issue among multiple robots. Finally, numerical simulations are conducted to verify the theoretical results.
