例 2.1 已知坐标系 {B} 的初始位姿与 {A} 重合 , 首
先 {B} 相对于 {A} 的 Z
A
轴转 30°, 再沿 {A} 的 X
A
轴移动 12 单位 , 并沿 {A} 的 Y
A
轴移动 6 单位 . 求位
置矢量
A
P
B0
和旋转矩阵
B
A
R. 设点 p 在 {B} 坐标系中
的位置为
B
P=[3,7,0], 求它在坐标系 {A} 中的位置 .
0
6
12
;
100
0866.05.0
05.0866.0
)30,(
0
0
B
AA
B
zR pR
0
562.13
908.11
0
6
12
0
562.7
902.0
0B
ABA
B
A
ppRp
2.2 坐标变换