High-Speed Motion Planning with Object Acceleration Constraint for Industrial Robots

In this paper, we propose a new approach to efficiently plan trajectories for industrial robots, where total trajectory time is reduced while limiting the robot end-effector acceleration to a safe threshold, which guarantees an object to be transported safely without damage or spills. We also propose to solve the optimization problem in two steps by utilizing both the quadratic programming algorithm and sparse sequential quadratic programming method. The proposed two-step procedure empirically proves that computing time of solving the optimization problem is significantly reduced. Effectiveness of the proposed approach was verified in Drake, where the obtained results are highly promising.