Elimination of Constraint Violation Based on Decomposition of Generalized Virtual Displacements under Servo Constraint Control
-
摘要: 基于Udwadia和Kalaba方程的伺服约束控制理论可以较好地应用在机械系统的轨迹跟踪控制中.在伺服约束控制中,对约束系统动力学模型的数值积分过程会产生对低阶约束的违约,同时还存在初始值不相容引起的控制偏差甚至系统不稳定问题.利用系统广义质量矩阵的乔利斯基分解,将描述系统的广义虚位移向量经过变换,在约束流形上分解为约束方向与约束允许方向,从而分离出速率约束及坐标约束违约部分,在此基础上推导出修正公式.以二自由度机械臂为仿真对象,在伺服约束轨迹控制中的应用进行了仿真研究.结果表明,基于虚位移分解的方法可以对伺服控制中的约束违约进行抑制,同时也可以解决系统初始条件不相容引起的问题.Abstract: The servo constraint control theory based on Udwadia and Kalaba equations can be applied in the tracking control of mechanical systems. The numerical solutions under servo constraint control may violate the lowerorder constraint equations,together with the inconsistent initial conditions,which result in control error even unstable problem. In this paper, using the Cholesky decomposition of the generalized mass matrix and the coordinates transformation,the generalized virtual displacements is decomposed in constrained directions and admissible directions,thus the constraint violation of the generalized velocity and configuration are separated,and the modified equations are obtained. Finally,the simulation study of a mechanical manipulator with two degrees of freedom is made and the results show that the algorithm can eliminate the constraint violation and solve the problem caused by inconsistent initial conditions under servo constraint trajectory control.
-
[1] Udwadia F E.A new perspectaive on the tracking control of nonlinear structaural and mechanical systems[J] Proceedings of the Royal Society,Series A: Mathematical,Physical and Engineering Sciences, 2003,459(2035):1783-1800 [2] Braun D J,Goldfarb M.Eliminating constraint drift in the numerical simulation of constrained dynamical systems [J]Computer Methods in Applied Mechanict、 and Engineering,2009,198:3151-3160 [3] Baumgarte J.Stabilization of constraints and integrals of motion in dynamical systems[J]Computer Methods in Applied Mechanic、and Engineering,1972,1(1):1-16 [4] 孔向东,钟万础非线性系统动力学微分代数方程约 束违约的自动修正[J]大连理工大学学报,1999,39 (1);22-25 Kong X D,Zhong W X.Self-correctaion algorithm of constraint errors of differential algebraic: equations for nonlinear system dynamic、[J]Journal of Dalian University of Technology,1999,39(1):22-25(in Chinese) [5] 刘颖,马建敏,苏芳,等多体系统动力学方程的无违 约数值计算方法[J]计算力学学报,2010,27(5); 942-947 LiuY,MaJM,Su F,et al.Precise numerical solution for multibody system'、equations of motion based on algorithm without constraint violation[J]Chinese Journal of Computational Mechanict、,2010,27(5):942-947(in Chinese) [6] 刘颖,马建敏多体系统动力学方程的反馈参数自适 应约束违约稳定法[J]复旦学报,2012,51(4);432-437 Liu Y,Mang J M.Adaptive feedback parameters for Baumgarte's constraint violation stabilization methods of multibody system'、equations of motion[J]Journal of Fudan University,2012,51(4);432-437(in Chinese) [7] Lin S T,Chen M W A PID type constraint stabilization method for numerical inteb anon of multibody systenLs[J] Journal of Computational and Nonlinear Dynamic、, 2011,6(10);44501-44506 [8] Braun D J,Goldfarb M.Simulation of constrained mechanical systems-part I; an equation of motion[J] Journal of Applied Mechanict、,2012,79(4):410171-410178 [9] 丁玉洁,潘振宽多体系统动力学微分-代数方程广 义-。投影法[J]工程力学,2013,30(4);380-184 Ding Y J,Pan Z K.Generalized-a projectaion method for diHerentialalgebraic equations of multibody dynanucta[J] Engineering Mechanict、,2013,30(4):380-184(in Chinese) [10] Blajer W An orthonormal tangent space method for constrained multibody systems[J].Computer Methods in Applied Mechanic、and Engineering,1995,121(1);45-57 [11] BlajerW,SchiehlenW,Schirm W A projectaive criterion to the coordinate partitioning method for multihody dynamic、[J].Archive of Applied Mechanict、,1994,64 (2):86-98 [12] Blajer W Elimination of constraint violation and actx:uracy aspectas in numerical simulation of multihody systems [J Multihody System Dynamicta,2002,7(3);265-284 [13] Blajer W Methods for constraint violation suppression in the numerical simulation of constrained multihody systems-A comparative study[J]Computer Methods in Applied Mechanic、and Engineering,2011,200(13): 1568-1576 [14] Kovectaes J,Piedhoeuf Jean-Claude.A novel approach for the dyamic analysis and simulation of constrained mechanical systems[C]//Proceedings of ASME 2003, Design Engineering Technical Conferences and Computers and Information in Engineering Conference, Chicago Illinois USA.New York:ASME,2003:1-10
点击查看大图
计量
- 文章访问数: 129
- HTML全文浏览量: 23
- PDF下载量: 4
- 被引次数: 0