Creating Better Collision-Free Trajectory for Robot Motion Planning by Linearly Constrained Quadratic Programming.
Yizhou Liu,Fusheng Zha,Mantian Li,Wei Guo,Yunxin Jia,Pengfei Wang,Yajing Zang,Lining Sun
DOI: https://doi.org/10.3389/fnbot.2021.724116
IF: 3.493
2021-01-01
Frontiers in Neurorobotics
Abstract:Many algorithms in probabilistic sampling-based motion planning have been proposed to create a path for a robot in an environment with obstacles. Due to the randomness of sampling, they can efficiently compute the collision-free paths made of segments lying in the configuration space with probabilistic completeness. However, this property also makes the trajectories have some unnecessary redundant or jerky motions, which need to be optimized. For most robotics applications, the trajectories should be short, smooth and keep away from obstacles. This paper proposes a new trajectory optimization technique which transforms a polygon collision-free path into a smooth path, and can deal with trajectories which contain various task constraints. The technique removes redundant motions by quadratic programming in the parameter space of trajectory, and converts collision avoidance conditions to linear constraints to ensure absolute safety of trajectories. Furthermore, the technique uses a projection operator to realize the optimization of trajectories which are subject to some hard kinematic constraints, like keeping a glass of water upright or coordinating operation with dual robots. The experimental results proved the feasibility and effectiveness of the proposed method, when it is compared with other trajectory optimization methods.