动力学建模方法与解法总结

1、目录1刚体系统 12弹性系统动力学 63高速旋转体动力学 101刚体系统一般力学研究的对象，是由两个或两个以上刚体通过铰链等约束联系在一起 的力学系统，为一般力学研究对象。自行车、万向支架陀螺仪通常可看成多刚体 系统。人体在某种意义上也可简化为一个多刚体系统。现代航天器、机器人、人 体和仿生学中关于动物运动规律的研究都提出了多刚体系统的一系列理论模型 作为研究对象。多刚体系统按其内部联系的拓扑结构， 分为树型和非树型(包含 有闭链)；按其同外界的联系情况，则有有根和无根之别。利用图论的工具可以 一般地分析多刚体系统的构造，建立系统的数学模型和动力学方程组。也可从分 析力学中的高斯原理出发，用求

2、极值的优化算法直接求解系统的运动和铰链反力。 依照多刚体系统动力学的理论和方法，广泛采用电子计算机对这些模型进行研究， 对于精确地掌握这些对象的运动规律是很有价值的。1.1自由物体的变分运动方程任意一个刚体构件i，质量为mi，对质心的极转动惯量为 Ji，设作用于 刚体的所有外力向质心简化后得到外力矢量Fi和力矩ni，若定义刚体连体坐标系xoy 的原点o位于刚体质心，则可根据牛顿定理导出该刚体带质心坐 标的变分运动方程：、向仃- Fi、让 Ji i - nt = 0(1-1)其中，ri为固定于刚体质心的连体坐标系原点o 的代数矢量，为连体坐标系相对于全局坐标系的转角，5与-< 分别为r与i

3、的变分。定义广义坐标：qi =讥 iT(1-2)广义：Qi =FiT, nF(1-3)及质量矩阵：M i 二 diag(mi,mi, Ji)(1-4)体坐标系原点固定于刚体质心时用广义力表示的刚体变分运动方程:(1-5)Tq (M jqi QJ =01.2束多体系统的运动方程考虑由nb个构件组成的机械系统，对每个构件运用式(1-5)，组合后可得到系统的变分运动方程为：nb(1-6)-:qTMiqi -Qi0i丄若组合所有构件的广义坐标矢量、质量矩阵及广义力矢量，构造系统 的广义坐标矢量、质量矩阵及广义力矢量为：T TT Tq 珂5 ,q2,，qnb(1-7)M =diag (M 1, M2,.

4、, M nb)(1-8)Q =Q1T,Q：,QTbT(1-9)系统的变分运动方程则可紧凑地写为：、qTMq Q二 0(1-10)对于单个构件，运动方程中的广义力同时包含作用力和约束力，但在 一个系统中，若只考虑理想运动副约束，根据牛顿第三定律，可知作用在 系统所有构件上的约束力总虚功为零，若将作用于系统的广义外力表示为：QA "Q1aT,q2aT,Qn；TT11)其中：QjA 十匚 nAT， i =1,2,nb(1-12)则理想约束情况下的系统变分运动方程为：、qTMq -QA =0(1-13)式中虚位移q与作用在系统上的约束是一致的。系统运动学约束和驱动约束的组合如式(1-10)，

5、为：(q,t) =0(1-14)对其微分得到其变分形式为: 式(1-13)和(1-15)组成受约束的机械系统的变分运动方程。为导出约束机械系统变分运动方程易于应用的形式，运用拉格朗日乘子定理对式(1-13)和(1-15)进行处理。拉格朗日乘子定理：设矢量Rn，矢量x. Rn，矩阵 A Rmn为常数矩阵，如果有：bTx = O(1-16)对于所有满足式(1-84 )的x条件都成立。Ax=O(1-17)则存在满足式(1-85)的拉格朗日乘子矢量Rm obTx ：tAx=O(1-18)其中x为任意的。在式(1-13)和(1-15)中，q Rn，M Rnn，QA Rn ,讥 Rm n，运用 拉格朗日乘

6、子定理于式 (1-13)和(1-15)，则存在拉格朗日乘子矢量 Rm，对于任意的 q应满足：Mq -Q AT、qq、q 二Mq 亠处：'；一QAT、q 二 0(1-19)由此得到运动方程的拉格朗日乘子形式：. TAMq 亠勺订：；、=Q(1-20)式(1-20)还必须满足式(1-10)、(1-12)和(1-14)表示的位置约束方程、速度约 束方程及加速度约束方程，如下：:：J(q,tH0(1-21)(q,q,t) =Gq(q,t)qj=0，=b(q,t)(1-22)(q,q；q；t) =q(q,t)q- (q,q,t)=0， 八3 qq)qq - 鮎亦 - Xt (1-23) 以上三式

7、其维数同式(1-14) o式(1-20)、(1-21)、(1-22)和(1-23)组成约束机械系统的完整的运动方程。将式(1-20)与(1-23)联立表示为矩阵形式：M(1-24)式(1-24)即为多体系统动力学中最重要的动力学运动方程，式(1-24)还必须满足式(1-22)和(1-23)。它是一个微分一一代数方程组，不同于单纯的常微 分方程组问题，其求解关键在于避免积分过程中的违约现象，此外，还要 注意DAE问题的刚性问题。如果系统质量矩阵是正定的，并且约束独立，那么运动方程就有唯一解。实际中的系统质量矩阵通常是正定的，只要保证约束是独立的，运动 方程就会有解。在实际数值迭代求解过程中，需要

8、给定初始条件，包括位置初始条件q(t。)和速度初始条件q(t。)。此时，如果要使运动方程有解，还需要满足初值相容条件，也就是要使位置初始条件满足位置约束方程，速度初始条件 满足速度约束方程。对于由式(1-24)及(1-21)、(1-22)确定的系统动力学方程，初值相容条件为：(q(t °), t°)= oG(q(to),q(to),t0)Gq(q(to),t0)q(to)- (q(to),t。)=0(1-25)(1-26)1.3正向动力学分析、逆向动力学分析与静平衡分析对于一个确定的约束多体系统，其动力学分析不同于运动学分析，并不需要系统约束方程的维数m等于系统广义坐标的维

9、数n , m ： n。在给定外力的作用下，从初始的位置和速度，求解满足位置约束式(1-22)及速度约束式(1-23)的运动方程式(1-24)，就可得到系统的加速度和相应的速度、位 置响应，以及代表约束反力的拉格朗日乘子，这种已知外力求运动及约束 反力的动力学分析，称为正向动力学分析。如果约束多体系统约束方程的维数m与系统广义坐标的维数n相等，m=n，也就是对系统施加与系统自由度相等的驱动约束，那么该系统在运动学上就被完全确定，由2.2.3节的约束方程、速度方程和加速度方程可求解系统运动。在此情况下，雅可比矩阵是非奇异方阵，即：展开式(1-24)的运动方程，为：TAMq+6qh=Q(1-28)G

10、qqi(1-29)由式(1-29)可解得q；再由式(1-28)可求得，拉格朗日乘子就唯一地确定 了作用在系统上的约束力和力矩(主要存在于运动副中)。这种由确定的运动求系统约束反力的动力学分析就是逆向动力学分析。如果一个系统在外力作用下保持静止状态，也就是说，如果：q = q = 0(1-30)那么，就说该系统处于平衡状态。将式(1-30)代入运动方程式(1-20)，得到平衡方程：Taq=Q(1-31)由平衡方程式(1-21)及约束方程式(1-13)可求出状态q和拉格朗日乘子。这种求系统的平衡状态及在平衡状态下的约束反力的动力学分析称为(静)平衡分析。1.4约束反力对于约束机械系统中的构件i，设

11、其与系统中某构件j存在运动学约束或驱动约束，约束编号为k。除连体坐标系xoy外，再在构件i上以某点P为原点建立一个新的固定于构件上的坐标系x Py，称为运动副坐标系，设从坐标系x Py到坐标系xoy的变换矩阵为 Ci，从坐标系x o y到坐标系 xoy的变换矩阵为 Ai，则可导出由约束 k产生的反作用力和力矩分别为：Fk = CjTAT：.：，：T，k(1-32)Tk =(§戸匕8：丁 釣沾(1-33)以上两式中，k为约束k对应的拉格朗日乘子，反作用力F”k和力矩Tk均为运动副坐标系 x Py "中的量。2弹性系统动力学由于工业机器人、机械手、弹性联动装置、带柔性附件人造卫

12、星、直升飞机 的旋翼等工程结构发展的需求，使运动中的弹性结构的动力学分析得到了很大 的进展。运动弹性体的动力学分析属于多体系统动力学的范畴。而导出其有限元 格式的动力学方程并研究其数值解法则是计算多体系统动力学的任务。由于弹性变形与刚体运动的耦合导致了运动弹性体的动力学方程为时变的或非线性的，因此运动中的弹性体会出现诸多非线性效应。运动中弹性体的动力分析问题可分为两类，其一是具有给定刚体运动的弹性体的动力分析，这类问题仅讨论弹性体的刚体运动对其弹性变形的影响，比如机械手的弹性终端杆的振动分析一般可归于此类。第二类问题是多体系统中之刚体运动与其中的弹性体的弹性变形的相互耦合的动力分析，在这类问题

13、中，弹性体的变形会受到系统刚体运动的影响，反之弹性体的变形也会影响系统的刚体运动。下面采用运动参考系方法并用 Jourdain动力学普遍方程导出了具有空间一 般运动的弹性体之通用的有限元动力学方程， 其最大的优点在于推导简单并适用 于各类结构及各种单元形式。对系统的动力学方程的数值求解，一般可以采用直 接积分法。下面给出了对时变的运动弹性的动力学方程的Neumann级数2直接积分解法，该方法可以在保证计算精度的前提下很大程度地节省机时。图2-1所示为一运动的弹性体B，选用两个坐标系来定义弹性体B的刚体运动与弹性变形：静系一ox：x；x3，简记o系；原点在B上的01点,固连于B上的动系一OiX：

14、 x2x3,简记为Oi系。B的刚体移动由01点对于o点的矢量心，定义B的 111 1空间转动则用O1系对o系的转动来定义，而B内任意点P的弹性变形则用在O1系 内的弹性变形位移矢量u来表示。由图可见B发生弹性变形后，其上任意一点P对o系的位置矢量可以表示(2-1)(2-2)其中r是B未产生弹性变形时P点在O1系中的位置矢量，u则表示P点的弹性变 形位移矢量。把（2-2）式代入（2-1）式并向o系投影，且采用矩阵形式表示为：Tp To? - lAOO1（ 2-3）其中p刑匕0汾别表示和r向o系的投影列阵；a°o1 表示。1系向o系转移的方向余弦矩阵。把（3-3）式中uor的用有限元的格

15、式，表达为：汕 1 - N f（2-4）其中N 1为单元形函数矩阵，“为P点所在单元的有限元结点位移列阵。把(2-4)式代入（2-3）式，并利用公式：一 几 OO1 1AOO11:（2-5）其中！ i。1 是o系相对于o系转动角速度在o系上投影的斜对称阵。由（2-3）式对时间分别求一次导数和二次导数可得 P点的速度vO '和加速度 筍，进而可得到P点的虚速度§于是P点邻域之微元体的Jourdain动力 学普遍方程可以写作：AOO1?f-mpdvap1 =0（ 2-6）其中：mp为弹性体在P点的质量密度；1是作用于P点微元体上的全部力在。1系上的投影。对于6 VpK Aoodf

16、可利用常规有限元的格式将它写作儿；F瓜呵I f -(2-7)其中：K和C分别为单元刚度阵和单元阻力阵在 P点的值；为作用在P点微元体上的外力在Oi系的列阵，把求得的P点的虚速度和加速度以及(2-7)式代 入(2-6)式，并考虑到6 P中诸元素之独立性,可得P点微元体的动力学方程为:N TF-k9_CP(2-8)N Hfk IpCl mpdvZp0Ta；=O将(2-8)式对单元积分便可得运动的弹性体的单元动力学方程：L p> +(2-9)式中：Me L mp N N dvCel=N TTn dv 2 mp N Ta00 T X001 】A001CJ Cd Ikel=BT D dv mp N

17、 FA001T门001 x0011! ；001IIa001Un dv订 丿kdl=k T 忙 bv - Jm p N T A=Fd 10。1广«»0 %Iv 亠 I mp N T -A001-i001啦si 仏。0 Ir01:dv其中Cs，ks，Ts分别是常规有限元法中的单元阻力阵、刚度阵和外力向量, 而Cd ，Kd I,花则分别是由于刚体运动与弹性变形的耦合而产生的附加单元动力阻尼阵、动力刚度阵和动力力向量。而且由于它们的表达式中含有表示弹性 体空间运动量汀05和仏,因此，通常这些动力附加项是时变的。当弹性体的刚体运动速度特别是转动速度较大时，弹性体受到较大的惯性力作用，

18、会产生变形 的耦合效应。例如转动的梁，由于离心惯性力产生的轴向拉力会增大梁的抗弯刚 度,即所谓的 刚化效应”这时在(2-10)式中的常规刚度阵 KJ中需计入结构 的几何刚度阵，关于各类单元的几何刚度阵可参阅有关非线性有限元的书籍。而结构的几何刚度阵往往是未知内力的函数 ，这时方程(2-9)式就是一个非线性的 动力方程。但对于简单的弹性体，如梁，由于刚体运动的惯性力产生的轴力容易 求得，这时的几何刚度阵就变为时变阵。本文只讨论几何刚度阵为时变阵的情况， 即方程(2-9)式为时变动力学方程时的数值解法。显然，若弹性体没有刚体运动，则方程(2-9)式退化为常规的有限单元动力学 方程。把(2-9)式按

19、常规有限元的组集方法进行组集，便可得到对于运动弹性体的 具有时变特性的、通用的有限元动力学方程：畀昭打已+k 3=日(2-10)3高速旋转体动力学高速旋转体通常是由是由三个刚体卜环、内环、转子互相约束在一起而成，可使陀螺仪转子具有空间转动的三个自由度。 过去曾长期认为，高速自转的平衡 对称卡登陀螺仪和单刚体陀螺仪的理论模型没有本质区别，具有所谓定轴性。但实际上，理论研究和精密的实验研究都已证明这个想法是错误的。平衡对称卡 登陀螺仪的空间定向大都具有里雅普诺夫意义下的不稳定性（见运动稳定性）。卡登陀螺仪和单刚体陀螺仪模型有本质区别，只有通过多刚体系统模型的研究才 能正确解释卡登陀螺仪的动力学特征

20、。图3-1如图3-1所示，对于外径D与长度I的比值D/I : 5的转子，如多缸内燃机的 曲轴、机床主轴等，这些转子的不平衡质点不是集中在同一平面内，而是分布在垂直于轴线的各个平面内。对于这种转子动平衡问题，一般都采用矢量法来求校 正质量mb、mb的重径积mbrj和mbrb。但是这种方法所带来问题是力多边形不 易求解以及图解法不够精确。假如采用平面解法，不仅简单正确，而且对于没有 动平衡机的工厂无疑有一定的实用价值。上述转子质量分布简图如图3-2所示，不平衡质量 叶、m2、m3分别分布在 与回转轴线垂直的三个平面1、2、3内，各质点距回转轴线的矢径分别为 几、r2、 r3。当转子以等角速度。回转时，各质点所产生的离心惯性力分别为R = mi占（3-1）2(3-3)2二 m3"图3-2方向如图所示。若选择转子左、右二端面T （过点A与轴线垂直的平面）、T ”（过 点B与轴线垂直的平面）作为校正平面，在T >T平面内分别加上校正质量mb、 mb，矢径为rb、r；，则校正质量所产生的离心惯性力为R.二mb2和 Pb"=mbrb霸2，R、P2、P3、P；和P；组成了空间力系。选取三坐标轴x、y、z轴如图所示，并将作用在转子上的所有力向 YAZ平 面和XAY平面投影，如图3-3所示。在图3-3中，所有的力组成