发明内容
本发明的技术解决问题是:克服现有技术的不足,提供了一种适用于星载导航接收机的RAIM改进方法,该方法能够克服传统奇偶空间方法占用资源较大的问题,提高导航接收机完好性监测的效率。
本发明的技术解决方案是:一种适用于星载导航接收机的自主完好性监测方法,步骤如下:
(1)预先设定定位误差警报限值PAL、误检概率PFA和漏警概率PMD;其中定位误差警报限值用于描述所能容忍的最大定位误差,误检概率表示导航接收机伪距测量正常但提示工作不正常的概率,漏警概率表示没有检测到导航接收机测量错误的概率;
(2)求解线性化定位矩阵方程式y=Hx+ε,得到未知参数的最小二乘估计δx=(HTH)-1HTy,并据此对未知参数进行更新xk=xk-1+δx,直至未知参数x的迭代更新收敛到了所需精度后进入步骤(3);其中y为n维伪距残余列向量,代表实际测量伪距与预测伪距的差值;H为n×4维由各导航卫星至导航接收机的方向余弦向量构成的线性化矩阵;x表示4维由导航接收机的位置坐标和时钟偏差构成的状态列向量;ε为n维观测伪距噪声向量;n为可视导航卫星的个数;k代表当前历元正在进行的牛顿迭代次数;
(3)判断PPL是否小于PAL,若小于则转步骤(4),否则退出; 而 其中Rx、Qx分别为R、QT阵的前4行,||Qpi||为Qp的第i列的长度,算子erf-1的含义为误差函数求逆运算,Tr为故障识别限值,Tr=Φ-1(1-PFA/2n),n为可视的导航卫星的数量,Q为n×n维正交矩阵,R为n×4维上三角矩阵,H=QR,H为未知参数x收敛至所需精度后对应的观测矩阵,Qp为QT的后n-4行;
(4)选取统计检测量并确定T的检测限值其中SSE=pTp,p=Qpy,y为未知参数x收敛至所需精度后对应的伪距残余,为观测伪距噪声中的各个分量所服从的正态分布的方差,α满足关系式
(5)在每次检测时,将实时获取的T与门限值TD比较,若T≥TD表示检测到故障,将向用户发出警告并进入步骤(6)进行识别;若T<TD表示无故障导航卫星并退出;
(6)构建第i颗导航卫星的检测统计量ri,对每个统计量ri与Tr比较,若ri>Tr,则表明第i颗导航卫星有故障;其中||Qpi||为Qp的第i列的长度。
所述的步骤(2)每步迭代中未知参数x的求解采用最小二乘估计的方式。
本发明与现有技术相比的优点在于:观测误差可以通过故障检测统计量反映出来,通常选择奇偶空间矢量进行故障检测统计量的构造。利用数理统计的假设检验方面的内容对统计量进行分析可以检验系统中是否存在粗差(没有模型化的偏差)。由于涉及到多次运算复杂的QR分解,奇偶空间方法的统计检测量构造模块运算量较大。本发明通过一次观测阵的QR分解,基于最小二乘方法构造奇偶空间的统计检测量,并在奇偶空间进行可用性判断、故障检测、故障识别。该方法既能够发挥奇偶空间可用性判断、故障检测、故障识别运算量较小的优势,又能成功避免直接在奇偶域进行统计检测量构造时的复杂运算,达到运算量简化的目的。
具体实施方式
相比地面和航空应用,航天器具有轨道高度更高、运行速度更快及资源有限等特点,航天上应用的RAIM应该更加节省资源。在上述背景下,本发明提出了一种适用于星载导航接收机使用的RAIM改进方法。通过采用最小二乘方法构造奇偶空间矢量,避免了求解奇偶空间统计检测量时的运算复杂QR分解运算,提高方法的执行效率。
如图1所示,为本发明方法的流程框图,主要步骤如下:
(1)统计检测量的构造
n个伪距观测值的误差模型可以表示为:
y=Hx+ε (1)
上式中y称为伪距残余,为n×1的测量向量,代表实际测量伪距与预测伪距的差值;H为n×4维由各卫星至用户接收机的方向余弦向量构成的线性化矩阵;x表示用户实际位置的三个分量和导航接收机的时钟偏差,是4×1维状态向量;ε为n维列向量,表示观测伪距噪声,包括随机误差和系统误差,如大气延迟和轨道误差、卫星钟误差等;n为可视卫星的个数。
当n>4时,在最小二乘准则下,可得到未知参数的最小二乘估计
δx=(HTH)-1HTy (2)
根据上式,对接收机的位置坐标和钟差值进行更新:
xk=xk-1+δx (3)
k代表当前历元正在进行的牛顿迭代次数,k取值不小于1。
若牛顿迭代已经收敛到了所需要的精度,则牛顿迭代法可终止循环运算,否则k值增1,根据更新后的位置坐标和卫星钟差值对观测矩阵H和伪距残余y进行更新后,重复步骤(2)和(3)。迭代收敛后,中止循环,并对n×4维的观测矩阵H进行QR(正交三角)分解:
H=QR (4)
其中Q为n×n维正交矩阵,R为n×4维上三角矩阵。
定义奇偶空间矢量如下
p=Qpy (5)
Qpy=Qp(Hx+ε)=Qpε,因此它能直接反映故障卫星的偏差信息。其中Qp称为奇偶空间矩阵,为QT的后n-4行。Qp具有以下性质:Qp的行与H的列正交;Qp的行相互正交;Qp的行都进行了标准化,每一行的长度都是1。
定义伪距残余各分量的平方和为SSE=pTp。将回归剩余标准差T作为RAIM判断的检验统计量:
(2)RAIM可用性判断
单颗卫星出现伪距发生偏差时,它所引起的统计检测量与定位误差两者之间成线性关系,而与故障大小无关,将该量称为“卫星特征斜率”,它能够表征该星对故障的反应灵敏度。若最难检测故障的卫星不能保证系统所要求的漏警概率的要求,那么判断RAIM算法在这种卫星几何分布情况下是不可用的。
由于当没有观测偏差时,识别统计量服从均值为零的正态分布。根据系统所要求的漏警概率,可推导出第i颗星上最小可检测偏差引起的定位误差为:
其中Rx、Qx分别为R、QT阵的前4行,角标-1表示逆矩阵,PMD为给定的漏警概率(检测不出错误测量值和故障状态的概率),||Qpi||为Qp的第i列的长度。算子erf-1表示误差函数求逆,Tr为故障识别限值,可由下式计算得到:
Tr=Φ-1(1-PFA/2n) (8)
其中,角标-1表示函数求逆运算,PFA为给定的误检概率(将一些原本正常的测量值和系统状态假报成错误和故障的概率)。
取最大定位误差,则定位误差保护级别为:
此PPL值表示满足PMD条件时可能达到的最大定位误差,若其小于定位误差警报限值PAL(系统可接受的最大位置误差),则故障检测具有完好性保证。
(3)故障检测
在方法可用的条件下,进行故障检测。根据所构造的统计量所服从的统计分布,在满足用户/系统所要求的误检概率的条件下,通过一定的变换关系便可以确定相应该统计检测量的告警门限值。统计量超过检测门限说明有故障星的存在,系统发出警报。
根据统计分布理论,若伪距测量误差向量ε中的各个分量相互独立且服从均值为零、方差为的正态随机分布(称为等效测距误差),则服从自由度为n-4的卡方(χ2)分布,SSE与卫星数、几何分布独立;若ε的均值不为零,则服从自由度为n-4的非中心化卡方分布,非中心化参数:
算子E(U)表示对U求统计平均。
即统计假设有两类:
无故障假设H0:E(ε)=0则
有故障假设H1:E(ε)≠0则
无伪距故障时,系统处于正常监测状态,如果出现监测告警,则为误检。因此,给定误检概率PFA,应有如下概率等式(11):
通过上式确定了SSE/的检测限值a,因此相应T的检测限值
在每次检测时将T与门限值TD比较,若T≥TD表示检测到故障,将向用户发出警告;若T<TD,无故障导航卫星。
(4)故障识别
系统发出警告时,需要对故障星进行识别。由于观测误差是通过奇偶空间矩阵的每一列反映到奇偶矢量的,因此奇偶矢量与奇偶空间矩阵的列有着必然的联系,可以利用它们之间的几何性质进行故障卫星的识别。故障识别准则:含有粗差的卫星就是那颗特征偏差线与观测的奇偶向量重合的卫星。
为最大化偏差的可视性,将奇偶矢量投影到Qp的每一列,并进行标准化,可得到第i颗卫星的统计量:
以ri作为识别统计量,当没有观测偏差,ri是均值为零的正态分布。给定误检概率PFA,对n个统计量有下列概率等式:
从而可以得到识别限值:
Tr=Φ-1(1-PFA/2n) (15)
已知PFA,可事先计算得到限值Tr,对每个统计量ri与Tr比较,若ri>Tr,则检测到该卫星有故障。
实施例
为了验证本发明的在轨工作性能,地面与仿真信号源联合进行测试,搭建的验证系统示意图如图2:
RAIM为嵌入在接收机内部的算法。仿真信号源采用Sprint公司的SimGEN仿真控制软件,模拟产生星载射频信号,仿真场景时长为8小时,原始轨道数据设置如下表格:
表1轨道六根数设置
轨道长半轴 |
轨道倾角 |
轨道偏心率 |
升交点赤经 |
近地点辐角 |
平近点角 |
7004km |
97.935° |
0.00121 |
29.89° |
58.22° |
81.051° |
考虑到实际在轨性能要求及航天器的运行轨道特点,本试验中先验参数的选取按照下面表格中的参数设计。
表2RAIM场景设计
场景/参数 |
误检概率 |
漏警概率 |
观测误差(m) |
场景1 |
0.0005 |
0.001 |
3.5 |
8小时内,奇偶空间方法和本发明方法所用运行时间如图3所示:
两种方法的平均运行时间及在满负荷运算(导航星数目为12颗)时不同算法的最大运行时间如下表所示。
表3不同方法运行时间比较(ms)
RAIM方法 |
均值 |
满负荷时最大运行时间 |
奇偶空间法 |
17.35 |
34.89 |
改进方法 |
12.67 |
24.80 |
通过上表看出,本发明所用方法的平均运行时间为12.67ms,相比奇偶空间方法,运行时间缩短了4.68ms,运行效率提高了27%;在满负荷运行的情况下(即可用星达到12颗时),本发明所用方法的最大运行时间为24.8ms,相比奇偶空间方法,运行时间缩短了10.09ms,运行效率提高了28.9%。
综合以上分析可以看出,两种方法中,无论从最大占用时间或随卫星数目而变化的统计时间考虑,本发明占用时间均最少,更加适合星载接收机的使用。
另外,一颗星模拟添加7.5m的伪距误差时,本发明的检测效果如下表格:
表2模拟添加7.5m伪距误差时的检测效果
漏警概率 |
误检概率 |
正确检测率 |
0.0893 |
0.0005 |
0.8977 |
通过上述仿真结果可以发现,本发明方法对于7.5m的观测误差,能够实现0.8977的正确检测概率;且根据在轨数据的分析,伪距偏差大于7.5m的历元个数所占百分比约为1.75%,可以算出,使用本发明方法可以保证接收机正确输出的概率从原来的98.25%提高到99.77%。该发明是一种适用于星载导航接收机的完好性监测手段。
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。