空间连杆机构运动分析未讲

第七章空间连杆机构运动分析

第七章空间连杆机构运动分析 (1)

7.1空间机构运动分析矩阵法：刚体空间位移矩阵 (2)

7.1.1 绕直角坐标轴的旋转 (2)

7.1.2 空间旋转矩阵 (3)

7.1.2.1 按右手规则绕三维直角坐标轴的一系列旋转表示空间旋转 (3)

7.1.2.2 绕空间任意轴u旋转φ角表示空间旋转 (3)

7.1.2.3 用欧拉角ψ，θ和φ来描述空间旋转 (4)

7.1.3 刚体位移矩阵及其逆 (4)

7.1.4 旋转矩阵与位移矩阵的微分 (5)

7.1.4.1 旋转矩阵的微分 (5)

7.1.4.2 位移矩阵的微分 (6)

7.2空间四杆机构运动分析 (7)

7.2.1 空间四杆机构RSSR运动分析 (7)

7.2.2 习题 (8)

7.3空间串联机器人运动分析 (8)

7.3.1 3-RPR运动分析 (8)

7.3.2 RRRRRR机械手运动分析 (11)

7.4空间并联机器人运动分析 (12)

7.4.1 6-SPS并联机构的位置分析 (12)

7.5参考文献 (13)

7.1 空间机构运动分析矩阵法：刚体空间位移矩阵

在三维空间中，刚体的总位移可以视为刚体的角位移和刚体上任何适当参考点的线位移这两个基本位移分量的总和。描述刚体位移有好几种方法，其中较常用的是绕三角坐标轴的一组旋转矩阵、绕空间任意一轴的旋转矩阵和欧拉角旋转矩阵。下面分别讨论这三种旋转矩阵。

7.1.1 绕直角坐标轴的旋转

图表示固连在旋转刚体上的一个定长向量绕z 轴的旋转向量v 在位移前后的所有分量都是以相对固定的x-y 轴参考系来度量。当向量1v 绕z 轴旋转α角，到达2v 处时，有下列方程（参见邹老师的教材P62）

21121121cos sin sin cos x x y y x y z z

v v v v v v v v αα

αα=-=+=

(7.1) 把上式写成矩阵的形式，有

212121cos sin 0sin cos 00

1x x y y z z v v v v v v α

α

αα-⎡⎤⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥=⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦⎣⎦

(7.2)

上式可缩写成如下的形式，即

2,1()[]()z v R v α=

(7.3)

式中,[]z R α为绕z 轴转α角的旋转矩阵，有

,cos sin 0[]sin cos 00

1z R ααααα-⎡⎤

⎢⎥=⎢⎥

⎢⎥⎣⎦

(7.4)

同理，可写出分别绕y 轴和x 轴旋转的矩阵

,cos 0sin []010sin 0cos y R βββββ⎡⎤

⎢⎥=⎢⎥

⎢⎥-⎣⎦ (7.5)

,1

00[]0cos sin 0sin cos z R γγ

γγ

γ⎡⎤

⎢⎥=-⎢⎥⎢⎥⎣⎦

(7.6)

7.1.2 空间旋转矩阵

空间旋转矩阵可用若干个基本旋转矩阵来表示，其主要有以下三种形式。

7.1.2.1 按右手规则绕三维直角坐标轴的一系列旋转表示空间旋转

固连于刚体上的矢量在三维空间内旋转的每个分量是3x3矩阵，空间旋转矩阵可把每个矢量矩阵逐次相乘来求得，即当三个旋转顺序为绕z 旋转α角，绕y 轴转β角，然后在绕x 轴转γ，则始末位置1与2处矢量v 的关系可用下式描述：

2,,,11()[][][]()[][]x y z v R R R v R v γβααβγ== (7.7) 式中空间旋转矩阵[]R αβγ为

[]c s c c c s c s R s c c s s c c s s s c s s s c s s s c c c αβγαβαββαγαβγ

αγαβγβγαγαβγ

αγαβγ

βγ-⎡

⎤

⎢⎥=+--⎢⎥

⎢⎥-+⎣⎦

(7.8)

式中cos c αα=，sin s αα=。

7.1.2.2 绕空间任意轴u 旋转φ角表示空间旋转

在图中，(,,)T x y z u u u u =是单位向量。绕u 轴旋转φ角的运动，可按下列步骤来描述：首先转动刚体，使u 轴平行于z 轴，再以u 的这一暂时位置为转轴旋转φ角，然后把u 轴旋回它原来的位置。这一完整的旋转过程可用矩阵描述：

2,,,,,1,1()[][][][][]()[]()y x z x y u v

R R R R R

v R v βγφγ

βφ--== (7.9) 式中，,[]u R φ称为轴旋转矩阵，它是描述刚体空间有限旋转的最常用的形式之一。当形成,[]u R φ时，单位向量u 的方向余弦有下列代换：

sin ,sin cos cos sin ,cos cos y x z

u u u γβγβγβγβ==

==

==(7.10)

把式(7.10)代入式(7.9)，有

2

2

,2[]x x y z x z y u x y z y y z x x z y y z x z u V C u u V u S u u V u S R u u V u S u V C u u V u S u u V u S u u V u S u V C φφφφφφφφφφφφφφφφφφφ⎡⎤-+⎢⎥=++-⎢⎥⎢⎥-++⎣⎦

(7.11)