4.2 机器人动力学方程