![自动驾驶理论及在农机中的应用](https://wfqqreader-1252317822.image.myqcloud.com/cover/24/35011024/b_35011024.jpg)
上QQ阅读APP看本书,新人免费读10天
设备和账号都新为新人
第2章 数学基础和软件基础
2.1 空间坐标系变换
本节给出描述空间直角坐标系变换的齐次变换矩阵。空间直角坐标系变换包含旋转和平移两部分,描述旋转可以用一个3×3的旋转矩阵,描述平移可用一个3×1的平移向量,使用旋转矩阵和平移向量可以定义4×4的齐次变换矩阵。
先介绍旋转,空间坐标系关系如图2-1所示,直角坐标系{B}的3个单位主矢量xB,yB,zB相对于直角坐标系{A}的方向余弦组成3×3矩阵
![](https://epubservercos.yuewen.com/C5E452/18685354208163806/epubprivate/OEBPS/Images/39764-00-14-1.jpg?sign=1739236883-nQLvObpcDf4N0ixrgH7Buu6UAnJLaotw-0-20b3bad499f2c42a340a9cf48b32f0a7)
![](https://epubservercos.yuewen.com/C5E452/18685354208163806/epubprivate/OEBPS/Images/39764-00-14-2.jpg?sign=1739236883-E1k9m8QeIUmng1dnH9C7ttJd3fNJGHjh-0-af0f2704b37db190dfa8a15b2dfe1101)
图2-1 空间坐标系关系
该矩阵描述了坐标系{B}相对于{A}的方位,我们称其为坐标系{B}相对于{A}的旋转矩阵。旋转矩阵有9个元素,但3个列矢量AxB,AyB,AzB均为单位主矢量且两两垂直,所以有6个正交约束条件
![](https://epubservercos.yuewen.com/C5E452/18685354208163806/epubprivate/OEBPS/Images/39764-00-15-1.jpg?sign=1739236883-mqS9yjEp6feV7NLEIYe6MUiHYp8hMlYJ-0-224f87552b406517d279cf53d0242511)
故只含有3个独立元素。
为正交矩阵,并且
。绕X、Y、Z轴旋转δ的旋转矩阵分别为
![](https://epubservercos.yuewen.com/C5E452/18685354208163806/epubprivate/OEBPS/Images/39764-00-15-5.jpg?sign=1739236883-krthITOIbf7yTWb1yVBxOl0P0KS82HZv-0-ef9877f2f6e3259fb46b04704beff7ed)
对于平移,我们用一个平移向量p=AOB来描述,AOB是坐标系{B}的原点在坐标系{A}中的坐标,是3×1的向量。
设空间中一点P,它在坐标系{A}中的坐标为AP,在坐标系{B}中的坐标为BP,一般地
![](https://epubservercos.yuewen.com/C5E452/18685354208163806/epubprivate/OEBPS/Images/39764-00-15-6.jpg?sign=1739236883-XDZ6rpcKa3wJEbR9TVbPpfmd4WqJ18wU-0-c4caf1ca4f3439cd17ebeeccf41394d6)
我们还可以用齐次坐标进一步简写上式,一个3×1坐标向量[x,y,z]T的齐次形式是4×1向量[x,y,z,1]T,不加区分地仍用AP、BP表示齐次坐标,则有
![](https://epubservercos.yuewen.com/C5E452/18685354208163806/epubprivate/OEBPS/Images/39764-00-15-7.jpg?sign=1739236883-9U3QTdL8Y2v172noxV6Ph7cp2S6fnQD0-0-0b259e15480def873bd034e4dbbe573b)
其中,为4×4齐次变换矩阵
![](https://epubservercos.yuewen.com/C5E452/18685354208163806/epubprivate/OEBPS/Images/39764-00-15-9.jpg?sign=1739236883-4e2pQxgPtfwUUJVAs6wLa80niyklA0oM-0-9bf1a8e277c2a134a5f7ef60df7ff8f7)
这里,向量的左上角与矩阵的左下角均为B,可以看作相互抵消,只剩左上角标A。