Particle Swarm Optimization for high-DOF inverse kinematics

The inverse kinematics (IK) problem is a fundamental problem in robotic manipulation. Traditional, Jacobian-based solutions to this problem are known to scale poorly with the number of degrees of freedom (DOF) in the manipulator, necessitating novel IK solutions for high-DOF manipulators. Metaheuristic optimization algorithms such as Particle Swarm Optimization (PSO) are a promising alternative approach to traditional IK techniques due to their strong performance on difficult and high-DOF problems in many diverse domains. Previous applications of PSO to the IK problem have focused on specific classes (e.g., planar) or models of manipulators or specific IK subproblems (e.g., position only IK). Furthermore, the experimental validation of these techniques has considered only manipulators with seven or fewer degrees of freedom and taken place almost exclusively in simulation. In this paper, we (1) generalize previous work to derive a fitness function that can be minimized to solve the full position and orientation IK problem for any serial manipulator while respecting joint limits and avoiding self-collisions, (2) present the first statistical analysis of PSO as a high-DOF IK solver on simulated manipulators with up to 180 DOF using this fitness function, and (3) present an important validation of PSO-based IK using this fitness function on real-world hardware on a difficult precision manipulation task.