Inverse kinematics 6 axis robot