(完整版)动力学建模方法与解法总结

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

2、程组。也可从分析力学中的高斯原理出发，用求极值的优化算法直接求解系统的运动和铰链反力依照多刚体系统动力学的理论和方法，广泛采用电子计算机对这些模型进行研究对于精确地掌握这些对象的运动规律是很有价值的。1.1 自由物体的变分运动方程自由物体的变分运动方程任意一个刚体构件i，质量为m，对质心的极转动惯量为J，设作用于ii刚体的所有外力向质心简化后得到外力矢量F和力矩n，若定义刚体连体坐ii标系xoy的原点 o位于刚体质心，则可根据牛顿定理导出该刚体带质心坐标的变分运动方程：&Tm&-F+切J杵n=0(1-1)iiiiiiii其中，r为固定于刚体质心的连体坐标系原点 o的代数矢量，*

3、为连体坐标ii系相对于全局坐标系的转角，5r与冈分别为r与*的变分。iiii定义广义坐标：q=rT,*T(1-2)iii广义：Q=FT,nT(1-3)iii及质量矩阵：M=diag(m,m,J)(1-4)iiii2体坐标系原点固定于刚体质心时用广义力表示的刚体变分运动方程：5qT(M典Q)=0(1-5)iiii1.2 束多体系统的运动方程束多体系统的运动方程考虑由nb个构件组成的机械系统，对每个构件运用式(1-5)，组合后可得到系统的变分运动方程为：芳5qTM辱Q二0(1-6)iiiii=1若组合所有构件的广义坐标矢量、质量矩阵及广义力矢量，构造系统的广义坐标矢量、质量矩阵及广义力矢量为：q=

4、qT,qT,.,qTT(1-7)12nbM=diag(M,M,.,M)(1-8)12nbQ=QT,QT,.,QTT(1-9)12nb系统的变分运动方程则可紧凑地写为：5qTMqQ=0(1-10)对于单个构件，运动方程中的广义力同时包含作用力和约束力，但在一个系统中，若只考虑理想运动副约束，根据牛顿第三定律，可知作用在系统所有构件上的约束力总虚功为零，若将作用于系统的广义外力表示为：QA=QAT,QAT,.,QATT(1-11)12nb其中：QA=FAT,nAT，i=1,2,.,nb(1-12)ii则理想约束情况下的系统变分运动方程为：5qTMqgQA=0(1-13)式中虚位移5q与作用在系统上

5、的约束是一致的。系统运动学约束和驱动约束的组合如式(1-10)，为：(q,t)=0(1-14)3对其微分得到其变分形式为：5q=0(1-15)q4式(1-13)和(1-15)组成受约束的机械系统的变分运动方程。为导出约束机械系统变分运动方程易于应用的形式，运用拉格朗日乘子定理对式(1-13)和(1-15)进行处理。拉格朗日乘子定理：设矢量bGRn，矢量xGRn，矩阵AeRmxn为常数矩阵，如果有：bTx=0(1-16)对于所有满足式(1-84)的x条件都成立。Ax=0(1-17)则存在满足式(1-85)的拉格朗日乘子矢量XGRmbTx+XTAx=0(1-18)其中x为任意的。在式(1-13)和

6、(1-15)中，qGRn，MeRnxn，QAGRn，GRmxn，运用q拉格朗日乘子定理于式(1-13)和(1-15)，则存在拉格朗日乘子矢量XGRm，对于任意的8q应满足:MqQAT8q+XT8q=MqTX-QAT8q=0qq由此得到运动方程的拉格朗日乘子形式：(1-19)Mq+TX=QAq式(1-20)还必须满足式(1-10)、(1-12)和(1-14)表示的位置约束方程、速度约(1-20)束方程及加速度约束方程，如下：(q,t)=0(1-21)歡 q,q,t)=O(q,t)q-u=0，qO(q,q,q,t)=O(q,t)qM(q,q,t)=0，耳q以上三式其维数同式(1-14)。(1-22

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

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

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

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

11、)平衡分析。1.4 约束反力约束反力对于约束机械系统中的构件i，设其与系统中某构件j存在运动学约束或驱动约束，约束编号为 k。除连体坐标系xVy外，再在构件i上以某点P为原点建立一个新的固定于构件上的坐标系xffpy，称为运动副坐标系，设从坐标系xffPy到坐标系xoy的变换矩阵为C，从坐标系xoy到坐标系ixoy的变换矩阵为A，则可导出由约束 k 产生的反作用力和力矩分别为：iFk=-CTATkT九k(1-32)iiiriTk=(sPTBTkTkT)xk(1-33)iiir4-以上两式中，九 k为约束k对应的拉格朗日乘子，反作用力Fk和力矩Tk均ii为运动副坐标系xPy中的量。82弹性系统动

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

13、之刚体运动与其中的弹性体的弹性变形的相互耦合的动力分析,在这类问题中,弹性体的变形会受到系统刚体运动的影响，反之弹性体的变形也会影响系统的刚体运动。下面采用运动参考系方法并用Jourdain动力学普遍方程导出了具有空间一般运动的弹性体之通用的有限元动力学方程，其最大的优点在于推导简单并适用于各类结构及各种单元形式。对系统的动力学方程的数值求解,一般可以采用直接积分法。下面给出了对时变的运动弹性的动力学方程的Neumann级数2直接图 2-1图2-1所示为一运动的弹性体B，选用两个坐标系来定义弹性体B的刚体运动与弹性变形:静系ox1x2x3，简记O系；原点在B上的o点，固连于B上的动9系一oxi

14、x2x3,简记为o系。B的刚体移动由o点对于o点的矢量r,定义B的1o1o1o111o1空间转动则用o系对o系的转动来定义，而B内任意点P的弹性变形则用在o系ii内的弹性变形位移矢量u来表示。由图可见B发生弹性变形后，其上任意一点P对o系的位置矢量可以表示为:r=r+rpoiu2-2)其中r是B未产生弹性变形时P点在o系中的位置矢量，U则表示P点的弹性变i形位移矢量。把(2-2)式代入(2-1)式并向o系投影，且采用矩阵形式表示为：其中为单元形函数矩阵，O为P点所在单元的有限元结点位移列阵。把(2-4)式代入(2-3)式，并利用公式:由(2-3)式对时间分别求一次导数和二次导数可得P点的速度(

15、o口加速度p(o，进而可得到P点的虚速度5(vo，于是P点邻域之微元体的Jourdain动力pp，学普遍方程可以写作:5(oClooifmdv(oD=0pppm为弹性体在P点的质量密度；f是作用于P点微元体上的全部力在Op12-i)2-3)其中io和C妇别表示po1的方向余弦矩阵。把(3-3)式中to的用有限元的格式，表达为:仁丄IN山oo1-表示o系向o系转移12-4)Aoo1ii2-5)其中IQoo是o系相对于o系转动角速度在o系上投影的斜对称阵。112-6)其中:po110系上的投影。对于5lo1Looib1可利用常规有限元的格式将它写作：p51。1Lof=5忡DvTF1-Kp-C其中：

16、K和C分别为单元刚度阵和单元阻力阵在p点的值；仏1为作用在P点微元体上的外力在O系的列阵，把求得的P点的虚速度和加速度以及(2-7)式代入(2-6)式，并考虑到(中诸元素之独立性，可得P点微元体的动力学方程为:NT-Kp-C(p-mdv5Vo。=0IIppp将(2-8)式对单元积分便可得运动的弹性体的单元动力学方程:Me时+Ce+Lee1式中：MeLJmINTINhvCelP二JNTDvhv+2JmNTUo1-TQooilAooiIvhv=C+C1psdIK=JBTDBhv+JmNrL。】1=DK1+K1卩Fesd=JNrbv-卩mNTL。】j|dv+JmNTD(Q們+Q。1Q們1jL。=F+

17、F1sd其中C,K,1分别是常规有限元法中的单元阻力阵、刚度阵和外力向量,sss而C,K,仏1则分别是由于刚体运动与弹性变形的耦合而产生的附加单元ddd动力阻尼阵、动力刚度阵和动力力向量。而且由于它们的表达式中含有表示弹性2-7)。p2-8)2-9)。Ci。INhvQoodv+Jmp11体空间运动量和o,因此，通常这些动力附加项是时变的。当弹性体的刚体运动速度特别是转动速度较大时,弹性体受到较大的惯性力作用,会产生变形的耦合效应。例如转动的梁，由于离心惯性力产生的轴向拉力会增大梁的抗弯刚度，即所谓的“刚化效应”。这时在(2-10)式中的常规刚度阵EK中需计入结构s的几何刚度阵，关于各类单元的几

18、何刚度阵可参阅有关非线性有限元的书籍。而结构的几何刚度阵往往是未知内力的函数，这时方程(2-9)式就是一个非线性的动力方程。但对于简单的弹性体，如梁，由于刚体运动的惯性力产生的轴力容易求得，这时的几何刚度阵就变为时变阵。本文只讨论几何刚度阵为时变阵的情况，即方程(2-9)式为时变动力学方程时的数值解法。显然，若弹性体没有刚体运动，则方程(2-9)式退化为常规的有限单元动力学方程。把(2-9)式按常规有限元的组集方法进行组集，便可得到对于运动弹性体的具有时变特性的、通用的有限元动力学方程:2-10)123高速旋转体动力学高速旋转体动力学高速旋转体通常是由是由三个刚体外环、内环、转子互相约束在一起

19、而成，可使陀螺仪转子具有空间转动的三个自由度。过去曾长期认为，高速自转的平衡对称卡登陀螺仪和单刚体陀螺仪的理论模型没有本质区别， 具有所谓“定轴性。 但实际上,理论研究和精密的实验研究都已证明这个想法是错误的。 平衡对称卡登陀螺仪的空间定向大都具有里雅普诺夫意义下的不稳定性（见运动稳定性）。卡登陀螺仪和单刚体陀螺仪模型有本质区别，只有通过多刚体系统模型的研究才能正确解释卡登陀螺仪的动力学特征。图 3-1如图3-1所示， 对于外径D与长度l的比值 D/15的转子，如多缸内燃机的曲轴、机床主轴等，这些转子的不平衡质点不是集中在同一平面内，而是分布在垂直于轴线的各个平面内。 对于这种转子动平衡问题,

20、一般都采用矢量法来求校正质量m、m的重径积mP和m戸。但是这种方法所带来问题是力多边形不bbbbbb易求解以及图解法不够精确。假如采用平面解法，不仅简单正确，而且对于没有动平衡机的工厂无疑有一定的实用价值。上述转子质量分布简图如图3-2所示，不平衡质量m、m、m分别分布在123与回转轴线垂直的三个平面1、2、3内，各质点距回转轴线的矢径分别为r、r、12r。当转子以等角速度。回转时，各质点所产生的离心惯性力分别为3P=mrw2（3-1）111P=mrw2（3-2）22113图 3-2方向如图所示。若选择转子左、右二端面T（过点A与轴线垂直的平面）、T（过点B与轴线垂直的平面）作为校正平面，在T T、T平面内分别加上校正质量m、bm，矢径为r、r，则校正质量所产生的离心惯性力为P，=mro2和bbbbbbP=mrO2，P、P、P、P和P组成了空间力系。bbb123bb选取三坐标轴x、y、z轴如图所示，并将作用在转子上的所有力向YAZ平面和XAY平面投影，如图3-3所示。图 3-3在图3-3中,所有的力组成了平面平行力系,列平衡方程：3-3)P=