![自动驾驶理论及在农机中的应用](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=1739149523-VaD8pbelBOG2kXAuqc9upudZyNXyFlfR-0-f7b5bc76a5ed70d302483b0dc074cccb)
![](https://epubservercos.yuewen.com/C5E452/18685354208163806/epubprivate/OEBPS/Images/39764-00-14-2.jpg?sign=1739149523-szEGQFcbQSoGE6fWgtPokECx3DpOkHrv-0-020065826fbb7f920197a5581a130fe0)
图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=1739149523-7UpsuePsAOVq5vWM53mtfdiJxD8QEBuj-0-f2a4114c77c15431e200d0a34e34782f)
故只含有3个独立元素。
为正交矩阵,并且
。绕X、Y、Z轴旋转δ的旋转矩阵分别为
![](https://epubservercos.yuewen.com/C5E452/18685354208163806/epubprivate/OEBPS/Images/39764-00-15-5.jpg?sign=1739149523-aVO5JaGIxkmyxvZCoCneUCmlZRtbFwvW-0-0c609c51947738f5454f7791f98edb38)
对于平移,我们用一个平移向量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=1739149523-THTtXTXeVV5phVsKM4oNtY8scPVfaEqh-0-530219d6c0f6c8ea166a3aaac19b9a89)
我们还可以用齐次坐标进一步简写上式,一个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=1739149523-7YmQVlx0V1WLBnbJtiwcyYnrOPNTAUqE-0-1a61ad705677b84b261aa003551e104b)
其中,为4×4齐次变换矩阵
![](https://epubservercos.yuewen.com/C5E452/18685354208163806/epubprivate/OEBPS/Images/39764-00-15-9.jpg?sign=1739149523-kxaSGQnCVFnDcc4KVX2ZD5IbazidUi4N-0-2db1deed5925ca9760d282ccbdd82185)
这里,向量的左上角与矩阵的左下角均为B,可以看作相互抵消,只剩左上角标A。