[发明专利]捷联惯性导航系统与天文导航系统实现组合导航的方法无效
申请号: | 201010152226.5 | 申请日: | 2010-04-20 |
公开(公告)号: | CN101825467A | 公开(公告)日: | 2010-09-08 |
发明(设计)人: | 郁丰;熊智;何真;刘建业;韩龄;华冰;屈蔷;王丹;陈海明 | 申请(专利权)人: | 南京航空航天大学 |
主分类号: | G01C21/16 | 分类号: | G01C21/16;G01C21/02;G01C21/20 |
代理公司: | 南京经纬专利商标代理有限公司 32200 | 代理人: | 许方 |
地址: | 210016*** | 国省代码: | 江苏;32 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | 本发明公布了一种捷联惯性导航系统与天文导航系统实现组合导航的方法,属于组合导航领域。本发明采用SINS有误差的“数学平台”作为CNS的水平基准,并根据耦合SINS姿态误差天文定位原理构建了深组合数学模型。本发明包括如下步骤:第一步:建立基于SINS数学平台的天文导航定位模型,第二步:建立SINS和CNS组合系统模型,第三步:所建立的组合导航系统状态方程和量测方程进行离散化处理,采用卡尔曼滤波器对惯性导航误差进行最优估计和修正。惯性/天文组合导航系统具有极好的自主性和抗干扰能力,采用本专利的方法,飞行器上可不安装专门的水平基准,有望简化机载条件下的SINS/CNS组合导航系统的设计。 | ||
搜索关键词: | 惯性 导航系统 天文 实现 组合 导航 方法 | ||
【主权项】:
1.一种捷联惯性导航系统与天文导航系统实现组合导航的方法,其特征在于包括如下步骤:第一步:建立基于SINS数学平台的天文导航定位模型1)建立天文定位模型采用地球固联坐标系OXYZ为参考系建立天文定位模型:
式(1)中δA,ω分别代表恒星的赤纬、地方时角,其中地方时角ω为恒星的格林时角tGA即0°经线处的地方时角与飞行器所在位置经度λ的和,h为星敏感器观测得到恒星的高度角值,λ、
分别为在地固坐标系中的经度、纬度即飞行器所在的经度、纬度;2)建立考虑SINS数学平台误差的天文测量模型SINS导航坐标系转换到SINS平台坐标系的姿态转换矩阵为:C ≈ 1 φ u - φ n - φ u 1 φ e φ n - φ e 1 - - - ( 2 ) ]]> 式(2)中,φu、φn和φe分别为数学平台的航向角误差、滚动角误差和俯仰角误差;式(1)所述的天文定位模型在考虑耦合SINS数学平台角误差的情况下表示成:
式(3)中,平台坐标系中的恒星方向矢量表示为[x y z]T,x、y、z分别为该方向矢量的三个分量;第二步:建立SINS和CNS组合系统模型a)建立SINS和CNS组合导航系统的状态模型采用线性卡尔曼滤波器进行组合,系统的状态方程为SINS的误差方程,导航坐标系选为东北天地理坐标系,获得捷联惯导系统的误差方程即组合导航系统的状态模型为
其中系统状态变量定义为:X = [ φ e , φ n , φ u , δ υ e , δ υ n , δ υ u , δL , δλ , δh , ϵ bx , ϵ by , ϵ bz , ϵ rx , ϵ ry , ϵ rz , ▿ x , ▿ y , ▿ z ] - - - ( 4 ) ]]> 其中,F(t)为状态系数矩阵,G(t)为噪声系数矩阵,W(t)为系统动态噪声;φe,φn,φu为平台误差角;δυe,δυn,δυu为速度误差;δL,δλ,δh为纬度、经度和高度误差;εbx,εby,εbz,εrx,εry,εrz分别为陀螺常值漂移误差和一阶马尔可夫漂移误差;![]()
为加速度计零偏;b)建立SINS和CNS组合导航系统的测量模型将式(3)在线性卡尔曼滤波器一步时间更新预测点上线性展开可表示为
其中,![]()
![]()
![]()
dz = z - z ^ ; ]]> dφe为数学平台俯仰角误差的待估小量;dφn为数学平台滚动角误差的待估小量;
为导航系统经度的一步时间更新值;
为导航系统纬度的一步时间更新值;
为导航系统数学平台俯仰角误差的一步时间更新值;
为导航系统数学平台滚动角误差的一步时间更新值;测量噪声仅考虑高度角的测量误差,具体有:sin(hc)=sin(hr+hε)=sinhrcoshε+coshrsinhε ≈sinhr+coshr·hε (6) ≈sinhr+coshc·hε其中,hc为恒星高度角的测量值,hr为恒星高度角的真实值,hε为恒星高度角的测量噪声;第三步:对式(4)、(5)和式(6)所建立的组合导航系统状态方程和量测方程进行离散化处理后,利用线性卡尔曼滤波器对惯性导航误差进行最优估计和修正。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于南京航空航天大学,未经南京航空航天大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201010152226.5/,转载请声明来源钻瓜专利网。