一种基于改进的ICCP算法的重力匹配辅助惯性导航方法技术

本发明专利技术公开了一种基于改进的ICCP算法的重力匹配辅助惯性导航方法。使用本发明专利技术能够有效地提高重力辅助惯性导航系统的精度和实时性，从而减小惯导系统随时间积累误差及在惯导系统存在大误差条件下重力匹配失效的缺陷。本发明专利技术对匹配算法模块中的ICCP算法进行改进，用采样单个点数据代替序列采样的方法，将单个点数据替换序列数据中的首位数据，形成新的序列，从而缩短数据采样时间，提高匹配效率。

【技术实现步骤摘要】
【专利摘要】本专利技术公开了一种基于改进的ICCP算法的重力匹配辅助惯性导航方法。使用本专利技术能够有效地提高重力辅助惯性导航系统的精度和实时性，从而减小惯导系统随时间积累误差及在惯导系统存在大误差条件下重力匹配失效的缺陷。本专利技术对匹配算法模块中的ICCP算法进行改进，用采样单个点数据代替序列采样的方法，将单个点数据替换序列数据中的首位数据，形成新的序列，从而缩短数据采样时间，提高匹配效率。【专利说明】—种基于改进的ICCP算法的重力匹配辅助惯性导航方法
本专利技术涉及惯性导航
，具体涉及一种基于改进的ICCP算法的重力匹配辅助惯性导航方法。
技术介绍
惯性导航系统具有无源性和自主性，因此水下航行器一般采用以惯性导航为核心的导航系统，以实现水下自主隐蔽导航。但惯性导航系统存在误差随时间积累而发散的缺陷，如果不定期修正，就无法保证其水下航行器长航时及高精度两个要求，因此必须要通过其他导航方式实时或定时修正惯性导航系统来抑制导航系统位置误差的增长，提高长航时导航精度。目前辅助惯导系统常采用的无源方法是天文导航、地磁匹配及地形匹配等技术。近年来，借助地形匹配的技术成果，重力/惯性、地磁/惯性、GPS/惯性等组合导航的理论方法也相继成为了国内外研究和开放的重点。重力匹配辅助惯性导航系统目前获得各国的广泛关注。地球重力场的变化是地球固有的物理信息，稳定性较好，重力数据的获得是一个无源的过程，最大程度保证了潜器导航的隐蔽性和自主性。将重力信息引入惯导系统，通过与惯导系统组合修正，可以形成自主、高精度、高隐蔽性、抗干扰能力强的组合导航系统。重力匹配的核心是算法，经典的方法是地形轮廓匹配方法(TERC0M)、桑迪亚惯性地形辅助导航方法(SITAN)和基于等值线的最近点迭代方法(ICCP)。ICCP算法是近年来使用较多的一类匹配算法，最初它是用于图像配准中，Behzad首次将其引入到水下辅助导航,并给出了具体的实现形式，Bishop则通过仿真试验系统地验证了该算法的可行性及各种误差影响。ICCP算法是ICP算法以等值线为匹配单元的特例，它原理简单，易于实现。ICCP算法不需要进行事先估计分析，只需对实测点值不断重复迭代，以求得最佳航迹。主要问题涉及等值线提取、最近点的求解和坐标值转换计算。ICCP算法是针对序列数据进行的运算，在使用前，需采样出足够的惯导指示航迹点和重力测量值。地球重力场在小范围内变化并不明显，因此航行器需要大范围搜索采样点才能满足算法需要特别变化明显的重力值的要求。潜器在水下航行速度较慢，导致算法在取采样点和重力值的环节上耗费大量时间。而此期间惯导误差继续随时间积累，如若再进行匹配，势必造成一次完整的重力匹配修正惯导耗时长、精度低，相邻匹配相隔时间也过长，不能达到最佳匹配的效果。如果将采样时间缩短，可以提高匹配精度，充分达到修正惯性导航的目的。
技术实现思路
有鉴于此，本专利技术提供了一种基于改进的ICCP算法的重力匹配辅助惯性导航方法，能够有效地提高重力辅助惯性导航系统的精度和实时性，从而减小惯导系统随时间积累误差及在惯导系统存在大误差条件下重力匹配失效的缺陷。本专利技术的基于改进的ICCP算法的重力匹配辅助惯性导航方法中，匹配算法模块将重力仪器实测得的重力值与预存重力基准图中读取的重力值进行改进的ICCP算法匹配，得到接近真实轨迹的匹配轨迹，将匹配轨迹反馈给惯性导航系统进行轨迹修正，其中，改进的ICCP算法包括如下步骤:步骤一，匹配算法模块利用重力仪器采集的η个航迹点作为初始序列PJp1,P2,…，PnI，进行第一次匹配，第一次匹配时采用的刚性变换记为T1,得到航迹M1 K1,m2;1，mn；1}；步骤二,采集新的航迹点pn+1,对pn+1进行T1变换得到IVu,将mn+i，i代入航迹M1中，替换航迹点,形成航迹P2Imiu, m3；1,..., mn；1, ,将P2作为初始序列进行第二次匹配，第二次匹配时采用的刚性变换记为1~2，得到航迹M2{m2，2，m3，2，…，mn+1，2}；步骤三，采集新的航迹点pn+2，对pn+2先进行T1变换后再进行T2变换，得到mn+2，2，将％+2，2代入航迹仏中，替换航迹点m2，2,形成航迹P3{m3，2, m4；2,..., mn+2，2},将航迹P3作为第三次匹配的初始航迹进行第三次匹配，第三次匹配时采用的刚性变换记为T3,得到航迹M3lm3’3, m4’3，…，mn+2’3}；步骤四，按照以上做法，采集新的航迹点pn+i，对pn+i进行T1, T2,…，Ti变换，得到mn+i； i，将mn+i，i代入航迹Mi中，替换航迹点^，形成航迹Pi+1 {m i+1；i,m i+2；i；...,mn+i； J，将航迹Pi+1作为第i+1次匹配的初始航迹进行第i+Ι次匹配，第i+Ι次匹配时采用的刚性变换;己为 T i+i，丫守至丨M j+i {ill i+i’i+ι, Π i+2, i+1,...， Π i+n, i+ll ;步骤五， 不断重复上述采样、迭代步骤，得到的结果为匹配算法求解出的最佳匹配航迹。有益效果:修改后的ICCP算法相对于传统的ICCP算法在计算上更具有连贯性，这就使得匹配误差相对减少，匹配轨迹精确度相对提高。由于只有第一次采样是序列值，之后的采样都是单个点值，这就满足了实时测量的要求，大大减少匹配算法前采样数据的消耗时间，提高了匹配效率和精度，对测量系统的修正也更精确。【专利附图】【附图说明】图1为重力匹配辅助惯导原理图。图2为ICCP算法示意图。图3为ICCP算法流程图。图4为初始序列采样匹配示意图。图5为单点采样二次匹配示意图。图6为单点采样第三次匹配示意图。图7为传统ICCP算法采样匹配示意图。图8为改进的ICCP算法采样匹配示意图。【具体实施方式】下面结合附图并举实施例，对本专利技术进行详细描述。本专利技术提供了一种基于改进的ICCP算法的重力匹配辅助惯性导航方法，对传统的ICCP算法进行改进。如图1所示，传统的重力辅助惯性导航系统一般主要分成惯性导航系统、预存重力基准图、基于动基座的实测重力参数系统和匹配算法四个模块。惯导系统模块的主要目的是对航行器在航行过程中进行自主隐蔽的导航定位；预存重力图模块的主要目的是利用惯导系统指示出的位置在重力图上找到重力值，作为匹配值；实测重力系统模块的主要目的是实时测量航行器所在位置的重力、水深等信息，利用重力值画出等值线，并找出惯导指示位置对应的最近等值线；匹配算法模块的主要目的是将实测重力值与预存重力图上读取的重力值利用ICCP算法匹配，使得匹配后得到的轨迹值最接近真实轨迹值。本专利技术主要是针对匹配算法模块中ICCP算法的改进问题，以提高重力辅助惯性导航系统的可靠性和实时性。传统ICCP算法中，匹配数据为序列值，因此在每次匹配之前需要采样固定数目的序列数据之后才能进行匹配计算，由于惯导误差随时间积累，因此长时间序列值采样会导致匹配后的结果误差较大。本专利技术提出了用采样单个点数据代替序列采样的方法，将单个点数据替换序列数据中的首位数据，形成新的序列，从而缩短数据采样时间，提高匹配效率。即在跟踪模式下，与目标对象同步，实时追踪以获取一组采样序列值，作为初始匹配序列进行匹配；第二次待匹配值采样时只取单个采本文档来自技高网...

【技术保护点】
一种基于改进的ICCP算法的重力匹配辅助惯性导航方法，其特征在于，匹配算法模块将重力仪器实测得的重力值与预存重力基准图中读取的重力值进行改进的ICCP算法匹配，得到接近真实轨迹的匹配轨迹，将匹配轨迹反馈给惯性导航系统进行轨迹修正，其中，改进的ICCP算法包括如下步骤：步骤一，匹配算法模块利用重力仪器采集的n个航迹点作为初始序列P1{p1，p2，…，pn}，进行第一次匹配，第一次匹配时采用的刚性变换记为T1，得到航迹M1{m1,1，m2,1，…，mn,1}；步骤二，采集新的航迹点pn+1，对pn+1进行T1变换得到mn+1,1，将mn+1,1代入航迹M1中，替换航迹点m1,1，形成航迹P2{m2,1，m3,1，…，mn,1，mn+1,1}，将P2作为初始序列进行第二次匹配，第二次匹配时采用的刚性变换记为T2，得到航迹M2{m2,2，m3,2，…，mn+1,2}；步骤三，采集新的航迹点pn+2，对pn+2先进行T1变换后再进行T2变换，得到mn+2,2，将mn+2,2代入航迹M2中，替换航迹点m2,2，形成航迹P3{m3,2，m4,2，…，mn+2,2}，将航迹P3作为第三次匹配的初始航迹进行第三次匹配，第三次匹配时采用的刚性变换记为T3，得到航迹M3{m3,3，m4,3，…，mn+2,3}；步骤四，按照以上做法，采集新的航迹点pn+i，对pn+i进行T1,T2,…,Ti变换，得到mn+i,i，将mn+i,i代入航迹Mi中，替换航迹点mi,i，形成航迹Pi+1{m i+1,i，m i+2,i，…，mn+i,i}，将航迹Pi+1作为第i+1次匹配的初始航迹进行第i+1次匹配，第i+1次匹配时采用的刚性变换记为T i+1，得到航迹M i+1{m i+1,i+1，m i+2,i+1，…，m i+n,i+1}；步骤五，不断重复上述采样、迭代步骤，得到的结果为匹配算法求解出的最佳匹配航迹。...

【技术特征摘要】

【专利技术属性】
技术研发人员：付梦印，王博，邓志红，刘美琪，肖烜，
申请(专利权)人：北京理工大学，
类型：发明
国别省市：北京;11