旋转矩阵算法_对旋转矩阵求导

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

在slam算法当中,我们经常要对载体的姿态进行优化。这就不可避免的要计算代价函数或者量测模型对旋转矩阵的导数。一般涉及到对旋转矩阵求导,我们首先都会想到李群、李代数、李导数。这里我们用另一种思路来对旋转矩阵求导,不过本质上还是用到了李群、李代数的基础理论,只是形式上会更直接一些。

首先我们要介绍就是著名的罗德里格斯(Rodriguez formula)公式:

(2.1)

这里

为单位矩阵,
为旋转矩阵的轴角表示,在秦永元老师的《惯性导航》这本书里又叫旋转矢量;

以上罗德里格斯公式,将轴角与旋转矩阵关联了起来。而轴角其实就是旋转矩阵(特殊三维正交群)对应的李代数。正因为我们如下的推导完全基于该公式,所以说,本文的思路,本质上还是用到了李群李代数的理论。

为小角度的情况下,根据罗德里格斯公式忽略二阶小量,存在如下常用近似公式:

(2.2)

这里

的叉乘反对称矩阵。

下面我们来具体求对旋转矩阵的导数。

slam中涉及到的对旋转矩阵求导,一般都是经旋转矩阵变换后的矢量对旋转矩阵求

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值