多体系统动力学方程违约修正的数值计算方法

多体系统动力学方程为微分代数方程,一般将其转化成常微分方程组进行数值计算,在数值积分的过程中约束方程的违约会逐渐增大.本文对具有完整、定常约束的多体系统,在修改的带乘子Lagrange正则形式的方程的基础上,根据Baumgarte提出的违约修正的方法,给出了一种多体系统微分代数方程违约修正法和系统的动力学方程的矩阵表达式.通过对曲柄-滑块机构的数值仿真,计算结果表明本文给出的方法在计算精度和计算效率上好于Baumgarte提出的两种违约修正的方法.     

论轮式移动结构的非完整约束及其运动控制

当质点沿光滑曲线运动时,必须满足横向速度为零的条件.同样地,不同轮式移动结构在平面上做光滑曲线运动时都需要满足该非完整约束条件.本文结合轮子转速和它们运动速度的完整约束关系,理清各轮式移动结构的完整和非完整约束,然后利用 Euler-Lagrange 方程方便地推导出相应的动力学方程.另外,通过该非完整约束,将目标轨迹曲线转化为速度目标的形式,然后引入目标轨迹曲线的相对曲率设计合适的动态跟踪目标.进一步,通过采用该动态跟踪目标可以将轮式移动结构的运动规律和动力学方程有机结合起来,并将原运动任务简化为一般的 轨迹 控制问题.基于该动态跟踪目标可以为轮式移动结构设计合适的鲁棒跟踪控制器,通过跟踪目标轨迹曲线的相对曲率来实现对目标曲线的精确跟踪.最后,理论分析和仿真结果显示,采用动态目标跟踪方法能够从根本上解决初始速度误差过大和位置误差不断被累积的问题,即使前向速度误差系统不稳定的,实际运动轨迹也几乎能和目标轨迹曲线重合.      

ON THE NONHOLONOMIC CONSTRAINTS AND MOTION CONTROL OF WHEELED MOBILE STRUCTURES1)

当质点沿光滑曲线运动时,必须满足横向速度为零的条件.同样地,不同轮式移动结构在平面上做光滑曲线运动时都需要满足该非完整约束条件.本文结合轮子转速和它们运动速度的完整约束关系,理清各轮式移动结构的完整和非完整约束,然后利用 Euler-Lagrange 方程方便地推导出相应的动力学方程.另外,通过该非完整约束,将目标轨迹曲线转化为速度目标的形式,然后引入目标轨迹曲线的相对曲率设计合适的动态跟踪目标.进一步,通过采用该动态跟踪目标可以将轮式移动结构的运动规律和动力学方程有机结合起来,并将原运动任务简化为一般的 轨迹 控制问题.基于该动态跟踪目标可以为轮式移动结构设计合适的鲁棒跟踪控制器,通过跟踪目标轨迹曲线的相对曲率来实现对目标曲线的精确跟踪.最后,理论分析和仿真结果显示,采用动态目标跟踪方法能够从根本上解决初始速度误差过大和位置误差不断被累积的问题,即使前向速度误差系统不稳定的,实际运动轨迹也几乎能和目标轨迹曲线重合.     

Modeling and analysis of rigid multibody systems with driving constraints and frictional translation joints

An approach is proposed for modeling and anal- yses of rigid multibody systems with frictional translation joints and driving constraints. The geometric constraints of translational joints with small clearance are treated as bilat- eral constraints by neglecting the impact between sliders and guides. Firstly, the normal forces acting on sliders, the driv- ing constraint forces （or moments） and the constraint forces of smooth revolute joints are all described by complementary conditions. The frictional contacts are characterized by a set- valued force law of Coulomb＇s dry friction. Combined with the theory of the horizontal linear complementarity problem （HLCP）, an event-driven scheme is used to detect the transi- tions of the contact situation between sliders and guides, and the stick-slip transitions of sliders, respectively. And then, all constraint forces in the system can be computed easily. Secondly, the dynamic equations of multibody systems are written at the acceleration-force level by the Lagrange multiplier technique, and the Baumgarte stabilization method is used to reduce the constraint drift. Finally, a numerical example is given to show some non-smooth dynamical behaviors of the studied system. The obtained results validate the feasibility of algorithm and the effect of constraint stabilization.     

含摩擦滑移铰平面多刚体系统动力学的数值算法

基于LuGre摩擦模型和线性互补问题(LCP)的数值算法,给出了具有双边约束含摩擦滑移铰平面多体系统动力学的数值算法.首先,根据滑移铰的特点,当间隙充分小时,将其视为双边约束,给出了滑移铰中滑道作用于滑块上的法向接触力的互补关系;LuGre摩擦模型能有效地描述机械系统中的黏滞与滑移运动,将该模型用于描述滑块与滑道间的摩擦力.其次,结合Baumgarte约束稳定化方法,应用第一类Lagrange方程,建立了该多体系统的动力学方程,给出了Lagrange乘子与滑移铰中作用于滑块上的法向接触力的关系式.然后,将滑块与滑道间多种接触状态的判断以及作用于滑块上的法向接触力的计算转换为线性互补问题的求解,并用常微分方程的数值算法求解该多体系统的动力学方程.最后,通过数值仿真算例揭示了滑移铰中滑块的黏滞与滑移现象,以及滑块在滑道内的多种接触状态;另外,在文中分别采用Coulomb干摩擦模型和LuGre摩擦模型,对算例中的某些工况进行了数值仿真,并且分别用本文方法得到的数值仿真结果与已有方法得到的数值仿真结果对比,表明了本文给出的方法的有效性.      

多体系统接触碰撞问题的牛顿-欧拉线性互补方法

基于非光滑动力学方法的多体系统接触碰撞分析是目前多体系统动力学的研究热点.本文采用牛顿-欧拉方法建立多体系统接触、碰撞问题的动力学模型,给出一种牛顿-欧拉型线性互补公式.该建模方法与目前一般采用的拉格朗日建模方法的不同之处是约束条件中除了库仑摩擦、单边约束之外还含有光滑等式约束.在建立系统动力学模型时,首先解除摩擦约束和单边约束得到原系统对应的基本系统.牛顿-欧拉方法采用最大数目坐标建立基本系统的动力学方程,由于坐标不相互独立,因此基本系统中带有等式约束,其数学模型为一组微分代数方程.借助约束雅可比矩阵,在基本系统微分代数方程中添加摩擦接触和单边约束对应的拉氏乘子,就可以得到系统全局运动的具有变拓扑结构特征的动力学方程,再结合非光滑约束互补条件便可构成完备的系统动力学模型.完备的动力学模型由动力学微分方程以及等式约束和不等式约束组成.线性互补公式采用分块矩阵形式进行推导,简化了推导过程.数值计算采用基于线性互补的时间步进算法.时间步进算法是目前流行的非光滑数值算法,其突出特点是可以免去数值积分中繁琐的事件检测过程,而数值积分过程中通过对线性互补问题的求解可以确定系统的触-离状态.通过对典型的曲柄滑块间隙机构进行数值分析,验证本文方法的有效性.     

CONSTRAINT VIOLATION STABILIZATION OF EULER-LAGRANGE EQUATIONS WITH NON-HOLONOMIC CONSTRAINTS

Two constraint violation stabilization methods are presented to solve the Euler Lagrange equations of motion of a multibody system with nonholonomic constraints. Compared to the previous works, the newly devised methods can deal with more complicated problems such as those with nonholonomic constraints or redundant constraints, and save the computation time. Finally a numerical simulation of a multibody system is conducted by using the methods given in this paper.     

一类多体系统非完整运动最优规划的拟牛顿算法

研究带有非完整约束的一类多体系统运动规划问题。多体系统中的非完整约束通常是由不可积的速度约束或不可积的守恒律引起。在系统动量和动量矩守恒情况下,动力学方程降阶为非完整形式约束方程,系统的控制问题可转化为无漂移系统的非完整运动规划问题。文中首先导出具有多体开链系统的非完整运动模型。利用最优控制理论和最优化技术,采用输入参数化的方法将连续的最优控制问题转化为离散的最优控制问题,提出一种非完整多体系统运动规划的拟牛顿算法。最后将该方法用于自由漂浮的空间三连杆机构,仿真结果验证了该方法的有效性。     

轮式移动机器人非完整运动规划的最优控制方法

本文讨论轮式动机器人非完整运动的最优规划问题,利用约束与最优控制理论建立数学模型,考虑系统的非完整约束特性,提出轮式移动机器人运动规划的最优控制算法。通过数值仿真,表明该方法的有效性。     

车辆纵向非光滑多体动力学建模与数值算法研究

在建立车辆纵向多体系统的动力学模型中, 将车身与车轮视为刚体, 两者通过减振器链接; 将传动系统视为一个圆盘通过扭簧和阻尼器与驱动轮连接; 将车轮与路面间的接触力简化为法向约束力、摩擦力和滚阻力偶,其中摩擦力的模型采用库仑干摩擦模型. 采用笛卡尔坐标作为该系统的广义坐标用于描述该系统的位形, 给出系统单双边的约束方程, 应用第一类拉格朗日方法建立了系统的动力学方程. 由于摩擦与滚阻的非光滑性, 使得该系统动力学方程不连续. 为便于计算, 建立了车轮与路面接触点的相对切向加速度与摩擦力余量的互补条件、车轮角加速度与滚阻力偶余量的互补条件, 以及车轮轮心法向加速度与路面法向约束力的互补条件. 将接触—分离、黏滞—滑移的判断问题转化成线性互补问题的求解, 并给出了具有约束稳定化的基于事件驱动法的数值计算方法. 最后, 应用该方法对车辆纵向多体系统进行了仿真, 分析了输出扭矩、摩擦及滚阻系数对其动力学行为的影响.      

含摩擦与碰撞平面多刚体系统动力学线性互补算法

基于接触力学理论和线性互补问题的算法, 给出了一种含接触、碰撞以及库伦干摩擦, 同时具有理想定常约束(铰链约束) 和非定常约束(驱动约束) 的平面多刚体系统动力学的建模与数值计算方法. 将系统中的每个物体视为刚体, 但考虑物体接触点的局部变形, 将物体间的法向接触力表示成嵌入量与嵌入速度的非线性函数,其切向摩擦力采用库伦干摩擦模型. 利用摩擦余量和接触点的切向加速度等概念, 给出了摩擦定律的互补关系式; 并利用事件驱动法, 将接触点的黏滞-滑移状态切换的判断及黏滞状态下摩擦力的计算问题转化成线性互补问题的求解. 利用第一类拉格朗日方程和鲍姆加藤约束稳定化方法建立了系统的动力学方程, 由此可降低约束的漂移, 并可求解该系统的运动、法向接触力和切向摩擦力, 还可以求解理想铰链约束力和驱动约束力. 最后以一个类似夯机的平面多刚体系统为例, 分析了其动力学特性, 并说明了相关算法的有效性.      

Forward and inverse dynamics of nonholonomic mechanical systems

This paper deals with the forward and the inverse dynamic problems of mechanical systems subjected to nonholonomic constraints. The intrinsically dual nature of these two problems is identified and utilised to develop a systematic approach to formulate and solve them according to an unified framework. The proposed methodology is based on the fundamental equations of constrained motion which derive from Gauss’s principle of least constraint. The main advantage arising from using the fundamental equations of constrained motion is that they represent an effective method capable to derive the generalised acceleration of a mechanical system, constrained in general by a set of nonholonomic constraints, together with the generalized constraint forces (forward dynamics). When the constraint equations are used to represent the desired behaviour of the mechanical system under study, the generalised constraint forces deriving from the fundamental equations of constrained motion provide the control actions which reproduce the specified motion for the system (inverse dynamics). This approach is systematically extended to underactuated mechanical systems introducing a new method named underactuation equivalence principle. The underactuation equivalence principle is founded on the key idea that the underactuation property of a mechanical system can be mathematically represented using a particular set of nonholonomic constraint equations. Two simple case-studies are reported to exemplify the proposed methodology. In the first case-study the computation of the generalised constraint forces relative to the revolute joint constraints of a physical pendulum is illustrated. In the second case-study the calculation of the control action which solves the swing-up problem for an inverted pendulum is described.     

Differential-algebraic equations of programmed motions of Lagrangian dynamical systems

We suggest a method for constructing the dynamic equations of manipulator systems in canonical variables. The system of differential dynamic equations has an integral manifold corresponding to the holonomic and nonholonomic constraint equations. The controls are determined so as to ensure the stability of this manifold. We state conditions for the exponential stability of the manifold and for constraint stabilization when solving the dynamic equations numerically by a simplest difference method. We also present the solution of the problem of control of a plane two-link manipulator.     

Nonholonomic systems with non-linear constraint equations

The development of a form of Lagrange's equations applicable with nonholonomic systems with non-linear constraint equations is presented and discussed. The analysis is based upon, and is an extension of. a method developed by the authors for nonholonomic systems with linear constraint equations in the generalized coordinate derivatives. The method is illustrated with the problem of the “balancing pole”.     

ROUTH’S EQUATIONS FOR GENERAL NONHOLONOMIC MECHANICAL SYSTEMS OF VARIABLE MASS

In this paper,Routh’s equations for the mechanical systems of the variable masswith nonlinear nonholonomic constraints of arbitrary orders in a noninertial referencesystem have been deduced not from any variational principles,but from the dynamicalequations of Newtonian mechanics.And then again the other forms of equations fornonholonomic systems of variable mass are obtained from Routh’s equations.     

Point-to-point trajectory planning of wheeled mobile manipulators with stability constraint. Extension of the random-profile approach

We propose a flexible stochastic scheme for point-to-point trajectory planning of nonholonomic wheeled mobile manipulators subjected to move in a structured workspace. The problem is known to be complex, particularly if obstacles are present and if dynamic stability constraint is considered. The proposed method consists of extending to wheeled mobile manipulators the random-profile approach recently applied to wheeled platforms. This versatile method handles constraints on: (i) geometry (obstacle avoidance, bounded joint positions and path curvature); (ii) kinematics (bounded velocities and accelerations); (iii) dynamics (bounded torques, stability condition). It may be applied using various forms of cost functions involving travel time, efforts and power. Solutions are presented for planar and spatial nonholonomic wheeled mobile manipulators undertaking, in a constrained workspace, a point-to-point task defined either in generalized or operational coordinates.     

具有可积微分约束的力学系统的Lie对称性

研究具有可积微分约束的力学系统的Ｌｉｅ对称性与守恒量。采用两种方法：一是用不可积微分约束系统的方法;另一是用积分后降阶系统的方法,研究两种方法之间的关系。     

Control of manipulators and wheeled transport robots as systems of rigid bodies

Problems of control of robots (manipulators and wheeled transport robots) that are considered as controllable systems of rigid bodies with holonomic and nonholonomic constraints are reviewed. The basic problems that arise in designing systems of control of such facilities are considered. Namely, the equations of model motion are derived, a specified trajectory is parametrized, and a stabilization algorithm is synthesized (including linear, nonlinear, adaptive, and robust controllers). Some model examples are given to illustrate the efficiency of the algorithms considered. S.P. Timoshenko Institute of Mechanics, National Academy of Sciences of Ukraine, Kiev. Translated from Prikladnaya Mekhanika, Vol. 36, No. 4, pp. 35–67, April, 2000.     

An index 0 differential-algebraic equation formulation for multibody dynamics: Nonholonomic constraints

A method is presented for formulating and numerically integrating index 0 differential-algebraic equations of motion for multibody systems with holonomic and nonholonomic constraints. Tangent space coordinates are defined in configuration and velocity spaces as independent generalized coordinates that serve as state variables in the formulation. Orthogonal dependent coordinates and velocities are used to enforce position, velocity, and acceleration constraints to within specified error tolerances. Explicit and implicit numerical integration algorithms are presented and used in solution of three examples: one planar and two spatial. Numerical results verify that accurate results are obtained, satisfying all three forms of kinematic constraint to within error tolerances embedded in the formulation.     

A linear complementarity model for multibody systems with frictional unilateral and bilateral constraints

The Lagrange-I equations and measure differential equations for multibody systems with unilateral and bilateral constraints are constructed.For bilateral constraints,frictional forces and their impulses contain the products of the filled-in relay function induced by Coulomb friction and the absolute values of normal constraint reactions.With the time-stepping impulse-velocity scheme,the measure differential equations are discretized.The equations of horizontal linear complementarity problems(HLCPs),which are used to compute the impulses,are constructed by decomposing the absolute function and the filled-in relay function.These HLCP equations degenerate into equations of LCPs for frictional unilateral constraints,or HLCPs for frictional bilateral constraints.Finally,a numerical simulation for multibody systems with both unilateral and bilateral constraints is presented.