本发明专利技术提供了一种GNSS/INS深耦合系统环路辅助切换方法，该方法可以在INS出现故障时完成对GNSS/INS深耦合系统载波跟踪环路辅助状态的切换，有效地实现GNSS/INS深耦合系统中INS对GNSS接收机载波跟踪环路辅助状态的切换，当INS出现故障时可以通过该方法对GNSS/INS深耦合系统环路辅助状态进行切换，避免INS故障所造成的深耦合系统的发散，有效地提高了深耦合系统的鲁棒性。
【技术实现步骤摘要】
本专利技术涉及卫星导航与通信领域，尤其是GNSS/INS组合导航。
技术介绍
近年来随着GNSS技术的发展以及INS传感器技术水平的进步，GNSS/INS组合导航 技术获得了长足的发展。GNSS/INS组合导航系统的数据融合算法已经得到了深入的研究。 而INS辅助的跟踪环路的深耦合导航技术的提出使得GNSS接收机可以适应更加复杂的外 部环境与动态性能。 GNSS/INS深耦合系统虽然可以提高两个系统各自的性能，但是随之而来的也提高 了系统出错的风险。当INS单元出现故障，尤其是当故障为渐变式时，会导致辅助后的GNSS 跟踪环路的失锁或误跟踪，GNSS跟踪环路的失锁与误跟踪会进而影响对INS的传递对准， 最终导致整个系统的发散，严重影响了 INS辅助的跟踪环路的深耦合系统的鲁棒性。在INS 故障的情况下若直接切断INS对GNSS接收机跟踪环路的辅助会导致接收机的失锁，因此应 该设计相应的GNSS/INS深耦合系统环路切换方法以实现GNSS/INS深耦合系统跟踪环路状 态的切换。
技术实现思路
为了克服现有技术的不足，本专利技术针对GNSS/INS深耦合系统环路跟踪状态切换 中存在的问题，设计了一种GNSS/INS深耦合系统环路辅助切换方法，该方法可以在INS出 现故障时完成对GNSS/INS深耦合系统载波跟踪环路辅助状态的切换，避免了由INS故障所 造成的深耦合系统发散的问题，提高了系统的整体性能。 本专利技术解决其技术问题所采用的技术方案是： 步骤1 :在组合导航接收机对卫星信号捕获完成后，GNSS/INS深耦合系统即转入 INS辅助下的深耦合环路跟踪状态，载波跟踪环路辅助量fAld如下： 其中Kswlteh为INS辅助开关量，在初始状态下设置为1，f INS为INS辅助下的载波频 率估计量，fro是根据INS输出的接收机动态信息，结合GNSS接收机解算的卫星动态信息而 计算出的卫星信号相对于接收机的多普勒频移，f Swlteh为切换频率，在初始状态下设置为卫 星信号的载波捕获频率，feal为环路累加锁存频率，在初始状态下设置为〇 ; 步骤2 :当INS系统出现故障，则将GNSS/INS深耦合系统环路辅助状态由辅助切 换为不辅助，为了避免直接断开载波跟踪环路辅助量f Ald所造成的GNSS信号失锁问题，载 波跟踪环路辅助量fAld仍然按照公式（1)计算，但其中环路累加锁存频率f eal以及INS辅助 开关量Kswlteh按照公式（2)、公式（3)进行计算： 其中，公式（2)中/&(^为状态更新前的前一个时刻的环路累加锁存频率； 步骤3 :当INS系统故障排除之后，将GNSS/INS深耦合系统环路辅助状态由不辅 助切换为辅助，载波跟踪环路辅助量fAld仍然按照公式（1)计算，但公式（1)中的切换频率 4_与INS辅助开关量K swlteh按照公式（4)、公式（5)进行计算： fSwltch= f C_Loop ⑷ Kswltch= 1 (5) 其中切换时刻载波的跟踪频率； 由此，GNSS/INS深耦合系统根据INS系统根据是否存在故障在步骤2与步骤3之 间进行切换，保证GNSS/INS深耦合系统可以对环路的辅助量进行控制。 本专利技术的有益效果是本专利技术所设计的GNSS/INS深耦合系统载波跟踪环路辅助的 切换方法，可以有效地实现GNSS/INS深耦合系统中INS对GNSS接收机载波跟踪环路辅助 状态的切换，当INS出现故障时可以通过该方法对GNSS/INS深耦合系统环路辅助状态进行 切换，避免INS故障所造成的深耦合系统的发散，有效地提高了深耦合系统的鲁棒性。【附图说明】 图1是本专利技术设计的模糊控制下的鲁邦深耦合跟踪方法方案图。 图2是本专利技术的流程图。【具体实施方式】 下面结合附图和实施例对本专利技术进一步说明。 本实施例的鲁棒深耦合跟踪方法的具体实施方案如图1所示，INS辅助下的载 波频率估计量f INS，经过辅助状态切换单元后得到载波跟踪环路辅助量fAid，将载波跟踪环 路辅助量匕3与环路滤波器的输出结果进行累加即完成了 GNSS/INS深耦合系统中INS对 GNSS接收机载波跟踪环路的辅助。 如图2本专利技术的切换方法的流程图所示，本专利技术的环路辅助切换方法的具体步骤 为： 步骤1 :在对卫星信号捕获完成后GNSS/INS深耦合系统即转入INS辅助下的深耦 合环路跟踪状态，载波跟踪环路辅助量fAld如下式所示。其中f INS为INS辅助下的载波频率 估计量，Kswlteh为INS辅助开关量，在初始状态下设置为l，f Swlteh为切换频率，在初始状态下 设置为卫星信号的载波捕获频率，feal为环路累加锁存频率，在初始状态下设置为0。 步骤2 :若INS系统出现故障，则应将GNSS/INS深耦合系统环路辅助状态由辅助 切换为不辅助，为了避免直接断开载波跟踪环路辅助量fAld所造成的时所问题，此时仍然保 持对载波跟踪环路辅助量f Ald按照公式（1)计算，但对频率累加锁存量feal以及INS辅助开 关量Kswlteh按照公式（2)、公式（3)所示进行更新，公式（2)中/ffi (i )为状态更新前的前一 个时刻的环路累加锁存频率： Kswltch= 0 (3) 步骤3 :当INS故障排除之后，则应将GNSS/INS深耦合系统环路辅助状态由不辅 助切换为辅助，此时仍然保持对载波跟踪环路辅助量f Ald按照公式（1)计算，但应对切换频 率fSwltoh与INS辅助开关量K Swlteh按照公式（4)、公式（5)所示进行更新： 其中fc>p为切换时刻载波的跟踪频率，之后根据INS是否存在故障在步骤2与步 骤3之间进行切换即可。【主权项】1. 一种GNSS/INS深耦合系统环路辅助切换方法，其特征在于包括下述步骤： 步骤1 :在组合导航接收机对卫星信号捕获完成后，GNSS/INS深耦合系统即转入INS辅 助下的深耦合环路跟踪状态，载波跟踪环路辅助量fAld如下： 【AidKSwitch(fINS【Switch)+fcal (1) 其中KSwlteh为INS辅助开关量，在初始状态下设置为1，fINS为INS辅助下的载波频率估 计量，fINii是根据INS输出的接收机动态信息，结合GNSS接收机解算的卫星动态信息而计算 出的卫星信号相对于接收机的多普勒频移，fSwlteh为切换频率，在初始状态下设置为卫星信 号的载波捕获频率，feal为环路累加锁存频率，在初始状态下设置为〇 ; 步骤2 :当INS系统出现故障，则将GNSS/INS深耦合系统环路辅助状态由辅助切换为 不辅助，为了避免直接断开载波跟踪环路辅助量fAldK造成的GNSS信号失锁问题，载波跟 踪环路辅助量fAld仍然按照公式（1)计算，但其中环路累加锁存频率feal以及INS辅助开关 ..桉昭/A忒徘籽彳+曾.其中，公式（2)中状态更新前的前一个时刻的环路累加锁存频率； 步骤3 :当INS系统故障排除之后，将GNSS/INS深耦合系统环路辅助状态由不辅助切 换为辅助，载波跟踪环路辅助量fAld仍然按照公式（1)计算，但公式（1)中的切换频率fSwlteh 与INS辅助开关量KSwlteh按照公式（4)、公式（5)进行计算：本文档来自技高网...
【技术保护点】
一种GNSS/INS深耦合系统环路辅助切换方法，其特征在于包括下述步骤：步骤1：在组合导航接收机对卫星信号捕获完成后，GNSS/INS深耦合系统即转入INS辅助下的深耦合环路跟踪状态，载波跟踪环路辅助量fAid如下：fAid＝KSwitch·(fINS‑fSwitch)+fCal (1)其中KSwitch为INS辅助开关量，在初始状态下设置为1，fINS为INS辅助下的载波频率估计量，fINS是根据INS输出的接收机动态信息，结合GNSS接收机解算的卫星动态信息而计算出的卫星信号相对于接收机的多普勒频移，fSwitch为切换频率，在初始状态下设置为卫星信号的载波捕获频率，fCal为环路累加锁存频率，在初始状态下设置为0；步骤2：当INS系统出现故障，则将GNSS/INS深耦合系统环路辅助状态由辅助切换为不辅助，为了避免直接断开载波跟踪环路辅助量fAid所造成的GNSS信号失锁问题，载波跟踪环路辅助量fAid仍然按照公式(1)计算，但其中环路累加锁存频率fCal以及INS辅助开关量KSwitch按照公式(2)、公式(3)进行计算：fCal=fCal(t-1)+fINS-fSwitch---(2)]]>KSwitch＝0 (3)其中，公式(2)中为状态更新前的前一个时刻的环路累加锁存频率；步骤3：当INS系统故障排除之后，将GNSS/INS深耦合系统环路辅助状态由不辅助切换为辅助，载波跟踪环路辅助量fAid仍然按照公式(1)计算，但公式(1)中的切换频率fSwitch与INS辅助开关量KSwitch按照公式(4)、公式(5)进行计算：fSwitch＝fC_Loop (4)KSwitch＝1 (5)其中fC_Loop为切换时刻载波的跟踪频率；由此，GNSS/INS深耦合系统根据INS系统根据是否存在故障在步骤2与步骤3之间进行切换，保证GNSS/INS深耦合系统可以对环路的辅助量进行控制。...
【技术特征摘要】
【专利技术属性】
技术研发人员：徐昊伟，廉保旺，何伟，廉杰，唐成凯，王嘉宁，杨琼，
申请(专利权)人：西北工业大学，
类型：发明
国别省市：陕西;61
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。