基于单轴旋转的光纤陀螺捷联惯性导航系统粗对准方法技术方案

技术编号:3837707 阅读:237 留言:0更新日期:2012-04-11 18:40
本发明专利技术提供的是一种基于单轴旋转的光纤陀螺捷联惯性导航系统粗对准方法。(1)通过GPS确定载体的初始位置参数;(2)采集光纤陀螺仪和石英加速度计输出的数据并对数据进行处理;(3)根据坐标系的相互位置关系确定出导航坐标系和惯性坐标系的转换矩阵T↓[i]↑[n];(4)惯性测量单元单轴连续旋转,设定初始时刻IMU坐标系s与载体坐标系b重合,然后惯性测量单元绕载体坐标系方位轴oz↓[b]正向以角速度ω=6°/s连续转动;(5)确定惯性坐标系和基座惯性坐标系的相对位置关系;(6)利用步骤(3)、(4)、(5)计算出的各个坐标系的相对转换关系确定粗对准结束后捷联矩阵表达式。在有摇摆干扰条件下,采用本发明专利技术方法可以获得较高的粗对准精度。

【技术实现步骤摘要】

本专利技术涉及的是一种测量方法,尤其涉及的是一种基于单轴旋转的光纤陀螺 捷联惯性导航系统粗对准方法。(二)
技术介绍
捷联惯性导航系统是根据牛顿提出的相对惯性空间的力学定律,利用陀螺 仪、加速度计等惯性测量元件敏感载体的加速度,再根据给定的初始条件,通过 计算机进行积分运算得到各种导航参数,由于捷联系统没有平台框架及相连的伺 服机构,因而简化了硬件,与平台惯导相比具有体积小、重量轻、成本低、可靠 性比较高等优点,因此得到了越来越广泛的的应用,捷联惯导系统的导航精度在 很大程度上取决于系统初始对准的精度。粗对准过程是对准阶段的初始部分,它的主要功能是将惯性平台在短时间内 粗略地调到水平和指北的方位上,以便在此基础上进行精对准。目前主要的粗对 准方法有解析法、水平二阶调平+方位估算法和惯性系改进型粗对准法。其中 解析法对于在静基座条件的粗对准能够满足要求;但是如果载体处于摇摆过程中,这时陀螺仪测得的角速度已不是地球自转角速度,如果载体有垂荡、纵荡、 横荡或随机干扰比较大的时候,加速度计测量的也不是重力加速度,这时粗对准 的效果将会变差,所以解析法在实际应用中有很大的局限性。水平二阶调平+方 位估算法不仅适用于静基座粗对准,也适用于摇摆基座下的粗对准过程,而且具 有一定的抗干扰能力,但当载体存在垂荡、纵荡、横荡或高频随机干扰时,对准 性能就大大下降。惯性系改进粗对准方法对于静基座、摇摆基座和存在垂荡、纵 荡、横荡或高频随机干扰或者干扰是近似周期性干扰时都有很好的性能。旋转调制技术是惯性导航系统的一种自校正方法。它不需要引入外部校正信 息,能自动地对系统中惯性器件的常值偏差进行调制,达到自动抵消漂移对系统 精度的影响。因而可以提高惯性导航系统长时间工作的精度,充分发挥惯性导航 "自主式"的优点。应用旋转调制技术,还可以应用较低精度的惯性器件,构成 较高精度的惯性导航系统,有利于降低惯性导航系统的成本。
技术实现思路
本专利技术的目的在于提供一种能够有效地提高旋转捷联惯导系统的粗对准精 度的。本专利技术的技术解决方案为 一种基于单轴旋转的光纤陀螺捷联惯性导航系统 粗对准方法,其特征在于将惯性测量单元绕载体方位轴连续旋转,即对水平方向 上惯性器件的常值偏差进行调制,以此提高旋转捷联惯导系统在惯性系粗对准过 程中的精度,其具体步骤如下-(1) 通过GPS确定载体的初始位置参数,将它们装订至导航计算机中;(2) 捷联惯导系统进行预热准备,采集光纤陀螺仪和石英加速度计输出的 数据并对数据进行处理;(3) 根据坐标系的相互位置关系(如附图3)确定出导航坐标系和惯性坐标系的转换矩阵7T。其中,7;"为导航坐标系"和地球坐标系e间的变换矩阵,可由载体所在位置的经、纬度(Z、义)确定。1 0 0 0sin丄cos丄 0 —cos丄 sin丄sin /1cos义 0 一cos义 sin义 0 00 1一sin义 一sin丄cosA cos丄cos义cos义 0 一sin丄sin义 cos丄 cos〖sin义 sin丄7T为地球坐标系e和惯性坐标系/间的变换矩阵,由于地球的转动,可由时间间隔^=卜^确定-<formula>formula see original document page 7</formula>其中为地球自转角速度,根据坐标系的相对转换关系得到转换矩阵r.<formula>formula see original document page 7</formula>(4)惯性测量单元单轴连续旋转,设定初始时刻IMU坐标系s与载体坐标 系b重合,然后惯性测量单元绕载体坐标系方位轴os正向以角速度《 = 6'"连续转动(如附图2):imu转动过程中,imu坐标系到载体坐标系的转换矩阵为:cosW — sin^ 0 sin^y/ cos^ 0 0 0 1《《—、cos W —sin W少Vx sin W +cos W《将惯性测量单元旋转后光纤陀螺仪和石英加速度计生成的数据转换到载体坐标系下,得到惯性器件常值偏差的调制形式sx cos W —弓sin W & sin W + f少cos W利用四元数法对方向余弦矩阵微分方程力4。 =7^。进行更新,经过坐标 转换得到imu坐标系与基座惯性坐标系的转换矩阵r, =7;"rv6 。(5)确定惯性坐标系和基座惯性坐标系的相对位置关系 旋转捷联惯导系统中,由于载体的摇摆,加速度计输出中包含重力加速度,、摇摆引起的干扰加速度^^'、 imu旋转引起的向心加速度"'和加速度计零 位误差。尸=_g'、. + W + "v + V加速度计输出在载体坐标系上表示为在imu旋转角速度平稳的条件下,根据式上式的转换过程可知,加速度计零位误差和旋转引起的向心加速度被调制成周期变化的量,经过下式的积分环节后为零,所以基座惯性坐标系下的速度值表示为=一 f +〖 7;"('7;Wfifr=-"。f+〖令F^-fg'&, AFM-fr,。^rW/。由于^^近似为周期变化,经过一个 周期的积分后产生的速度误差近似为零。因此可以得到利用时刻(,。< & < 42)的速度值K(&) 、 K&2)构建辅助矢r(^)x「(^)、『(^)xr(^)]x^^)。其中采用的两个时间段要求分别大于载体的摇摆周期,以便进行完整周期的积分运算。根据姿态矩阵最优正交化的方法 构建矩阵正交矢量计算《,。"。&) x"" d=x w。(^卜x由以上三个关系式列出7;'求取方法7;'=x"。fe)了(6)利用步骤(3)、 (4)、 (5)计算出的各个坐标系的相对转换关系确定粗 对准结束后捷联矩阵表达式r; = n'' r,。根据上两式得到载体姿态角主值:<formula>formula see original document page 9</formula>航向角^定义域为((T,36(T),俯仰角6定义域为(-90°,90。),倾斜角y定义 域为(-180°,180°),得到载体姿态真值^;主 ^C2>0,^G±>0 = 4 Pg主+ 36()° > 0, Pg主< 0%主+180。^ =《广^主主;>0,主-18(T r』3〈0,y主〉0本专利技术与现有技术相比的优点在于本专利技术打破了在旋转捷联惯导系统中由 于IMU旋转而导致解析法不适用这一问题,利用惯性系对准适用于解决载体动 态环境下的对准问题这一特性,提出了在旋转捷联惯导系统中采用惯性系对准的 方法。由于惯性测量单元的单轴连续旋转可以将水平方向上的惯性器件常值偏差 进行调制,因此可以有效地提高旋转捷联惯导系统的粗对准精度。对本专利技术有益的效果说明如下在Matlab仿真条件下,对该方法进行仿真实验载体作三轴摇摆运动。载体以正弦规律绕纵摇轴、横摇轴和航向轴摇摆,其 数学模型为-其中^、 /、 ^分别表示纵摇角、横摇角和航向角的摇摆角度变量;《,、 L、 V^分别表示相应的摇摆角度幅值;%、 w,、,分别表示相应的摇摆角频 率;A、 A、《分别表示相应的初始相位;《,=2;r/7;, / = 9、 ;本文档来自技高网
...

【技术保护点】
一种基于单轴旋转的光纤陀螺捷联惯性导航系统粗对准方法,其特征在于包括以下步骤: (1)通过GPS确定载体的初始位置参数,将它们装订至导航计算机中; (2)捷联惯导系统进行预热准备,采集光纤陀螺仪和石英加速度计输出的数据并对数据进 行处理; (3)根据坐标系的相互位置关系确定出导航坐标系和惯性坐标系的转换矩阵Tin; (4)惯性测量单元单轴连续旋转,设定初始时刻IMU坐标系s与载体坐标系b重合,然后惯性测量单元绕载体坐标系方位轴oz↓[b]正向以角速度ω= 6°/s连续转动; (5)确定惯性坐标系和基座惯性坐标系的相对位置关系; (6)利用步骤(3)、(4)、(5)计算出的各个坐标系的相对转换关系确定粗对准结束后捷联矩阵表达式: T↓[s]↑[n]=T↓[i]↑[n]T↓[i ↓[b0]]↑[i]T↓[s]↑[i↓[b0]] 根据上两式得到载体姿态角主值: *** 航向角φ↓[G]定义域为(0°,360°),俯仰角θ定义域为(-90°,90°),倾斜角γ定义域为(-180°,180°),得到载体 姿态真值: *** θ=θ↓[主] ***。...

【技术特征摘要】

【专利技术属性】
技术研发人员:孙枫孙伟袁俊佳薛媛媛郭真孙巧英胡晓形李国强王琦
申请(专利权)人:哈尔滨工程大学
类型:发明
国别省市:93[中国|哈尔滨]

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1
相关领域技术
  • 暂无相关专利