“…Inverse kinematics is an analysis method that joint angles can be solved with known position and orientation of the end-effector. Suppose the position and orientation vector of the end-effector is q = ½n x , n y , n z , o x , o y , o z , a x , a y , a z , p x , p y , p z T 2 R 12 3 1 , where p x , p y , p z are the position parameters along X, Y, and Z axis, then n x , n y , n z , o x , o y , o z , a x , a y , a z are the orientation parameters respectively 28 q is determined by the six variables p x , p y , p z, a, b, g. Suppose the measured position and orientation vector in the robot system (or converted in the robot system) is q m , target position and orientation vector in the robot system (or converted in the robot system) is q t . The actual and theoretical forward kinematic operators are respectively…”