9.3.4 运动学正逆解的实现