Udwadia-Kalaba方程构建操作臂名义模型的违约消除

采用Udwadia-Kalaba方程构建的操作臂轨迹跟踪控制器名义模型中，初始条件难以满足约束方程，数值求解过程产生误差累积造成的约束违约是亟待解决的问题。通过在数值求解过程所产生位置和速度项上添加修正项直接消除违约误差的方法，对该问题进行了研究。根据Udwadia-Kalaba建模思想，构建了期望轨迹下三杆操作臂的动力学名义模型并进行轨迹跟踪仿真。分别利用传统的Baumgarte约束稳定法与所提出误差直接消除法对仿真数值结果进行了修正。结果显示，所提误差直接消除法可更加快速直接地将约束违约控制在更小范围，更适用于操作臂动力学名义模型修正的使用。

Violation elimination of nominal models for manipulators constructed with Udwadia-Kalaba equation

In the nominal model of the manipulator trajectory tracking controller constructed by Udwadia-Kalaba equation, the initial conditions are difficult to satisfy the constraint equations, and the constraint violation is generated by the accumulation of errors in the process of numerical solution, which are all problems to be solved at present. Problems are solved by the method of eliminating violation errors directly. This method adds correction items to position and speed terms which are produced by the numerical solution process. The dynamic nominal model of the three-link manipulator is constructed, and the trajectory tracking simulation is carried out under the desired trajectory based on the Udwadia-Kalaba modeling idea. The simulation numerical results are corrected by using the traditional Baumgarte stability method and the proposed error direct elimination method. The results show that the direct elimination method can control the constraint violation in a smaller range more quickly, and is more suitable for the use of trajectory correction to manipulator dynamic nominal model.