展开 拉格朗日动力学公式求机械臂力矩