一种gps双卫星故障的raim方法
【专利摘要】一种GPS双卫星故障的RAIM方法，包括如下步骤：第一步，建立粒子滤波用于接收机自主完好性监测的故障检测与隔离的系统模型；第二步，计算各状态累加对数似然比；第三步，使用基于层次滤波和粒子滤波算法的接收机自主完好性监测方法实现对双故障卫星的检测和隔离。本发明的优点在于：1、本方法能有效地实现双卫星故障情况下的接收机自主完好性监测，检测方法不存在延时，实时性好；2、本方法对于系统噪声和干扰为非高斯分布的问题能得到最优解；3、本方法满足卫星导航系统精度的要求，适用于完好性要求苛刻的领域。
【专利说明】-种GPS双卫星故障的RAIM方法
[0001]
【技术领域】：本发明设及一种快速检测隔离Gl^s双卫星故障的方法，是一种在用户 端进行的自主完好性监测优化方法，具体地说，是指一种将粒子滤波与层次滤波相结合用 于检测与隔离GI^S双卫星故障的方法。
[000引【背景技术】：近几年来，随着全球导航卫星系统（GNS巧的发展W及用户对于GNSS 服务性能要求的不断升级，完好性作为导航系统的一项非常重要的性能指标，而日益受到 重视。当GI^S定位数据不可用时，完好性监测系统可W向用户告警，从而避免错误的定位数 据给用户带来定位错误。接收机自主完好性监测算法（RAIM)可W在接收机通过卫星导航 电文解算出的定位误差大于设定阔值时，向用户告警。根据RAIM对故障卫星进行监测和识 另IJ，从而提高接收机的定位精度。因此，用户端的接收机自主完好性监测算法的研究必要而 迫切。
[0003] 目前已有的RAIM方法主要基于单颗卫星发生故障的假设，但随着我国"北斗"二 代计划的实施，空中可用于定位的卫星数目的不断增加，多颗卫星发生故障的概率不可忽 视。同时，单颗卫星定位不能满足一些对完好性要求苛刻的领域时，采用多星座联合导航定 位时，两颗卫星同时发生错误的概率不能再被忽略，在进行RAIM算法研究中应予W考虑。
[0004] 接收机自主完好性监测是一种识别多星故障的完好性问题，用传统的算法（包括 基于卡尔曼滤波的算法、假设检验算法、重构奇偶矢量算法）解决将面临严峻挑战，主要表 现在；（1)运算过程中包含了大量的矩阵=角分解和广义特征值分解，在接收机中很难实 现实时解算；(2)可能存在故障残差抵消，从而导致无法找出故障卫星或者做出错误判断； (3)算法针对只有一颗卫星出现故障，对于多颗卫星发生故障的情况不能有效解决；(4)对 于系统噪声和干扰为非高斯分布的问题仅能提供次优解并且不能有效地实现多星座情况 下的接收机自主完好性检测。
【发明内容】
[0005] ；针对上述现有技术的不足，本发明提供了一种GPS双卫星故障的RAIM 方法。
[0006] 为实现上述目的，本发明采用的技术方案是：一种GPS双卫星故障的RAIM方法，包 括如下步骤：
[0007] 第一步，建立粒子滤波用于接收机自主完好性监测的故障检测与隔离的系统模 型；
[000引第二步，计算各状态累加对数似然比；
[0009] 第=步，使用基于层次滤波和粒子滤波算法的接收机自主完好性监测方法实现对 双故障卫星的检测和隔离。
[0010] 本发明的优点在于：
[0011] 1、本方法能有效地实现双卫星故障情况下的接收机自主完好性监测，检测方法不 存在延时，实时性好；
[0012] 2、本方法对于系统噪声和干扰为非高斯分布的问题能得到最优解；
[0013] 3、本方法满足卫星导航系统精度的要求，适用于完好性要求苛刻的领域。
【专利附图】
【附图说明】
[0014] 图1是基于PF的LLR测试方法用于FDI的实现框图。
[0015] 图2是基于层次滤波算法用于双故障检测的实现框图。
[0016] 图3是双故障卫星的情况进行故障检测与隔离实现流程图。
【具体实施方式】：
[0017] 下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清晰、完 整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于 本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他 实施例，都属于本发明保护的范围。
[001引首先介绍如下的概念与定义：
[0019] 1、完好性；是指当定位数据不可用时，系统可W向用户告警，从而避免错误的定位 数据给用户带来定位错误。
[0020] 2、故障的检测（FD);是指对被监测系统故障的存在作出判断；故障的隔离（FI): 是指对系统故障的类型作出判断。
[0021] 3、粒子滤波方法；是一种基于序贯蒙特卡罗方法和序贯重要性采样（SIS)的滤波 方法，其对于非线性、非高斯系统的状态估计问题有着很好的滤波效果，该方法对系统噪声 没有任何限制，通过从系统概率密度函数进行采样得到采样集，并通过系统的状态方程和 量测方程来对采样集进行预测和更新来近似非线性系统的随机贝叶斯估计。
[0022] 本发明提供的基于层次滤波和粒子滤波算法的接收机自主完好性监测方法，具体 步骤如下：
[0023] 第一步，建立粒子滤波用于接收机自主完好性监测的故障检测与隔离的系统模 型；
[0024] 系统状态方程：
[002引 Xk= F k-iXk-1+Wk-i
[0026] 式中，乂 = A 5为接收机相对于卫星时间的误差；F为转移矩阵，在 静止状态下为特征矩阵;W为过程噪声。
[0027] 量测方程；
[002引 P i 化）=Ri 化)+C A 5 i+f 化)+Ei 化)+ e i 化）
[0029] 式中，P i为接收机（r X，r" 〇与卫星i (s/，s/，SzO之间的伪距（m) ;c为光速； A 5为时间误差也为星历影响；e为码观测噪声；+ '接 收机与卫星i之间的真实距离（m)。
[0030] 量测量选取为；卫星位置坐标（s,i，s/，s,i)、伪距P哺时间误差A S，都可从量测 数据中提取。
[0031] 假设当前用于PVT解算的卫星数目8 = 6,并假设其中有一颗卫星出现故障。为了 检测和隔离出故障卫星，需要Q = S+1个PF，一个作为主PF，剩下的S个PF作为辅助PF。 主PF的作用是处理所有S颗卫星的测量值W计算系统的状态估计；S个辅助PF的作用是 计算依次去除s颗卫星中的一颗卫星的测量值后对应的状态估计，计算结果将用于LLR测 试W进行一致性检测。
[003引基于PF的LLR方法用于卫星故障检测和隔离的实现框图如图1所示。
[003引如图1所示，设从GF*S接收机输出的量测量数目为6,即y = [y。72, 73, 74, ys，ye]T， 故需要7个PF。图1中的MIN PF用于处理所有的6个量测量W对系统的状态做出较准 确的估计和其概率密度函数pM(y)，同时其它的6个PF作为辅助PF主要用于分别处理6 个量测量中的5个，W计算状态估计(g = 43,…，F)和它们的概率密度函数护(y)，计算 结果将用于构建检验统计量。
[0034] 各个PF的量测矢量如下所示
【权利要求】
1. 一种GPS双卫星故障的RA頂方法，包括如下步骤： 第一步，建立粒子滤波用于接收机自主完好性监测的故障检测与隔离的系统模型； 第二步，计算各状态累加对数似然比； 第三步，使用基于层次滤波和粒子滤波算法的接收机自主完好性监测方法实现对双故 障卫星的检测和隔离。
2. 如权利要求1所述的一种GPS双卫星故障的RAIM方法，其特征在于，所述第一步建 立粒子滤波用于接收机自主完好性监测的故障检测与隔离的系统模型的中的系统状态方 程： Xk=Fk-iXk-1+Wk-! 式中，1=1/;.，/;,〃_义4八6为接收机相对于卫星时间的误差丨为转移矩阵，在静止 ， 状态下为特征矩阵;W为过程噪声； 量测方程： P' (k) =Ri (k)+CA8 '+Ti (k) +Ei (k) +e' (k) 式中，PiS接收机（rx，ry，rz)与卫星i(s/，s/，s/)之间的伪距（m) ;c为光速；AS为 时间误差；Ei为星历影响；e为码观测噪声；
接收机与卫星i之间的真实距离（m); 量测量选取为：卫星位置坐标（s/,s/，s/)、伪距P1和时间误差A6，都可从量测数据 中提取； 假设当前用于PVT解算的卫星数目s= 6,并假设其中有一颗卫星出现故障，为了检测 和隔离出故障卫星，需要Q=s+1个PF，一个作为主PF，剩下的s个PF作为辅助PF，主PF 的作用是处理所有s颗卫星的测量值以计算系统的状态估计；s个辅助PF的作用是计算依 次去除s颗卫星中的一颗卫星的测量值后对应的状态估计，计算结果将用于LLR测试以进 行一致性检测。
3. 如权利要求1所述的一种GPS双卫星故障的RAIM方法，其特征在于，所述第二步计 算各状态累加对数似然比具体过程为：统计量的建立： 将LLR测试定义为各辅助PF和主PF的概率密度函数之比，表达式如下式所示：
由于系统状态估计的似然函数可用PF中粒子的归一化权值近似表示，故上式中的pH)和pA(yiIYiJ可表示为：
所以，计算出主PF和各辅助PF中各时刻的粒子归一化权值，即可得到用于一致性检测 的累加LLR，从而对系统是否出现故障进行检测； 通过计算得到各时刻的累加LLR函数$后，根据累加LLR函数 < 具有的特性，即正常 情况下，随着时间k的增长，函数曲线是平稳的；当数据发生变化时，会在变化之前产生一 个负向的漂移，在变化之后产生一个正向的漂移，体现在$函数曲线上就是一个不同于其 他时刻的波动，利用这一特性就可以对系统是否发生故障做出判断； 用于FD的判决函数如下：
式中的U为窗函数，包含当前时刻以前的各观测时刻，一般根据经验选择窗口大小，T为判决阈值，一般也是根据经验选择， 当ek>T，也就是系统检测到故障时，应当设置告警并将当前时刻表示为ta，之后利用 下式确定发生故障的卫星编号：
式中g表示故障卫星编号，确定了故障卫星的卫星编号，就可以对该卫星的量测值进 行隔呙。
4. 如权利要求1所述的一种GPS双卫星故障的RAIM方法，其特征在于，所述第三步使 用基于层次滤波和粒子滤波算法的接收机自主完好性监测方法实现对双故障卫星的检测 和隔离具体过程为： (1) 用全部的测量值s计算系统的状态估计后，用剩下的测量值计算除去s颗卫星中的 一颗卫星的测量值即s-1后对应的状态估计，然后进行LLR-致性检测，如果超过设定门限 则表示有故障，否则无故障； (2) 如果有故障卫星，则利用相同的方式，在去掉故障卫星的测量值之后，利用剩下的 测量值即s-1个测量值和剩下的部分测量值计算即s-2个测量值状态估计，然后再进行LLR 一致性检测，确定剩余卫星中是否有故障卫星，利用上述方法，经过两次计算，即可实现两 颗卫星的故障检测。
5. 如权利要求1所述的一种GPS双卫星故障的RAIM方法，其特征在于，根据空间交会 原理求解接收机初始位置，再根据接收机所在坐标（rx,ry,rz)产生N个主PF的初始粒子 k(i):i=l,和辅助PF的初始粒子k⑴:i= 1，2,…，M，4(1) = 4(0; ◎进行第一层次滤波，每个时间常数k重复以下步骤：
1.状态预测：将)^(丨):丨=1么...^4 和{^(〇:丨=1,2,...,7￥(分别带入系统状态方程即式（1)，得到粒子预测值4_10)和(i)；
2.计算粒子权重：将粒子预测值^^-4)、和第i颗卫星的位置坐标 (s/，<，s/)以及时间误差AS等带入系统量测方程，得到预测的第i颗卫星的伪距值//， 将//和伪距的量测值P1带入权值计算公式并归一化，得到归一化后的粒子权值对(i)和 叼⑴. 5
5. 错误判决：T为判决阈值； 如果ek>T，错误告警设置为ta=t时刻并跳至步骤6; 如果ek<T，则表示没有错误，跳至步骤7;
6. 错误隔离：在k>ta下，取出Q颗卫星中累积LLR最大的那个卫星q即为出错的卫 星，则g=q;
7. 状态更新：粒子滤波重采样得到更新粒子； ◎进行第二层次滤波，在去掉累计LLR最大的那颗卫星之后，用剩下的测量值和剩下 的部分测量值再一次进行基于LLR的PF算法进行第二层次卫星的故障检测与隔离，排除剩 余故障卫星。
【文档编号】G06F19/00GK104504247SQ201410748809
【公开日】2015年4月8日 申请日期:2014年12月9日 优先权日:2014年12月9日
【发明者】王尔申, 杨永明, 庞涛 申请人:沈阳航空航天大学