捷联惯导基础知识解析之五(低成本姿态航向参考系统)
陀螺仪精度0.1°/s;加速度计精度5mg;主要指零偏重复性!
一、简化的惯导算法
1、姿态更新
陀螺仪输出直接进行积分,得到角增量;
2、速度更新:
在导航系下,完整的速度微分方程,如下:
其中,在地速V<100m/s时,第二项量级大约为1mg;小于传感器本身的误差;因此,忽略地球自转和导航系在地球表面旋转的影响,得到如下更新方程:
3、位置更新:
二、低精度惯导系统误差方程
1、姿态误差方程:
其中,括号中第一项为陀螺仪的一阶马尔可夫过程误差:括号中第二项为陀螺仪角速率白噪声。
其中τGi为相关时间常数,WrGi是一阶马尔可夫过程激励白噪声。
误差方程详细解释:捷联惯导基础知识解析之二(捷联惯导更新算法和误差方程)
噪声详细解释点击:捷联惯导基础知识解析之三(噪声和kalman滤波)
2、速度误差方程:
其中,括号中第一项为加速度计的一阶马尔可夫过程误差:括号中第二项为加速度计比力的白噪声。
其中τAi为相关时间常数,WrAi是一阶马尔可夫过程激励白噪声。
综上,可以看出陀螺仪和加速度计噪声均采用一阶马尔可夫过程;其优点如下:
Allan方差噪声系数,主要有用的是角度随机游走系数(用于设置Q阵)和零偏不稳定性系数(用于设置一阶马氏过程的方差)
参考链接:Allan方差分析的使用要点
3、位置误差方程:
二、地磁场测量及误差方程
1、地磁场描述:
2、磁场坐标系/磁强计敏感轴坐标系
(1)磁场坐标系(OXYZm,简称m系):oym指向磁场方向;oxm在水平面内(此时,X轴指向不确定是哪里);ozm与前两者构成右手直角坐标系;如下所示:
因此,从导航坐标系(n系)到磁场坐标系的变换矩阵为:
实际中,计算磁场坐标系为m',则m系和m‘系的变换矩阵为:
(2)三轴磁强计敏感轴确定的直角坐标系为bm,其与IMU的b系并不完全一致;
3、磁场测量误差:
注意:在计算中,将磁场测量值进行归一化处理;磁测量误差的最后形式为:
三、低成本组合导航系统模型
IMU/GPS/磁力计组合导航系统中,选取状态量为:
姿态失准角、速度误差、位置误差、陀螺仪相关漂移、加速度计相关漂移、安装偏差角(磁力计与IMU安装偏差角)、磁力计倾角、磁力计偏角;一共20维状态量;
其中,系统状态空间模型为:
三、低成本惯导的姿态初始化
1、利用加速度计进行水平对准
静止条件下,速度为0;因此,其速度微分方程可写为:
其中为了减少加速度计测量噪声和外界晃动干扰加速度的影响,常采用一段时间内的平均比力进行计算:上式经过变换得:
分量形式为:
根据姿态矩阵求取欧拉角公式:
2、利用地磁测量进行方位对准
在忽略磁偏角的情况下,即磁方位角代替地理方位角;磁场坐标系为m系,由n系到m系的姿态矩阵为:
又因为,前面已经利用加速度计得到了姿态角(pitch、roll);
因此,三轴磁强计测量磁场为
利用Cnh和归一化地磁矢量在水平坐标系的投影,得到:
最需要注意的是hn的计算:
四、捷联式地平仪的工作原理
器件构成:陀螺仪和加速度计;
其中,利用陀螺仪的输出进行姿态更新(利用四元数);利用加速度计的比力输出和速度误差方程构建失准角模型;
注意点:
以上的应用前提是速度平稳或低加速度环境下;因此,如何判断载体当前的运动状态尤为重要;
参考链接:《捷联惯导算法与组合导航原理讲义》
捷联惯导基础知识解析之五(低成本姿态航向参考系统)相关推荐
- 捷联惯导基础知识解析之一(姿态表示方法基础知识)
1.定轴运动与非定轴运动 即转轴固定不动的转动:因此可得知,在捷联惯导应用中,X.Y.Z轴在空间中都存在转动,所以整个过程为非定轴运动. 2.不可交换性误差: 起因:在非定轴转动情况下, 描述姿态运动 ...
- 捷联惯导基础知识解析之四(粗/精对准和GPS/IMU和GPS/里程计组合导航)
初始对准(粗.精对准)/组合导航 一.捷联惯导粗对准 目的:寻找.确定参考导航坐标系:结果表现形式:得到姿态矩阵(进而可以求出欧拉角.四元数等) 前提:在导航坐标系(比如:东北天)下的重力矢量.地球旋 ...
- 捷联惯导基础知识解析之九万向节死锁/奇异点
背景知识 导航坐标系:东-北-天 载体坐标系:右-前-上 一.平衡环架 平衡环架(英语:Gimbal)为一具有枢纽的装置,使得一物体能以单一轴旋转.由彼此垂直的枢纽轴所组成的一组三只平衡环架,则可使架 ...
- 捷联惯导基础知识之一(姿态更新的毕卡算法、龙格库塔算法、及精确数值解法)
一.介绍旋转矢量以及由旋转矢量更新四元数 等效旋转矢量微分方程(Bortz方程): 经过理论和近似推导: 单位四元数与旋转矢量关系: 单位四元数与三角函数的关系: 四元数更新方程:利用旋转矢量,考虑了 ...
- 捷联惯导总结--初始对准,位置标定,INS姿态更新,GPS/INS组合
惯导及组合导航回顾 2018.09.16 今天和17系的同学一起把惯导的流程捋了一遍,为了加深自己的记忆,这里在前面把心得大致列出来. 我们这里只考虑捷联式惯导及松组合 首先拿到惯性传感器(加速度计 ...
- 基于matlab的捷联惯导算法设计及仿真,基于 Matlab 的捷联惯导算法设计及仿真1doc.doc...
基于 Matlab 的捷联惯导算法设计及仿真1doc 基于 Matlab 的捷联惯导算法设计及仿真1 严恭敏 西北工业大学航海学院,西安 (710072) E-mail:yangongmin@163. ...
- 惯导基础概念解析(一)初始对准及误差分析
因为感觉写的太好了,所以就转了! 详细可以参考原来的帖子:http://www.amobbs.com/thread-5492189-1-1.html ------------------------- ...
- 捷联惯导算法--体会与心得
本文转自:http://www.amobbs.com/thread-5492189-1-1.html,收藏学习! 1.四个概念:"地理"坐标系."机体"坐标系. ...
- 【算法学习笔记001】捷联惯导算法心得
1.四个概念:"地理"坐标系."机体"坐标系.他们之间换算公式.换算公式用的系数. 地理坐标系:东.北.天,以下简称地理.在这个坐标系里有重力永远是(0,0,1 ...
最新文章
- 计算机英语考试试题一附答案,计算机英语考试试题一附答案
- 解决 apache 2.4.1 无法解析shtml中的expr指令问题
- each 数据获取attr_调用高德POI数据,带你玩转长沙
- python自学平台-Python编程和人工智能平台学习
- LeetCode Gas Station(双指针 )
- CALL TRANSACTION 小节
- java程序中可以有几个构造方法_java中多个构造方法可以相互引用么?
- 百度百科中关于fwrite的用法说明
- python:浅析python 中__name__ = '__main__' 的作用(转载)
- 五个同事想计算他们的平均工资,但公司不让吐露薪资,如何实现?
- 重庆科技学院c语言程序设计报告,2020年重庆科技学院《911程序设计综合》硕士研究生招生复试大纲...
- python 托盘_[宜配屋]听图阁
- 简述SD卡的工作原理(四)
- 邮件发送JS脚本传播敲诈者木马的分析报告
- 外点惩罚函数法·约束优化问题
- 【备忘】尚学堂白贺翔java互联网架构师视频教程下载
- Flink 容错机制
- 《查拉图斯特拉如是说》读书笔记
- 中国最美滴100首古诗
- 推荐一款网络测试APP-网络百宝箱
热门文章
- Cadence Allegro如何输出贴片坐标文件?
- FDR土壤水分检测传感器设计方案
- windows10怎么安装c语言,如何在Win10安装Microsoft Visual C ++ 2015运行时
- while(Thread.activeCount() > 1)
- Windows平台优秀软件推荐(程序员推荐)
- ps cc 2018直装版系统要求
- RTK差分通讯链路---Ntrip DTU(支持千寻位置,CORS站、自建站)
- PLC实验七(装配流水线控制的模拟)
- plc实验报告流程图_中南大学plc实验报告(共6篇).docx
- Microsoft .NET Framework 各版可再发行组件包