分享

四元数-第6讲-参考Quaterniond kinematics

 SLAM之路 2022-04-24
本部分涉及扰动及微分,内容较为复杂,需要结合前几讲的公式进行理解,后期会使用MATLAB写一些实例进行理解;


4.4 扰动、不确定度、噪声
4.4.1 局部扰动
4.4.2 全局扰动
4.5 时间微分
4.5.1 全局与局部扰动关系
4.5.2 四元数乘积的时间微分
4.5.3 其他有用的导数公式



4.4 扰动、不确定度、噪声
4.4.1 局部扰动
扰动后旋转元素可以按照未受扰动旋转元素q和微小局部扰动的顺序表示。根据汉密尔顿惯例,这个局部扰动通常出现在右侧,这里给出四元数和矩阵形式,
局部扰动很容易根据它的等效向量得到,通过在正切空间使用指数映射,即受扰动后的旋转元素,
从而,局部扰动的表达式是,
如果局部扰动角度非常小,那四元数或旋转矩阵形式的扰动根据泰勒展开式可得到,(根据第3讲3.2部分公式)
因此扰动可以在实际方向SO(3)的正切局部向量空间指定。进而,在这个向量空间表示这些扰动的协方差矩阵变得非常方便。
4.4.2 全局扰动
接下来思考全局定义下的扰动及相关导数。全局扰动则出现在四元数乘积中的左边,即

进而全局扰动的表达式为,

这些扰动在初始位置SO(3)的正切向量空间被指定。



4.5 时间微分
通过在向量空间表示局部扰动,我们将很容易得到对时间微分的表达式。现在考虑q=q(t)为原始真实状态,是扰动状态,则运用微分定义
对于上式,可采用(角度的变化对时间的微分即是角速度),
此处,△φ是一个局部角度扰动,对应于q定义下局部帧的角速度向量。
四元数(相同的方法可用于旋转矩阵)对于时间的微分,进一步推导,(行2结合4.4.1部分)
定义(结合四元数乘法性质)
因此可得到结论(旋转矩阵同理可得)

这两个公式正好与第三讲SO(3)中2.1和3.1部分一致;有趣的是,我们能参考角速度获得特定参考帧,它出现在由方向q或者R定义的局部帧中,这可能就是q和R的准确几何意义。从这个角度理解,当角速度出现在参考帧时,上述两个公式表明参考帧方向的演变趋势。

关于全局扰动的时间微分,也可以采用上面的公式;
4.5.1 全局与局部扰动关系
根据上文,先注意局部和全局角速度关系
两侧同乘q的共轭四元数,
4.5.2 四元数乘积的时间微分
我们使用常规公式求导四元数乘积的导数,
但需要注意,因为四元数乘法不具有交换律,因此需要我们严格按照乘积顺序 。这代表(无法合并成两倍)
4.5.3 其他有用的导数公式
4.5.1的结论公式两边分别成四元数共轭或矩阵的转置,转化为求局部角速度的公式(全局角速度同理),

    转藏 分享 献花(0

    0条评论

    发表

    请遵守用户 评论公约

    类似文章 更多