![智能驾驶之激光雷达算法详解](https://wfqqreader-1252317822.image.myqcloud.com/cover/487/50233487/b_50233487.jpg)
2.2.2 李代数基础
李代数是由一个集合、一个数域
和一个李括号运算
组成的代数结构,可表述为(
),用于表示被赋予李括号运算的线性空间。李代数的定义需要其满足下述条件[7]。
(1)封闭性:若,则有
。
(2)分配率:若且
,则有
。
(3)自反性:若,则有
。
(4)反对称性:若,则有
。
(5)雅克比恒等式:若,则有
。
事实上,李括号运算是任意线性空间中的一种广义的向量乘法,其不仅适用于任意维度的实向量空间,也适用于复数空间和对偶空间。具体来说,在三维空间中,向量的叉乘运算即为该空间的李括号运算。
李代数的一个重要作用在于其能够反映李群的局部特性,并且李群和李代数
之间满足下述双射关系。
● 李群到李代数的对数映射:
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/202.jpg?sign=1739333495-gWqRqUrraFkEanNvtOWxXjU4RaBsQyYQ-0-cd134946f0794f4e3d4131abda821b60)
(2-49)
● 李代数到李群的指数映射:
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/203.jpg?sign=1739333495-7xoKLFnaKnLoxFifOVxPEpmja0Q5LrB0-0-cd1c5fd868b7e52b38d9f5bdb0cf65c5)
(2-50)
更具体地说,李代数实际上是李群在其幺元处的切空间,它能够完全捕获李群的局部结构,并可表示为
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/204.jpg?sign=1739333495-SXl9SSkCUW14IxRqh3uTJlR2zFHPyNsg-0-881a4e5f142be693f0540d12f400c4a7)
(2-51)
至此我们可以看出,有了李群和李代数之间的映射关系,我们就可以将流形空间中待求解的问题表示成对应的线性空间中的李代数结构,从而使得利用线性空间中的模型和算法成为可能。
1.李代数![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/205.jpg?sign=1739333495-ldAAWrU0VoYiYZbE4UHrzxOCS3xVnonH-0-92820e4907031521131e6e3551145baa)
我们再回头分析旋转矩阵构成的李群SO(3),其对应的李代数则记为
。结合李代数和李群之间的映射关系可知,
的元素应为三维线性空间中的
矩阵。若
为
对应的李代数,则结合
的指数映射关系可知
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/213.jpg?sign=1739333495-nI1yz7a8XoZMd32CZFEE5kNSGGjPpVVz-0-00c5a075f8b9960da48ab6b3feda2b68)
(2-52)
另外,结合罗德里格斯旋转公式[见式(2-22)]以及指数函数的泰勒级数展开式,对旋转向量取指数映射,可得下述等式关系:
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/214.jpg?sign=1739333495-iZGQRSHl5EGaKil4kD0Ljwt0Ci3g6Yes-0-860254489570567fea110214ecc4da1a)
(2-53)
对于反对称矩阵的乘积,我们可以推导出其具有下述特性:
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/216.jpg?sign=1739333495-O5IPzYNDiQGbgMIj1J9jM5WgMBTq1ikd-0-47806d734165e341fb5c2c72225731c2)
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/217.jpg?sign=1739333495-EcdVhqChIJFUtI44R24iuGu6QGCcIub0-0-ecc01edc7307d52883003f75e6524771)
(2-54)
因此,式(2-53)可进一步简化为
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/218.jpg?sign=1739333495-9TtXeCT7phlkBz7OndhksfPQy38LveX2-0-36bcb6610a1fce6dd28b5bcac352bfdc)
(2-55)
至此我们可以看出,对于,对应的李代数
,其中
和
分别为
对应的旋转向量表达中的旋转角和单位转轴向量。由于反对称操作满足数乘运算,令
,对应的欧氏空间中的三维向量为
,李代数
可具体表示为
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/227.jpg?sign=1739333495-K8yHgirhGqtatUG80KoMysipbb1fRHGA-0-d92521967d526a38ee483210587b90f8)
(2-56)
此外,空间可由下述三组基表示,其中每个基表示绕某个轴的微小旋转。
,
,
(2-57)
由此,我们也可进一步将空间中的元素
表示为上述三组基下的向量形式:
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/234.jpg?sign=1739333495-MYOeRm3cky5lScDPxiiZHG74NfTBukrE-0-ae8ee8a63b5cae53ab4ed1edf8add286)
(2-58)
结合对数函数的泰勒级数展开式,我们也可得到由李群到李代数的对数映射关系,这里不再展开推导。如图2-11所示,我们最终可以得到旋转矩阵和李代数以及三维向量之间的关系如下:
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/235.jpg?sign=1739333495-c8Zdgp2wNrj6k8PIEkVkHSY3lPRzvCIa-0-f2d4786312d1006a1007fbde3469c297)
(2-59)
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/236.jpg?sign=1739333495-0qCiZdb8PODdV0N41xv64qunG3upwtGH-0-cff4896d0169e685b721c3f14ac87acb)
(2-60)
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/2-11.jpg?sign=1739333495-lQojK1MSZUxvSJq5t0ADbs4MhGVkr43a-0-6cc8a4071cb5c13d43b920c8e783df5b)
图2-11 向量、李代数
和李群
之间的关系示意图
其中和
分别为反对称操作与其逆操作,并有
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/242.jpg?sign=1739333495-NvpDoIVwGZNiMfCY6DLfbxmO5geHRvYc-0-1703a7983dbb01980301975524d2002c)
(2-61)
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/243.jpg?sign=1739333495-02VirN0ePQxIP6Wpl28KcChhdtRiK9Ma-0-72bc11d70a64e4590d7f4193337892b4)
(2-62)
2.李代数![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/244.jpg?sign=1739333495-IUc8r2zJIIn51FALxQcqa5AiABDQMPCC-0-623b922ce389e87dce06b56152ce3aa1)
进一步地,对于由齐次变换矩阵构成的李群
,我们将对应的李代数命名为
。由式(2-63)中旋转矩阵
的结构可知:
是由
矩阵组成的空间。
,
,
(2-63)
该空间可由下述6组基表示,其中每个基表示绕某个轴的微小旋转或者沿某个轴的微小移动。
,
,
,
,
(2-64)
故可具体描述为
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/261.jpg?sign=1739333495-W6zmyVKPa1X9P9ZFyDVsGMsikUNYvY3v-0-877067db2aed9236a540b4fdfc2767ae)
(2-65)
若为
对应的李代数元素,则使用上述基可将其表示为下述矢量形式:
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/264.jpg?sign=1739333495-ll4iUE8dDGt5bYmP7qa9lSe5JjQ4vrX4-0-082e671d10ea9458ccd05dcad7e24c0d)
(2-66)
中的前三维表示位移,后三维表示旋转。根据李代数到李群的指数映射关系,对
取指数,于是有
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/267.jpg?sign=1739333495-izWINB1KGBhtqFz8wMWaBJyUMZzmZwWq-0-cbc6bc6bfc521179181eafaf2efb3a09)
(2-67)
其中:
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/268.jpg?sign=1739333495-4GxvJ1cJwNcFbV4e3KqxRV4RD8qEMKh1-0-a3ef247411a2ad9fa4e0b2db256ccc33)
(2-68)
在式(2-67)中,同样有,
和
为齐次变换矩阵
中旋转矩阵
对应的轴角表示,并可据此推导出李代数
中位移分量
与齐次变换矩阵
中位移分量
之间的关系如下:
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/278.jpg?sign=1739333495-uawsATa7iYKNRAsQXEb9XcjzwkeRpyfq-0-03bfb8d5c45265835a43292958c1ca2c)
(2-69)
3.“
”“
”操作的定义
下面进一步引入流形空间上的“”“
”操作[8],以便我们在后续章节中描述汽车的旋转和平移变换。令
为系统状态变量所在的流形空间,
为该流形空间的维度,
和
是局部同胚的,通过“
”“
”操作可在
幺元的局部邻域内与其正切空间
之间建立下述双映射关系:
,
(2-70)
假设我们已知,
为其正切空间
上的一个扰动矢量,则
的物理含义如图2-12所示。
![](https://epubservercos.yuewen.com/4AC89A/29556666103448906/epubprivate/OEBPS/Images/2-12.jpg?sign=1739333495-ZmuhGzJfWqBR9V5STX99GCf37etzXYhU-0-97042a2d722e358d72980402a9219898)
图2-12 “”操作原理示意图
进一步地,对于复合流形,则有
,
(2-71)
其中,为旋转矩阵,
为旋转向量,
,
和
分别表示旋转矩阵和旋转向量之间的罗德里格斯变换。