一种基于角速率输出的捷联系统速度解算方法

文档序号:6098298阅读:371来源:国知局
专利名称:一种基于角速率输出的捷联系统速度解算方法
技术领域
本发明涉及一种捷联系统速度解算方法,尤其是针对基于角速率输出的捷联系统速度解算方法。
背景技术
捷联系统是将陀螺仪和加速度计安装于载体的一种惯性导航系统,它通过计算 “数学平台”来模拟平台式惯导系统中的实际平台,因而造价大大降低,但是捷联系统对导航解算的要求却大大提高。过去,研究者们以陀螺仪输出为角度信号作为前提,提出了传统的基于增量输出信号的速度解算方法。近年来,随着光纤通讯技术和光纤传感技术的发展, 光纤陀螺仪成为惯性导航的重要技术,对于由光纤陀螺(如干涉型)构成的捷联系统,陀螺仪输出为角速率信号,传统的基于增量输出信号的捷联系统速度解算方法应用于光纤陀螺捷联系统时,需要通过角速率提取角增量,进而利用传统方法实现速度解算,这样既增加了系统软件设计难度,同时在解算精度上也有较大损失。

发明内容
为了克服传统速度解算方法在光纤陀螺捷联系统应用中的不足,本发明提出一种基于角速率输出的捷联系统速度解算方法,直接利用陀螺仪输出的角速率信号进行计算, 提高解算精度,减小计算复杂度。一种基于角速率输出的捷联系统速度解算方法,具体为载体在tm时刻的速度 Vm = vm_, + Γ [洲-(2 (0 + COm(0)XVm^l]dt +AVsfm,其中,Vnrl为载体在t^时刻的速度,Cnrl为载体在I1时刻的姿态矩阵,g(t)、(t)、ωεηα)分别为t时刻的重力加速度、地球自转角速度、导航系相对地球系的转动角速度;AVsfm = AVm +Uem X AVm+AVsculm ;AVm = Γ f(t)dt, f(t)为加速度计在t时刻的输出比力;
;tUi-IΑθη = Γ o(t)dt,ω (t)为陀螺在t时刻的输出角速率;
;tUi-I划桨效应补偿项的η子样求解过程如下(al)过η个采样点将速度解算周期T = t^t^均分成间隔为ΔΓ = 的η个
子时段,以;,, (, ( 标函数对这η个采样点处陀螺
f(t) = A1+2A2(t-tm_1) + - + nAn(t-tm_1)
仪的角速率输出和加速度计的比力输出作多项式线性拟合;
(a2)利用步骤(al)拟和确定的常矢量 …an,、…An计算
权利要求
1.一种基于角速率输出的捷联系统速度解算方法,具体为载体在tm时刻的速度
2.根据权利要求1所述的基于角速率输出的捷联系统速度解算方法,其特征在于, 的η子样求解过程还包括步骤(a4)利用步骤(M)的划桨效应补偿项计算公式计算划桨运动条件下划桨效应补偿项的精确值(a5)确定步骤(M)的划桨效应补偿项计算公式中的直流量
全文摘要
本发明提出一种基于角速率输出的捷联系统速度解算方法,该方法根据速度的划桨补偿算法原理,通过拟合载体角速度和比力函数,推导了基于角速率、比力以及测量带宽的划桨补偿算法,并在经典划桨运动条件下,通过使划桨补偿量中的直流量与真实值差值最小来确定划桨补偿算法的优化系数,从而得到划桨补偿的优化算法,实现了速度的高精度解算。
文档编号G01C21/18GK102288177SQ20111019906
公开日2011年12月21日 申请日期2011年7月14日 优先权日2011年7月14日
发明者张静远, 李恒, 罗轩, 谌剑 申请人:中国人民解放军海军工程大学
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1