单位主矢量相对于坐标系{A}的方向余弦组成：
xB
yB
zB
xA
yA
zA
其中：cos cos(xB , xA )
既表示了刚体F在{A}系中的方位，也描述了{B}系在{A}系中的 姿态。
3.1.2.2 坐标变换
一、坐标平移
如图3-5，坐标系{B}与{A} 方向相同，但原点不重合。
图3-5 坐标平移
此式称为平移方程。其中 是B系中的原点在A系中的表示。
xA
OB
30o xB
yA yB 30o
所以有：
cos 300 sin 300 0 0.866 0.5 0
A B
R
R(
z,300
)
sin
300
cos 300
0
0.5
0.866 0
0
0
1 0
0 1
10
A PBO
5
0
最后得： APBAR BP APBO
9.098 12.562
第三章 机器人的运动学
3.1 工业机器人运动学
3.1.1 相关知识回顾
一、行列式和矩阵 1. 行列式按照行（或列）展开法则：行列式等于它的任意一行 （或列）各元素与其对应的代数余子式乘积之和。
2.行矩阵 3.列矩阵 4.矩阵相等：两同型矩阵（行数和列数都相等）对应元素相等。
5.单位矩阵：主对角线元素为1，其它所 有的元素都为0的方阵。 6.矩阵的运算 （1）矩阵的加法：两同型矩阵的对应元素相加。
，它的齐
次坐标就是
，即满足Px=ωPx/ω，Py=ωPy/ω，
Pz=ωPz/ω（ω是非零整数）。可以看出，在三维直角坐标系中，
由于ω取值的不同，一个点的齐次坐标的表达不唯一。
