摘要
采用Udwadia-Kalaba方程构建的操作臂轨迹跟踪控制器名义模型中,初始条件难以满足约束方程,数值求解过程产生误差累积造成的约束违约是亟待解决的问题。通过在数值求解过程所产生位置和速度项上添加修正项直接消除违约误差的方法,对该问题进行了研究。根据Udwadia-Kalaba建模思想,构建了期望轨迹下三杆操作臂的动力学名义模型并进行轨迹跟踪仿真。分别利用传统的Baumgarte约束稳定法与所提出误差直接消除法对仿真数值结果进行了修正。结果显示,所提误差直接消除法可更加快速直接地将约束违约控制在更小范围,更适用于操作臂动力学名义模型修正的使用。
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 viola- tion 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 elimina- tion method.The results show that the direct elimination method can control the constraint violation in a smal- ler range more quickly,and is more suitable for the use of trajectory correction to manipulator dynamic nominal model.
作者
吕桂志
刘荣
LYU Guizhi;LIU Rong(School of Mechanical Engineering and Automation,Beijing University of Aeronautics and Astronautics,Beijing 100083,China;School of Electromechanical Engineering,Heze University,Heze 274015,China)
出处
《北京航空航天大学学报》
EI
CAS
CSCD
北大核心
2018年第11期2305-2311,共7页
Journal of Beijing University of Aeronautics and Astronautics
