Chap03_Manipulator kinematics