TORM: Collision-Free Trajectory Optimization of Redundant Manipulator given an End-Effector Path

A redundant manipulator has multiple inverse kinematics solutions per an end-effector pose. Accordingly, there can be many trajectories for joints that follow a given end-effector path in a Cartesian space. In this paper, we present a trajectory optimization of a redundant manipulator (TORM) to synthesize a trajectory that follows a given end-effector path accurately, while achieving the smoothness and collision-free manipulation. Given these desirable properties, our method optimizes a trajectory using two-stage gradient descent to reduce potential competition between different properties during the update. To further improve the performance and avoid falling into local minima, we apply the quantum annealing that iteratively randomizes various configurations of the trajectory, followed by updating the trajectory. We first show benefits of our method with environments containing external obstacles. We then compare ours with the state-of-the-art methods in their favorable setting, environments without having obstacles. Our method robustly minimizes the pose error in a progressive manner while satisfying various desirable properties.