北京航空航天大学学报 ›› 2018, Vol. 44 ›› Issue (11): 2305-2311.doi: 10.13700/j.bh.1001-5965.2018.0076

• 论文 • 上一篇    下一篇

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

吕桂志1,2, 刘荣1   

  1. 1. 北京航空航天大学 机械工程与自动化学院, 北京 100083;
    2. 菏泽学院 机电工程学院, 菏泽 274015
  • 收稿日期:2018-02-08 修回日期:2018-04-27 出版日期:2018-11-20 发布日期:2018-11-27
  • 通讯作者: 刘荣,E-mail:rliu@buaa.edu.cn E-mail:rliu@buaa.edu.cn
  • 作者简介:吕桂志,男,博士研究生,讲师。主要研究方向:工业机器人动力学及控制;刘荣,男,博士,教授,博士生导师。主要研究方向:工业机器人、爬壁机器人。

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

LYU Guizhi1,2, LIU Rong1   

  1. 1. School of Mechanical Engineering and Automation, Beijing University of Aeronautics and Astronautics, Beijing 100083, China;
    2. School of Electromechanical Engineering, Heze University, Heze 274015, China
  • Received:2018-02-08 Revised:2018-04-27 Online:2018-11-20 Published:2018-11-27

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

关键词: 机器人操作臂, 动力学建模, 违约消除, 约束流形, Udwadia-Kalaba方程

Abstract: 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.

Key words: robotic manipulator, dynamic modeling, violation elimination, constrained manifold, Udwadia-Kalaba equation

中图分类号: 


版权所有 © 《北京航空航天大学学报》编辑部
通讯地址:北京市海淀区学院路37号 北京航空航天大学学报编辑部 邮编:100191 E-mail:jbuaa@buaa.edu.cn
本系统由北京玛格泰克科技发展有限公司设计开发