Globally Optimal Solution to Inverse Kinematics of 7DOF Serial Manipulator

Pavel Trutman (1) , Mohab Safey El Din (2) , Didier Henrion (3) , Tomas Pajdla (1)

1 CIIRC - Czech Institute of Informatics, Robotics and Cybernetics [Prague]
2 PolSys - Polynomial Systems
3 LAAS-MAC - Équipe Méthodes et Algorithmes en Commande

The Inverse Kinematics (IK) problem is concerned with finding robot control parameters to bring the robot into a desired position under the kinematics and collision constraints. We present a global solution to the optimal IK problem for a general serial 7DOF manipulator with revolute joints and a quadratic polynomial objective function. We show that the kinematic constraints due to rotations can be all generated by the second-degree polynomials. This is an important result since it significantly simplifies the further step where we find the optimal solution by Lasserre relaxations of nonconvex polynomial systems. We demonstrate that the second relaxation is sufficient to solve a general 7DOF IK problem. Our approach is certifiably globally optimal. We demonstrate the method on the 7DOF KUKA LBR IIWA manipulator and show that we are in practice able to compute the optimal IK or certify infeasibility in 99.9 % tested poses. We also demonstrate that by the same approach, we are able to solve the IK problem for a random generic manipulator with seven revolute joints.

Domaines: Optimisation et contrôle [math.OC]; Robotique [cs.RO]; Calcul formel [cs.SC]

Pavel Trutman, Mohab Safey El Din, Didier Henrion, Tomas Pajdla. Globally Optimal Solution to Inverse Kinematics of 7DOF Serial Manipulator. IEEE Robotics and Automation Letters, 2022, 7 (3), pp.6012 - 6019. ⟨10.1109/LRA.2022.3163444⟩. ⟨hal-02905816v2⟩