INFO:
机器人学 3.2 拉格朗日动力学算法(Lagrangian mechanics