第二章刚体的位置和姿态.

1、第二部分运动学运动学是研究物体作机械运动的几何性质， 而不涉及引起运 动的原因，也就是说，不涉及物体的受力。物体的机械运动是指物体的空间位置随时间的变化， 这种变 化具有相对性，即对于不同的参照物这种变化具有不同的描述， 因此，选取参考系或称参考基是运动学分析首先要解决的问题。 其次，要研究物体及物体系统（刚体及刚体系）的位置、速度和 加速度的变化以及它们在构件及机构中的传递，它们的数学模型 如何表达，对这些变量如何分析和计算等。我们仅仅研究刚体作平面运动的运动学。第二章刚体的位置和姿态运动学问题是研究物体或物体系统在空间的运动情况，即它或它们的空间形态如 何随时间变化，以及它们形态之间的相互

2、关系等等。为此，我们首先要解决的是，对 它或它们的空间形态如何描述的问题。在大学物理课程里，我们已经学习了点的 运动，但是物体的运动远比点的运动复杂，因为点只有位置而没有姿态，一个物体可 以看作由无数的点组成，在运动过程中各个点的运动一般情况下是不一样的，也就是 说，一个物体的运动不能视为一个点的运动。体育比赛之所以能够吸引数以千万计的 目光，是因为大家不仅将运动员在比赛场地的状态视为一个点的运动，更主要的是欣 赏他们力量型的或优美型的姿态。工程结构的运动状态更是如此，图2-0-1是曲柄连杆机构的示意图，我们对曲柄施加一力偶矩使之绕0点转动时，连杆和滑块将产生运动，显然，滑块的运动状态只能是沿

3、滑槽移动，其上各点的运动是一样的，但是，连 杆的运动就比滑块复杂，其上各点的运动不一样。因此我们需要寻找一种方法以描述 这些点的位置以及它们相互的位置关系。为了从点的位置的描述过渡到刚体的形态的 描述，我们将采用与大学物理中不同的方法。图2-0-1曲柄连杆机构第一节 点的空间运动及其描述（一）点的空间位置首先建立一个惯性参考基，我们用矢径rA表示点A在惯性参考基中的空间位置,该矢量从参考基基点0出发到达点A,方向指向A，图 2-1-1如图2-1-1所示。矢径rA可以用参考基的基矢量表 示为：A =心%k（ 2-1-1）其中ax、By和Jz分别为该矢径在X、y、Z轴的三个分 量。我们已经知道，矢

4、径rA的矩阵表示为：rA=（AxAyrAz T（ 2-1-2）（二）点的速度和加速度1 .点的速度根据速度的定义，点 A的速度是其位置对时间的一次微分，即：- drVaa 二 rAxirAyj rAzk（2-1-3）dty式中，考虑到惯性参考系是固定坐标系，不随时间变化，因此，三个坐标轴的单位矢rAy量对时间的微分等于零。上式同样可以用矩阵表示为：(2-1-4)或者记为:T TVa =：Vax VAy Vaz I.AyAz( 2-1-5)2.点的加速度将速度对时间再次微分可以得到点A的加速度：aA - rAFAxiAy jrAzk(2-1-6)写作矩阵形式为：a A = r A=AxrAyJ(

5、2-1-7)或者记为：-VAx Ta a - r aVAyVaz二 OxrAyr； T(2-1-8)上面各式中，惯性系坐标轴的单位矢量对时间的微分同样为零。例2-1-1 细杆0识绕Oi轴以即翌t的规律运动，3为常量，该细杆上套有一小环M ,小环同时又套在半径为r的固定圆环上，如图 2-1-2，求小环的速度和加速度。如图，以O为原点建立惯性坐标系，M点的位置为rM = (rc o 2 r si0 T(1)M点的速度用矩阵表示为：Vm 二 rm=-2r si r22r co 20T= 2rV-sir2co 20T解:(2)图 2-1-2= 2r( sir2 coS 0T其中，M点的速度沿x轴和y轴

6、的分量分别为:VMx=2wsi2VMy=2wcoS申(3)因此，M点的速度大小为:Vm=2r (4)M点的加速度用矩阵表示为:Tam =rm - -4r : co 2 -4r : si r20(5)这里，由于=常量，=0。M点的加速度沿x轴和y轴的分量分别为：2 2aMx = -4c o 2 : ,aMy = -4rsi 2（6）因此，M点的加速度大小为:aM2 2 aMx aMy(7)此时，如果将 M点的加速度分别向 M点在圆周的切向和法向投影，可得:2(8)aM - 0 ,aMn - 4r 第二节广义坐标和自由度（一）广义坐标的概念为了进一步讨论物体的位置和姿态的描述，需要引进广义坐标的概

7、念。我们已经习惯于用直角坐标描写一个点的位置，如图2-2-1（ a），点M在xoy坐标平面内（也称基平面）的位置由其坐标值 x和y唯一确定。但是，这种描述是否就是唯一的呢？显 然不是，比如，可以采用极坐标描述，见图（b）。实际上还可以由其他的描述，图（c）中用面积A和角度确定点的位置等等。由此可见，确定一个点的位置的一组参数不是唯一的。为此，我们引入广义坐标的概念：如果存在一组相互独立的参数 qi, q2, qn,只要他们能够确定点的位置，不管这些参数的几何意义如何，这一组参数就称为这个点的广义坐标。比如上面的例子中，（x, y） , （r,和（A, 等都是 M点的广义坐标。一个点是如此，一个

8、物体也是如此。(a)(b)(c)图 2-2-1因此，广义坐标可以写作下面的通式:(2-1-1)riqi 02, ,qn ,t上式中，qi, q2，qn,为i点的广义坐标，时间t为参变量。将上式对时间求导,即得到i点的速度为：Vi汀电qjcq-jct(2-2-2)其中，q j =1,2,，n相应地称为广义速度。如果i点的位置描述函数中不显含时间t，则上式右边第二项应等于零。例2-2-1空间一动点 M，若选取参数r，二：为广义坐标，如图2-2-2所示，求动点M的速度。解:依题意，有:(1)由几何关系可得：卜二 r sin 二 cos : y = r sin 日 sin 申（2）z = r cos

9、日在笛卡尔直角坐标系中，M点的速度坐标阵为： tm mix y z( 3)由（2 ）式，有-Xr.:r亠-:r:zr(4)lx 二 r sin v cos：。cos t cos - r sin v sin ;:I .- V = r sin 日 sin + rT cos日 sin 护 一 r申 sin 日 cos（5）z = r cos日r 日 sin 9最后可得M点的速度大小用广义坐标表示为：6迈222 /2:2Tz 、vM =、x y z r r r sin（6）（二）完整系统的概念多个质点的集合可以组成一个质点系统，根据系统的运动是否受到预先规定的几何及运动条件制约的情况，可以将该质点系统

10、分为自由系统和非自由系统。图2-2-3图 2-2-3Xj、y,、z,表示系统中，（a）为空中自由飘动的气球，因而是 一自由系统，图（b）中，物体B只能限 制在环形轨道内运动，因而是一非自由系 统。对于非自由系统，那些预先规定的、（a）与初始条件及受力条件无关的、限制系统 的几何位置或（和）速度的运动学条件称为约束。在多种约束类型中，我们只介绍完整约束。仅仅限制系统的几何位置和形态的约束称为完整约束，如果用第i个质点的笛卡尔直角坐标，那麽由N个质点组成的系统的完整约束的约束方程可 以写作下面的通式:fk Xi, yi ,Zi ,xn , yN, zn =0 k =1, 2,r; r ： 3N（2

11、-2-3）完整约束又称为几何约束。换句话说，这种约束只有位置和姿态的约束而没有速 度和加速度的限制。例2-2-2一个半径为R的轮子沿斜面向下滚动而不滑动，如图2-2-4所示，分析轮子所受的约束。54如果沿斜面向下为 x轴建立平面 参考基，如图，由于轮子只能在斜面上运动，所以其形心 C的位置到斜面的距离不会改变，即存在几何位置的约束：图2-2-4yc 二 R（1）另一方面，轮子沿 x轴的坐标位置就是轮子滚过的轨迹：Xc = Co（b）其中，是轮子转过的角度，Co是质心沿斜面的初始位置，假设轮子开始时形心C在y轴上，贝U Co = 0。可见，该轮子受到完整约束，共有两个约束方程。（三）自由度的概念

12、一个由N个质点组成的系统，在笛卡尔直角坐标空间中，共有3N个坐标，如果该系统是自由的，则需要3N个坐标参数来确定其空间位置。如果受到完整约束， 即受到预先给定的几何位置的限制，显然该系统就不再需要 3N个坐标参数来确定其空间位 置了，如果存在I个完整约束，即有I个完整约束方程，则该系统仅需要n = 3N I个坐标参数就可以确定该系统的几何位置，当然，这n个坐标参数必须相互独立。我们将n称为该完整系统的自由度。前面已经介绍过广义坐标的概念，一个物体或一个系统可以用广义坐标描述其位置和姿态，而一个物体或一个系统的广义坐标不是唯一的，但是每一组广义坐标的各 个参数必须是相互独立的。对于完整系统，任一

13、组广义坐标中坐标参数的个数应该等 于该系统的自由度。也就是说，一个完整系统的自由度为 n,则确定该系统的广义坐标 数也为n。如例2-2-2，轮子在xy基平面上的形态需要 3个坐标描述，第三节刚体位置和姿态的描述（一）单个刚体的自由度一个自由刚体，不受任何限制在笛卡尔直角坐标空间中运动，它具有6个自由度，包括沿3个基矢量方向的移动和绕 3个基矢量的转动。比如一条船在水中航行，要确 定这条船在水中的位置和姿态，需要确定它的前进后退、左右移动、上浮下沉这3个整体的移动情况，还要知道该船体绕由船头到船尾这条轴线的转动（称为横摇）、船头相对船尾的俯仰运动（称为纵摇）以及该船航向的改变运动（称为偏航）。这

14、些运动状态需要6个相互独立的参数加以描写，所以船在水中航行一共有6个自由度。前3个称为移动自由度，用以确定船体的位置；后3个称为转动自由度，用以确定船体的姿态，参见图2-3-1。如果刚体不是自由的，受到预先给定的几何位置的限制，它的自由度将减少。比如将物体限制在某个基平面内运动，如图2-3-2，将杆AB限制在xoy基平面内运动，此时，杆 AB的几何位置受到的限制包括:杆AB上任一点的z坐标值都等于零;绕x轴不能产生转动;绕y轴不能产生转动。图2-3-1船在水中的自由度图2-3-2做平面运动杆的自由度于是，杆AB还剩下3个自由度，即沿x轴和y轴的移动和绕z轴（垂直纸面）的转动。 杆AB的自由度还

15、可以这样确定， 该杆的位置和姿态取决于 A和B两点的位置，A和B 两点各有两个坐标参数（Xa, yA）和（Xb, yB）共4个坐标参数，而该杆存在一个完整 约束，即杆AB的长度不变且等于 L:2 2 2Xb - XayB - yA i； = l所以杆AB的自由度为 n = 4 1 = 3。（二）齐次坐标与齐次变换的概念1 .惯性参考基和刚体连体基物体的大小不一、形状各异，我们将刚体在空间的位置和姿态统称为刚体的位形。为了采用广义坐标描述刚体的位置和姿态，需要建立两个矢量参照基，一个是惯性参 考基，一般认为，惯性参考基与地球固定，我们称之为参考基，也称定基；另一个是 固定在刚体上的矢量基，该矢量

16、基将随物体一起运动，我们称之为动基。一旦建立了 这两个矢量基，我们就可以利用两个矢量基的空间关系来确定刚体的位形。我们将矢 量基的原点称之为基点，将矢量基 3个坐标轴的单位向量称为基矢量。为了描述矢量基之间的关系，需要介绍有关齐次坐标及其变换的概念。2.齐次坐标我们把不同时等于零的四个数组成的列向量x1 x2 x3 x4 T称为三维空间里点的齐次坐标。点的齐次坐标与该点笛卡尔直角坐标（x y z f的关系为：X.x2x3(2-3-1)x -, y -, z -x4x4x4显然，一个点的齐次坐标不是唯一的，或者说,一个点的齐次坐标具有多值性。例如，设P点的齐次坐标为P = (% x2 X3 X4

17、 T(2-3-2)根据（2-3-1 ）式，入工0时有P =(?, % Zx2 也3 必 T(2-3-3)说明（2-3-2 ）和（2-3-3）都是P点的齐次坐标。一个点可以用齐次坐标表示，一个物体如何用齐次坐标描述呢？如图 2-3-3, o-xyz为惯性参考基，ob-xbybzb为物体的连体基,连体基的基点ob在惯性参考基中的位置用b图2-3-3by向径r表示，A为刚体上的任意点，假设 A相对其连体基用向径 Q表示，其在连体基上的分量分别为Qxb、Qyb和Qzb,女M可确定AQy和Qz分别投影到惯在惯性参考基中的位置？这个问题的解决并不难，只要将 性参考基三个基矢量上就可以的得到，当然，此时还需

18、要知道连体基和惯性参考基基矢量之间的夹角。现将两个矢量基的基矢量之间夹角的余弦值列于表2-3-1中，于是可以得到如下关系：Qx 二 QxbhQyb2Qzb3r-Qy =Qxbm- +Qybm2 +Qzbm3 +2（2-3-4）、Qz =Qxb5 +Qyb n? +Qzb 门3 +“其中，r-、2、3分别表示连体基基点在惯性参考基中的位置。表2-3-1动参考系与定参考系坐标轴间夹角的余弦值b xbyb zxh =cos(x,xb )I2 =cs8,yb )I3 =cos(x,zb )ym1 =cos(y,xb )m2 =cos(y,yb )m3 =cos(y,zb )zn勺=cos(z,xb )

19、n2 =cos(z,yb )n3 =cos(z,zb )如果采用齐次坐标表示 A点的位置，对于连体基和惯性参考基分别设为:(X； X；x3 x4 T 和XiX；X3X4T利用齐次坐标与笛卡尔直角坐标间的关系、即（2-3-1）式，（2-3-4）式可以改写为:X1Xi 1 X；1 1 2X4X；m；X4X4X4 1 “X4X；Xi:miX4X4X3x；niX4X4n；X3 .l3riX4X3 m3r；X4+ X3+一门3 RX4(2-3-5)根据齐次坐标的多值性，可以令X4 = X4，代入上式，将上式进一步改写为:X； = xlh + x；l ； + x；l3 + gx；X X； m； x；m； x3m3 r；x4X3 = xln； x；n2 X3n33X4IX4 = x4上是采用矩阵描述则为：(2-3-6)f 、 Xi1 l1l213ri 1ix；X；m；m2m3r2FX；X3n；n；rh“x31X4_0001x4 丿(2-3-7)简记为：(2-3-8)X =TX其中，T称为齐次变换矩阵，即l1l2l3rimm2m3r2T =（2-3-9）m门2门33.0oo1 _值得关注的是