机器人运动方程推导与应用