在slam算法当中,我们经常要对载体的姿态进行优化。这就不可避免的要计算代价函数或者量测模型对旋转矩阵的导数。一般涉及到对旋转矩阵求导,我们首先都会想到李群、李代数、李导数。这里我们用另一种思路来对旋转矩阵求导,不过本质上还是用到了李群、李代数的基础理论,只是形式上会更直接一些。
首先我们要介绍就是著名的罗德里格斯(Rodriguez formula)公式:
这里
以上罗德里格斯公式,将轴角与旋转矩阵关联了起来。而轴角其实就是旋转矩阵(特殊三维正交群)对应的李代数。正因为我们如下的推导完全基于该公式,所以说,本文的思路,本质上还是用到了李群李代数的理论。
在
这里
下面我们来具体求对旋转矩阵的导数。
slam中涉及到的对旋转矩阵求导,一般都是经旋转矩阵变换后的矢量对旋转矩阵求

本文介绍了在SLAM(同时定位与建图)算法中如何对旋转矩阵进行求导,虽然采用了一种相对直观的推导方式,但仍然基于李群和李代数的理论。通过罗德里格斯公式将轴角与旋转矩阵联系起来,并详细展示了如何计算经过旋转矩阵变换后的矢量对旋转矩阵的导数,特别地,当旋转角度很小时的近似表达式。最后提到了一篇经典文章中的类似求导方法,建议读者参考。

1272

被折叠的 条评论
为什么被折叠?



