Chap04_Inverse manipulator kinematics