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

doi:10.13700/j.bh.1001-5965.2018.0076

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

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

吕桂志^1,2, 刘荣¹

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 Guizhi^1,2, LIU Rong¹

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

摘要/Abstract

摘要： 采用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

中图分类号:

TH113

吕桂志, 刘荣. Udwadia-Kalaba方程构建操作臂名义模型的违约消除[J]. 北京航空航天大学学报, 2018, 44(11): 2305-2311.

LYU Guizhi, LIU Rong. Violation elimination of nominal models for manipulators constructed with Udwadia-Kalaba equation[J]. JOURNAL OF BEIJING UNIVERSITY OF AERONAUTICS AND A, 2018, 44(11): 2305-2311.

参考文献

[1] LIANG X,WAN Y,ZHANG C.Task space trajectory tracking control of robot manipulators with uncertain kinematics and dynamics[J].Mathematical Problems in Engineering,2017(2017):4275201.
[2] SAEED K,MEHDI F M.Uncertainty estimation in robust tracking control of robot manipulators using the Fourier series expansion[J].Robotica,2015,35(2):310-336.
[3] XIAO B,YIN S,KAYNAK O.Tracking control of robotic manipulators with uncertain kinematics and dynamics[J].IEEE Transactions on Industrial Electronics,2016,63(10):6439-6449.
[4] YAO J,DENG W.Active disturbance rejection adaptive control of uncertain nonlinear systems:Theory and application[J].Nonlinear Dynamics,2017,89(3):1611-1624.
[5] GALICKI M.Robust task space finite-time chattering-free control of robotic manipulators[J].Journal of Intelligent and Robotic Systems Theory and Applications,2017,85(3-4):471-489.
[6] UDWADIA F E,KALABA R E.A new perspective on constrained motion[J].Proceedings Mathematical and Physical Sciences,1992,439(1906):407-410.
[7] UDWADIA F E,KALABA R E.Equations of motion for mechanical systems:A unified approach[J].Journal of Aerospace Engineering,1996,9(3):64-69.
[8] UDWADIA F E,PHOHOMSIRI P.Explicit equations of motion for constrained mechanical systems with singular mass matrices and applications to multi-body dynamics[J].Proceedings:Mathematical,Physical and Engineering Sciences,2006,462(2071):2097-2117.
[9] SCHUTTE A,UDWADIA F.New approach to the modeling of complex multibody dynamical systems[J].Journal of Applied Mechanics,2011,78(2):856-875.
[10] PETERS J,MISTRY M,UDWADIA F,et al.A unifying framework for robot control with redundant DOFS[J].Autonomous Robots,2008,24(1):1-12.
[11] UDWADIA F E,MYLAPILLI H.Constrained motion of mecha-nical systems and tracking control of nonlinear systems:Connections and closed-form results[J].Nonlinear Dynamics and Systems Theory,2014:15(1):73-89.
[12] UDWADIA F E,KOGANTI P B.Optimal stable control for nonlinear dynamical systems:An analytical dynamics based app-roach[J].Nonlinear Dynamics,2015,82(1-2):547-562.
[13] 刘佳,刘荣.双臂协调机械手动力学建模的新方法[J].北京航空航天大学学报,2016,42(9):1903-1910.LIU J,LIU R.New approach for dynamics modeling of dual-arm cooperating manipulators[J].Journal of Beijing University of Aeronautics and Astronautics,2016,42(9):1903-1910(in Chinese).
[14] 徐亚茹,刘荣.一种爬壁机器人动力学建模方法[J].北京航空航天大学学报,2018,44(2):280-285.XU Y R,LIU R.An approach for dynamics modeling of climbing robot[J].Journal of Beijing University of Aeronautics and Astronautics,2018,44(2):280-285(in Chinese).
[15] UDWADIA F E,WANICHANON T.Control of uncertain nonlinear multibody mechanical systems[J].Journal of Applied Mechanics,2014,81(4):041020.
[16] WANICHANON T,CHO H,UDWADIA F E.An approach to the dynamics and control of uncertain multi-body systems[C]//IUTAM Symposium on Dynamical Analysis of Multibody Systems with Design Uncertainties.Amsterdam:Elsevier,2015:43-52.
[17] KOGANTI P B,UDWADIA F E.Dynamics and precision control of uncertain tumbling multibody systems[J].Journal of Guidance,Control,and Dynamics 2017,40(5):1176-1190.
[18] LIU J,LIU R.Simple method to the dynamic modeling of industrial robot subject to constraint[J].Advances in Mechanical Engineering,2016,8(4):1687814016646511.
[19] UDWADIA F E.A new perspective on the tracking control of nonlinear structural and mechanical systems[J].Proceedings Mathematical Physical and Engineering Sciences,2003,459(2035):1783-1800.
[20] CHO H,UDWADIA F E.Explicit control force and torque determination for satellite formation-keeping with attitude requirements[J].Journal of Guidance,Control,and Dynamics,2013,36(2):589-605.
[21] 张新荣,孟为来.基于虚位移分解与伺服轨迹约束的机械系统跟踪控制[J].机械工程学报,2015,51(3):45-50.ZHANG X R,MENG W L.Trajectory tracking control of mechanical systems based on virtual displacement decomposition and servo constraint following[J].Journal of Mechanical Engineering,2015,51(3):45-50(in Chinese).

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

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

PDF (PC)

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 10

编辑推荐

Metrics

本文评价

[1]	吴翰, 王正平, 周洲, 王睿. 基于凯恩方程的无人机伞降回收动力学建模与仿真[J]. 北京航空航天大学学报, 2019, 45(6): 1256-1265.
[2]	徐亚茹, 刘荣. 一种爬壁机器人动力学建模方法[J]. 北京航空航天大学学报, 2018, 44(2): 280-285.
[3]	张凯, 熊家军, 付婷婷, 席秋实. 基于耦合气动参数的HGV多模型估计[J]. 北京航空航天大学学报, 2018, 44(10): 2156-2164.
[4]	刘佳, 刘荣. 双臂协调机械手动力学建模的新方法[J]. 北京航空航天大学学报, 2016, 42(9): 1903-1910.
[5]	杨华, 宋磊, 王文剑, 黄俊. 动力翼伞纵向四自由度动力学仿真[J]. 北京航空航天大学学报, 2014, 40(11): 1615-1622.
[6]	刘敬猛, 刘岩, 陈伟海, 张良. 永磁球形电机的神经网络自适应控制算法[J]. 北京航空航天大学学报, 2014, 40(1): 25-30.
[7]	张睿, 吴帅, 焦宗夏. 一种典型盘式单向阀的动力学建模与优化设计[J]. 北京航空航天大学学报, 2013, 39(9): 1197-1202.
[8]	黄庭轩, 张尧, 徐世杰. 飞轮隔振平台组合系统的动力学建模[J]. 北京航空航天大学学报, 2013, (1): 120-125.
[9]	祝明, 左宗玉. 高空系留气球建模与稳定性分析[J]. 北京航空航天大学学报, 2010, 36(8): 940-944.
[10]	徐明,贾英宏,徐世杰. Halo轨道探测器的姿态描述与建模[J]. 北京航空航天大学学报, 2007, 33(10): 1166-1169.