机械手模型

结束了机械手的模型，根据这一模型，利用拉格朗日函数建立了动力学方程