关于姿态解算与融合的证明篇(二)
2016-12-26 14:49
204 查看
旋转矩阵的变换:
对于旋转矩阵转化,先来解决坐标变换的表示。先从二维平面OXY坐标系讲起:当OXY逆时针旋转α度时,同一矢量R在不同坐标下的表示:这里涉及向量的基础知识 补充如下并简单计算:
根据方向余弦矩阵我们可以得到欧拉角:
姿态解算的原理:
姿态解算常用的算法有欧拉角法、方向余弦法和四元数法。 欧拉角法在求解姿态时存在奇点(万向节死锁),不能用于全姿态的解算;方向余弦可用于全姿态的解算但计算量大,不能满足实时性要求。 四元数法,其计算量小,无奇点且可以满足飞行器运动过程中姿态的实时解算。
姿态解算的原理:对于一个确定的向量,用不同的坐标系表示时,他们所表示的大小和方向一定是相同的。但是由于这两个坐标系的旋转矩阵存在误差,那么当一个向量经过这么一个有误差存在的旋转矩阵后,在另一个坐标系中肯定和理论值是有偏差的,我们通过这个偏差来修正这个旋转矩阵。这个旋转矩阵的元素是四元数,我们修正的就是四元数,这样姿态就被修正了。
四元数旋转矩阵证明过程:
共轭四元数即实数部分相同,矢量部分相反q*表示q的共轭四元数;四元数的范数定义为四个元素的平方和,且范数为1时称为规范化的四元数。
假定某矢量绕通过O点的某轴逆时针转动一个角度θ,则与该矢量固连的动坐标系和参考坐标系间的变换四元数为:
q=cos(θ/2)+sin(θ/2)cosα i+ sin(θ/2)cosβj+ sin(θ/2)cosγ k
通常称其为四元数的三角形式,也称特征四元数,其范数为1,在导航应用中一般所应用的四元数均为特征四元数。其标量部分cos(θ/2)表示了转角一半的余弦值,矢量部分则体现了转动轴的方向,α、β、γ是转动轴与参考坐标系各轴间的夹角。
旋转矢量坐标变换的四元数描述为:r’=qrq*或r=q*r’q
四元数对坐标变换:
整个姿态解算的过程如下:
相关文章推荐
- 关于姿态解算与融合的代码注释篇(三)
- 关于姿态解算与融合的基础概念篇(一)
- 姿态解算系列一:经验型卡尔曼数据融合
- 四元数姿态解算中的地磁计融合解读
- 四旋翼姿态解算——互补滤波法补充(融合磁力计)
- 四元数姿态解算及多传感器融合详细解析
- 四元数姿态解算中的地磁计融合解读
- 姿态解算系列一:经验型卡尔曼数据融合
- 姿态解算中关于姿态角度需要注意的点
- 四元素姿态解算 ---地磁计融合解读
- 四旋翼姿态解算——互补滤波法补充(融合磁力计)
- 四元素姿态解算 ---地磁计融合解读
- 四元数姿态解算中的地磁计融合解读
- 关于最大流增广路径算法的正确性的证明
- 关于调和级数发散性的证明
- 关于一种求最大公约数的算法的分析与证明
- 随机数:关于用Rand7生成Rand10的最准确的算法(MS中的一道题)--仿真证明
- 关于NP-hard NP-complete问题定义典故与解释证明
- 关于补码取负数的证明
- 关于AC自动机的正确性的证明