A new and efficient algorithm for the inverse kinematics of a general serial \(6R\) manipulator. (English) Zbl 1116.70010

Summary: We present a new and very efficient algorithm to compute the inverse kinematics of a general \(6R\) serial kinematic chain. The main idea is to make use of classical multidimensional geometry to structure the problem and to use the geometric information before starting the elimination process. For the geometric pre-processing we utilize the Study model of Euclidean displacements, sometimes called kinematic image, which identifies a displacement with a point on a six-dimensional quadric \(S^2_6\) in seven-dimensional projective space \(P^7\). The \(6R\)-chain is broken up in the middle to form two open \(3R\)-chains. The kinematic image of a \(3R\)-chain turns out to be a Segre manifold consisting of a one-parameter set of 3-spaces. The intersection of two Segre manifolds and \(S^2_6\) yields 16 points which are the kinematic images representing the 16 solutions of the inverse kinematics. Algebraically this procedure means that we have to solve a system of seven linear equations and one resultant to arrive at the univariate 16 degree polynomial. From this step in the algorithm we get two out of the six joint angles, and the remaining four angles are obtained straight forwardly by solving the inverse kinematics of two \(2R\)-chains.


70B15 Kinematics of mechanisms and robots
53A17 Differential geometric aspects in kinematics
Full Text: DOI