机器人拉格朗日函数