捷联惯导更新算法及误差分析汇总
一、捷联惯导数值更新算法
导航坐标系:东-北-天
载体坐标系:右-前-上
1、姿态更新算法:
<1>姿态更新微分方程:
,表示导航系相对于惯性系的旋转;包括两部分:
(1)地球自转引起的导航系旋转;
(2)系统在地球表面附近移动因地球表面弯曲引起的导航系旋转;
根据矩阵链式乘法得:
又由于:
姿态微分方程:
<2>姿态更新方程:
对于,通过陀螺仪的积分可到,利用双子样圆锥补偿算法:
对于,认为短时间内速度和位置引起的变化很小,将将视为常值,则有:
注:此时的计算,取转置;
2、速度更新算法:
<1>速度更新微分方程:
为加速度计测量的比力;
为由载体运动和地球自转引起的哥式加速度;
为由载体运动引起的对地向心加速度;
为重力加速度;
统称为有害加速度;
<2>速度更新算法:
将微分方程,添加时间参数:
即:
和分别称为时间段内导航系比力速度增量和有害加速度的速度增量;
(1)
其中有害加速度的速度增量表达式,变化很小,直接采用中间时刻的值代替进行计算:,其中需要外推的量为:
(2)
采用矩阵链式乘法分解(与姿态更新算法一致)
即:
中间量为:
3、位置更新算法:
<1>位置微分方程:
<2>位置更新方程:
相关中间量为:
二、捷联惯导误差方程:
1、非直角坐标系到直角坐标系:
非直角坐标系α系:
直角坐标系b系:
从α系到b系到坐标变换矩阵为:
易知的列向量为单位矢量,但行向量一般不是单位矢量,在矩阵中仅有6个独立元素;
近似如下:
对上述的进行正交三角分解(QR分解):分解为单位正交阵 和上三角阵乘积的形式:
<1> 看作是从b系(直角坐标系)到另一右手直角坐标系(B系)的变换矩阵,(失准角)
若记从b系到B系的失准角(等效旋转矢量)为μ:
<2>上三角阵表示从非直角坐标系(a系)至直角坐标系(B系)的坐标变换矩阵:(偏差角/不正交误差角)
假设:α系的轴与B系的轴重合;α系的轴在B系的平面内,且单位矢量的端点在和轴上的投影分别记为和,α系的单位矢量的端点在、、轴上的投影分别记为:、、。
简化,如下:
式中,φ表示矢量,构成的上三角阵,即:
最终如下:分别为 失准角和不正交角
注:失准角:两个直角坐标系之间的旋转小角度;
不正交角:从非直角坐标系到直角坐标系旋转小角度;
2、惯性传感器测量误差:
以三轴陀螺仪为例,陀螺仪输出的是某一个非直角坐标系(记为系);
其中,是从非直角坐标系()到直角坐标系b系的坐标变换矩阵;
3、姿态误差方程;
<1> 理想导航坐标系
为:从导航坐标系(n系)到载体坐标系(b系)的捷联惯导姿态矩阵;
<2> 计算导航坐标系
为:导航计算机解算给出的姿态矩阵;简记:系;
因此,与之间的偏差在于系与系之间的偏差。
根据矩阵链乘规则:
以系为参考坐标系,从到系的等效旋转矢量为Φnn',常称其为失准角误差。
转置后:
则n‘系下为:
--%%-- --%%-- --%%-- --%%-- --%%-- --%%-- --%%-- --%%-- --%%-- --%%-- --%%-- --%%-- --
推导姿态误差方程:
理想下,姿态矩阵微分方程:
实际下,姿态矩阵微分方程:
其中,陀螺仪测量误差、导航系计算误差,都包含在以下中:
最终姿态误差微分方程为:
反映了计算导航系(系)相对于理想导航系(系)的失准角变化规律。
4、速度误差方程:
速度误差是指惯导系统导航计算机中的计算速度与理想速度之间的偏差;通过速度误差微分方程描述:
速度误差:
两边求微分:
其中,速度微分方程为:
中间量:
最终,速度误差微分方程为:
5、位置误差方程:
其中,Rm、Rn在短时间内变化很小,视为常值:
三、静基座误差特性分析:
静止基座下,惯导真实速度为0,真实位置已知;比力在导航坐标系的投影为[0 0 g]
将Rmh、Rnh近似为地球平均半径R;
1、高度通道
高度误差微分方程和天向速度误差微分方程:
高度误差会随时间不断发散,因此,纯惯导系统的高度通道是不稳定的;
2、水平通道误差微分方程:
经度误差δλ的传播是一个独立过程,仅收东向速度误差δVe的一次积分,不受其他误差影响;
修拉角频率:
傅科角频率: ,即为地球自转的天向分量;
如果取g=9.8,R=6371km;
可得到休拉周期;
傅科周期:在地区极点处最短为24小时,随纬度较小,周期变长,傅科周期在赤道上消失;因此,总有
3、水平通道简化
<1>单纯的失准角误差通道:
假设:水平两个速度误差为0,纬度误差为0;
单纯的姿态误差方程式为:
可视为:固定地理位置下的姿态跟踪误差方程;系统的特征方程为:
可得:单纯的失准角回路的震荡频率为地球自转频率,周期24Hour。
<2>水平东向/北向通道
<3>水平北向及方位通道
捷联惯导更新算法及误差分析汇总相关推荐
- 028捷联惯导更新算法备忘
1.姿态更新 对于nnn及bbb系,假定有如下四元数转换关系: 那么: rn(k+1)=Cb(k+1)n(k+1)rb(k+1)=Cn(k)n(k+1)Cn(k)b(k)Cb(k)n(k)Cb ...
- 组合导航算法(一)之捷联惯导更新及组合模式
捷联惯导基本算法 惯性导航技术于20世纪50年代最初开始投入使用,可分为物理平台与模拟平台.物理平台就是平台式惯性导航系统(PINS).模拟平台又称捷联式惯性导航系统(SINS),它以计算机为平台,随 ...
- 基于matlab的捷联惯导算法设计及仿真,基于 Matlab 的捷联惯导算法设计及仿真1doc.doc...
基于 Matlab 的捷联惯导算法设计及仿真1doc 基于 Matlab 的捷联惯导算法设计及仿真1 严恭敏 西北工业大学航海学院,西安 (710072) E-mail:yangongmin@163. ...
- 捷联惯导基础知识解析之五(低成本姿态航向参考系统)
陀螺仪精度0.1°/s:加速度计精度5mg:主要指零偏重复性! 一.简化的惯导算法 1.姿态更新 陀螺仪输出直接进行积分,得到角增量: 2.速度更新: 在导航系下,完整的速度微分方程,如下: 其中,在 ...
- 基于四元素法的捷联惯导姿态更新算法
摘要 本文主要介绍了机载捷联惯导系统常用的姿态更新算法--四元素法,并重点介绍了利用四元素法进行姿态更新的一般过程. 关键词:四元素法,连贯导,姿态 1 引言 ...
- 捷联惯导系统学习4.1(惯导数值更新算法)
1 常用坐标系的定义 (1)地心惯性坐标系(i 系,inertial frame) 用oixiyizio_ix_iy_iz_ioixiyizi表示,原点以地球为中心, 原点oio_ioi在地 ...
- 捷联惯导算法(二)位置更新算法的理解
前言 文中算法公式摘自<捷联惯导算法与组合导航原理>(严恭敏.翁浚 编著).<惯性导航>(秦永元 编著),其他理解仅代表个人观点.本文是对位置更新算法,按照自己学习的思路整理得 ...
- 捷联惯导算法--体会与心得
本文转自:http://www.amobbs.com/thread-5492189-1-1.html,收藏学习! 1.四个概念:"地理"坐标系."机体"坐标系. ...
- 【算法学习笔记001】捷联惯导算法心得
1.四个概念:"地理"坐标系."机体"坐标系.他们之间换算公式.换算公式用的系数. 地理坐标系:东.北.天,以下简称地理.在这个坐标系里有重力永远是(0,0,1 ...
- 捷联惯导总结--初始对准,位置标定,INS姿态更新,GPS/INS组合
惯导及组合导航回顾 2018.09.16 今天和17系的同学一起把惯导的流程捋了一遍,为了加深自己的记忆,这里在前面把心得大致列出来. 我们这里只考虑捷联式惯导及松组合 首先拿到惯性传感器(加速度计 ...
最新文章
- Gut:人体最初的微生物起源与生殖健康
- Android SimpleAdapter显示ListView、GridView
- linux使用freetds 连接连远程服务器sqlservser2012
- Tableau实战系列浏览 Tableau 环境(三) -在“数据”窗格的数据源中导航
- 《妥协的完美主义:优秀产品经理的实践指南(卷二)》一1.2 交互设计不是横空出世...
- 计算机求职意向范文,自我评价与求职意向范文3篇
- 如何通过c语言获取ipv6邻居表,急求在vc++6.0中获取IPV6地址的方法,高手请进,谢谢!!...
- 第十八节20181216
- C#医疗挂号系统试题
- sql truncate_如何在SQL Delete和SQL Truncate语句后使用数据库备份恢复数据
- C#中网络编程异步操作方法与 粘包和分包问题
- paip.asp vbs通过CLI命令行调用PHP代码
- [转载] 实现宿主机和VirtualBox下虚拟机ping相通教程
- MongodB数据库安装教程
- 关于QComboBox
- 小程序长按图片识别二维码
- 计算机死机代码怎么写,如何用代码让电脑死机
- SPRD Camera sensor
- 明辰智航网络一点通网络性能测试仪可以做什么
- 祝愿大家未来顺利平安