首页> 中国专利> 一种卫星导航定位接收机,及其自主正直性检测方法

一种卫星导航定位接收机,及其自主正直性检测方法

摘要

本发明公开了一种卫星导航定位接收机及其自主正直性检测方法,在保证卫星导航接收机的定位精度和可靠性的同时降低运算量。所述方法包括:接收机获得卫星的观测量后,对同一时刻的所有观测量采用卡尔曼滤波序贯处理法,逐一对同一时刻的所有观测量进行检测,如果不满足要求,则当前观测量含有粗大误差,不适合用于定位解算,剔除所述当前观测量,如果满足要求,则当前观测量不含粗大误差,保留所述当前观测量以用于定位解算。采用本发明实施例方法和设备,避免了矩阵变换、矩阵求逆等复杂运算,大大降低了接收机自主正直性检测的复杂度,增加检测的可靠性。

著录项

  • 公开/公告号CN112731464A

    专利类型发明专利

  • 公开/公告日2021-04-30

    原文格式PDF

  • 申请/专利权人 大唐半导体设计有限公司;

    申请/专利号CN202011532740.1

  • 申请日2020-12-23

  • 分类号G01S19/23(20100101);G01S19/37(20100101);

  • 代理机构11262 北京安信方达知识产权代理有限公司;

  • 代理人解婷婷;栗若木

  • 地址 100094 北京市海淀区永嘉北路6号

  • 入库时间 2023-06-19 10:48:02

说明书

技术领域

本发明涉及全球卫星导航技术领域,尤指一种卫星导航定位接收机,以及卫星导航定位接收机的自主正直性检测方法。

背景技术

全球导航卫星系统(Global Navigation Satellite System,简称GNSS)已经广泛应用于各个领域。目前,主要有四个全球导航定位系统:美国的全球定位系统(GlobalPositioning System,简称GPS),工作的地球中轨卫星(MEO)有24颗;中国的北斗卫星导航系统(Compass或Bei Dou,简称BD),实际工作的MEO卫星将达到27颗;俄罗斯的全球导航卫星系统(Global Navigation Satellite System,简称GLONASS)实际工作的MEO卫星将达到21颗;欧盟推出的规模最大的民用卫星导航定位系统,即伽利略(Galileo)系统,实际工作的MEO卫星将达到27颗。其中,GPS发展最为成熟,BD和GLONASS已经取得阶段性进展,而伽利略系统还处于起步阶段。

随着卫星导航技术和应用的飞速发展,为了提高导航定位的精度和可用性、连续性、完好性,单卫星定位系统接收机已经不能满足用户的需求。接收机生产商已逐步转向多模系统接收机,即接收机同时支持多个导航系统。目前已经出现的有双模、三模等导航接收机,随着工艺的提高和导航系统的发展与完善,可以预见将来卫星导航接收机会有更多的导航系统集成在一起。

随着卫星导航系统的逐渐完善和多模接收机系统的发展,接收机在同一时刻接收到的卫星数目势必大大增加,例如GPS和BDS的双模系统接收机在同一位置,同一时间理论上可接收到30左右颗卫星。虽然大大的提高了接收机的定位精度,但也大大的增加了接收机的运算量。为了保证接收机的定位、授时的精确性、连续性、鲁棒性,必须对接收机的正直性进行检测,即接收机自主正直性检测(Receiver Autonomous Integrity Monitoring,简称RAIM)。RAIM算法的基本思想就是对参与解算的观测量进行判断,将如含有粗大误差、仰角过小等不适合参与解算的观测量剔除。

传统的RAIM算法是在最小二乘法定位过程中进行的。具体步骤:

一.卫星信息的计算及初步踢星

接收机完成信号的位同步和帧同步以后得到卫星的星历和时间信息,依此计算出卫星的位置和速度。通过接收机位置的预设值,计算出每颗卫星的仰角。将仰角低于预设仰角门限的观测量剔除。

二.建立观测方程

其中,(x,y,z)为卫星的位置坐标,(X,Y,Z)为接收机位置预设值,n为导航卫星系统个数,ρ为观测量的测量值。式(1)可以通过系统的时钟转换因子变换为只含一个钟差的观测方程。

三.选星

由于卫星的空间分布直接影响定位的精度,虽然多模接收机同一时刻可接收到较多的可见卫星,但是为了降低接收机的运算量,采用了从N颗可见卫星中选出m颗卫星,以提高卫星几何分布的合理性。同时RAIM算法需要一定的冗余,所以一般m>5。采用几何精度因子(GDOP)值反映卫星空间分布质量。

其中,矩阵G为式(2)线性化得到的观测矩阵,trace()为矩阵求迹运算。GDOP最小的组合为最好的卫星几何分布。

四.观测量残余

根据加权最小二乘法定位得,

b=GΔx (4)

Δx=(G

其中,b为定位前观测量残余,Δx为状态量的校正值,矩阵C=W

定位后残余为

其中,I为单位矩阵。

五.全局检测

检测量为加权残余平方和T

由式(6)可知定位后残余服从均值为0的正态分布,所以加权残余平方和服从自由度(DOF)为m-4的X

如果T

如果T

六.局部检测

由步骤五,如果判定观测量中含有有问题的卫星,这一步通过局部检测确定哪一个观测量存在问题。检测量为

SLOPE(i)=b(i)σ(i)/S

其中,SLOPE(i)为第i颗卫星的观测量的特征性斜率,b(i)为第i颗卫星的观测量残余,σ(i)为第i颗卫星的观测量误差的均方根,S

SLOPE(i)值最大的量为最难检测的量,即可能存在问题的观测量,将该观测量剔除。然后在从N-m颗卫星中挑选出一个卫星组合最优几何组合。判断此时的卫星数是否满足解算,如果满足返回第三步次序进行;如果过此时的卫星数不满足解算,则发出卫星不足警告。

上述传统RAIM算法中,涉及到了矩阵的运算,包括矩阵的乘法、矩阵求逆等,而且每次只能检测出一个存在问题的观测量。随着观测量的增加,其运算量会成倍的增加。不仅会增加检测的复杂度,而且其检测可靠性势必会降低。随着各卫星导航系统的增加,多模接收机的快速发展,寻找简单可靠的RAIM方法迫在眉睫。

发明内容

为了解决上述技术问题,本发明提供了一种卫星导航定位接收机及其自主正直性检测方法,在保证卫星导航接收机的定位精度和可靠性的同时降低运算量。

为了达到本发明目的,本发明提供了一种卫星导航定位接收机自主正直性检测方法,所述方法包括:

接收机获得卫星的观测量后,对同一时刻的所有观测量采用卡尔曼滤波序贯处理法,逐一对同一时刻的所有观测量进行检测,如果不满足要求,则当前观测量含有粗大误差,不适合用于定位解算,剔除所述当前观测量,如果满足要求,则当前观测量不含粗大误差,保留所述当前观测量以用于定位解算。

进一步地,所述逐一对同一时刻的所有观测量进行检测,包括:逐一选取观测量对状态量进行校正,获得检测参数,判断所述检测参数是否满足要求。

进一步地,所述检测参数包括:用当前观测量校正的状态量误差协方差矩阵;所述判断检测参数是否满足要求,包括:判断所述状态量误差协方差矩阵是否正定,如果正定则满足要求,如果不正定,则不满足要求。

进一步地,所述逐一选取观测量对状态量进行校正,获得检测参数,包括:选取一观测量作为当前观测量,计算所述当前观测量的卡尔曼增益,利用所述当前观测量的卡尔曼增益对状态量误差协方差矩阵先验矩阵进行校正获得校正后的状态量误差协方差矩阵;

本次检测完成后,选取下一观测量作为当前观测量,并将上一次检测过程中用满足要求的观测量校正的状态量误差协方差矩阵作为本次检测过程的状态量误差协方差矩阵先验矩阵,重复检测过程以及对检测参数是否满足要求的判断过程,直到所有观测量处理完毕。

进一步地,所述检测参数还包括:观测量的观测量残余;所述判断检测参数是否满足要求,包括:判断所述状态量误差协方差矩阵正定后,采用观测量的观测量残余进行观测量一致性判定,如果符合观测量一致性则满足要求,如果不符合观测量一致性则不满足要求。

进一步地,所述逐一选取观测量对状态量进行校正,获得检测参数,包括:选取一观测量作为当前观测量,计算所述当前观测量的卡尔曼增益,利用所述当前观测量的卡尔曼增益对状态量估计值进行校正获得状态量的校正值及当前观测量的观测量残余,以及利用所述当前观测量的卡尔曼增益对状态量误差协方差矩阵先验矩阵进行校正获得校正后的状态量误差协方差矩阵;

本次检验完成后,选取下一观测量作为当前观测量,并将上次检测过程中得到的最新的状态量以及状态量误差协方差矩阵作为本次检测过程的初始值,重复检测过程以及对检测参数是否满足要求的判断过程,直到所有观测量处理完毕。

进一步地,所述采用观测量的观测量残余进行观测量一致性判定,包括:采用观测量的观测量残余计算第一检测量,判断第一检测量是否大于预设第一检测门限,如果大于,表示当前观测量不符合观测量一致性,如果小于等于,表示当前观测量符合观测量一致性。

进一步地,所述方法还包括:对保留的满足要求的所有观测量进行卡尔曼滤波的整体检验,利用观测量的观测量残余计算第二检测量,判断所述第二检测量是否小于预设第二检测门限,如果小于,则输出所述保留的所有观测量,如果大于等于,则对所述保留的所有观测量进行局部检测,确定存在问题的观测量,并将其剔除。

进一步地,所述对保留的所有观测量进行局部检测,确定存在问题的观测量,包括:计算第三检测量,将所述第三检测量的最大值对应的观测量确定为存在问题的观测量。

为了达到本发明目的,本发明还提供了一种卫星导航定位接收机,所述接收机包括观测量获取模块和检测模块,其中:

所述观测量获取模块用于获得卫星的观测量;

所述检测模块用于对同一时刻的所有观测量采用卡尔曼滤波序贯处理法,逐一对同一时刻的所有观测量进行检测,如果不满足要求,则当前观测量含有粗大误差,不适合用于定位解算,剔除所述当前观测量,如果满足要求,则当前观测量不含粗大误差,保留所述当前观测量以用于定位解算。

进一步地,所述检测模块对同一时刻的所有观测量采用卡尔曼滤波序贯处理法,逐一对同一时刻的所有观测量进行检测,包括:所述检测模块逐一选取观测量对状态量进行校正,获得检测参数,判断所述检测参数是否满足要求。

进一步地,所述检测参数包括:用当前观测量校正的状态量误差协方差矩阵;

所述检测模块判断检测参数是否满足要求,包括:所述检测模块判断所述状态量误差协方差矩阵是否正定,如果正定则满足要求,如果不正定,则不满足要求。

进一步地,所述检测模块逐一选取观测量对状态量进行校正,获得检测参数,包括:

所述检测模块选取一观测量作为当前观测量,计算所述当前观测量的卡尔曼增益,利用所述当前观测量的卡尔曼增益对状态量误差协方差矩阵先验矩阵进行校正获得校正后的状态量误差协方差矩阵;

本次检测完成后,选取下一观测量作为当前观测量,并将上一次检测过程中用满足要求的观测量校正的状态量误差协方差矩阵作为本次检测过程的状态量误差协方差矩阵先验矩阵,重复检测过程以及对检测参数是否满足要求的判断过程,直到所有观测量处理完毕。

进一步地,所述检测参数还包括:观测量的观测量残余;

所述检测模块判断检测参数是否满足要求,包括:所述检测模块判断所述状态量误差协方差矩阵正定后,采用观测量的观测量残余进行观测量一致性判定,如果符合观测量一致性则满足要求,如果不符合观测量一致性则不满足要求。

进一步地,所述检测模块逐一选取观测量对状态量进行校正,获得检测参数,包括:

所述检测模块选取一观测量作为当前观测量,计算所述当前观测量的卡尔曼增益,利用所述当前观测量的卡尔曼增益对状态量估计值进行校正获得状态量的校正值及当前观测量的观测量残余,以及利用所述当前观测量的卡尔曼增益对状态量误差协方差矩阵先验矩阵进行校正获得校正后的状态量误差协方差矩阵;

本次检验完成后,选取下一观测量作为当前观测量,并将上次检测过程中得到的最新的状态量以及状态量误差协方差矩阵作为本次检测过程的初始值,重复检测过程以及对检测参数是否满足要求的判断过程,直到所有观测量处理完毕。

进一步地,所述检测模块采用观测量的观测量残余进行观测量一致性判定,包括:所述检测模块采用观测量的观测量残余计算第一检测量,判断第一检测量是否大于预设第一检测门限,如果大于,表示当前观测量不符合观测量一致性,如果小于等于,表示当前观测量符合观测量一致性。

进一步地,所述检测模块还用于:对保留的满足要求的所有观测量进行卡尔曼滤波的整体检验,利用观测量的观测量残余计算第二检测量,判断所述第二检测量是否小于预设第二检测门限,如果小于,则输出所述保留的所有观测量,如果大于等于,则对所述保留的所有观测量进行局部检测,确定存在问题的观测量,并将其剔除。

进一步地,所述检测模块对保留的所有观测量进行局部检测,确定存在问题的观测量,包括:所述检测模块计算第三检测量,将所述第三检测量的最大值对应的观测量确定为存在问题的观测量。

为了达到本发明目的,本发明还提供了一种卫星导航定位接收机,包括存储器、处理器以及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现上述方法中的步骤。

采用本发明实施例方法和设备,用卡尔曼滤波序贯处理法代替现有技术中的最小二乘法进行观测量的预处理,逐一对观测量进行处理,且处理的参数为标量,由此避免了矩阵变换、矩阵求逆等复杂运算,大大降低了接收机自主正直性检测的复杂度,增加检测的可靠性。本发明实施例方法和设备尤其适用于多模接收机,但也可以适用于单模接收机。

本发明的其它特征和优点将在随后的说明书中阐述,并且,部分地从说明书中变得显而易见,或者通过实施本发明而了解。本发明的目的和其他优点可通过在说明书、权利要求书以及附图中所特别指出的结构来实现和获得。

附图说明

附图用来提供对本发明技术方案的进一步理解,并且构成说明书的一部分,与本申请的实施例一起用于解释本发明的技术方案,并不构成对本发明技术方案的限制。

图1为本发明实施例1方法流程图;

图2为本发明实施例2基于卡尔曼滤波的接收机RAIM算法整体流程图;

图3为本发明实施例2卡尔曼滤波序贯处理踢星流程图;

图4为本发明实施例3卫星导航定位接收机的一种结构示意图;

图5为本发明实施例3卫星导航定位接收机的另一种结构示意图。

具体实施方式

为使本发明的目的、技术方案和优点更加清楚明白,下文中将结合附图对本发明的实施例进行详细说明。需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互任意组合。

在附图的流程图示出的步骤可以在诸如一组计算机可执行指令的计算机系统中执行。并且,虽然在流程图中示出了逻辑顺序,但是在某些情况下,可以以不同于此处的顺序执行所示出或描述的步骤。

卡尔曼滤波定位算法将不同时刻的状态量通过状态方程联系起来,使得定位轨迹更为平滑。而状态量通过观测方程与观测量联系起来,根据这一特性在处理观测量时就可以逐个处理,即卡尔曼滤波的序贯处理法。由于是单个逐一处理观测量,既避免了解算过程中的矩阵求逆过程,同时又不会降低定位质量。根据这一特性实现一种降低运算量、提高可靠性的基于卡尔曼滤波的RAIM算法。

实施例一

如图1所示,包括以下步骤:

步骤10,接收机获得卫星的观测量;

步骤11,对同一时刻的所有观测量采用卡尔曼滤波序贯处理法,逐一对同一时刻的所有观测量进行检测,判断是否满足要求,如果满足要求,则执行步骤12,如果不满足要求,则执行步骤13;

步骤12,所述当前观测量不含粗大误差,保留当前观测量,以用于定位解算;

步骤13,所述当前观测量含有粗大误差,不适合用于定位解算,剔除当前观测量。

采用上述实施例方法,由于采用卡尔曼滤波序贯处理法逐一进行观测量的检测,相比于现有技术的最小二乘法观测量预处理,降低了运算量和处理复杂度。

上述步骤11中的对同一时刻的所有观测量采用卡尔曼滤波序贯处理法,逐一对同一时刻的所有观测量进行检测,包括:逐一选取观测量对状态量进行校正,获得检测参数,判断所述检测参数是否满足要求。

在一个可选实施方式中,上述检测参数包括:用当前观测量校正的状态量误差协方差矩阵,判断检测参数是否满足要求,是对该状态量误差协方差矩阵进行正定性的判断,如果正定,则认为满足要求,如果不正定,则认为不满足要求。在本实施方式中,只需要对用当前观测量校正后的状态量误差协方差矩阵的正定性判断即可实现观测量的剔除,无需大量的矩阵运算,在保证卫星导航接收机的定位精度和可靠性的同时降低运算量。

在本实施方式中,上述逐一选取观测量对状态量进行校正,获取检测参数的步骤,包括:选取一观测量作为当前观测量,计算该当前观测量的卡尔曼增益,利用所述当前观测量的卡尔曼增益对状态量误差协方差矩阵先验矩阵进行校正获得校正后的状态量误差协方差矩阵;本次检测完成后,选取下一观测量作为当前观测量,并将上一次检测过程中用满足要求的观测量校正的状态量误差协方差矩阵作为本次检测过程的状态量误差协方差矩阵先验矩阵,重复检测过程以及对检测参数是否满足要求的判断过程,直到所有观测量处理完毕。

在另一个可选实施方式中,上述检测参数除了状态量误差协方差矩阵外,还可包括:观测量的观测量残余;判断检测参数是否满足要求,包括:在判断状态量误差协方差矩阵正定后,利用观测量的观测量残余进行观测量一致性判定,如果符合观测量一致性则认为满足要求,如果不符合观测量一致性则认为不满足要求。在本实施方式中,除了状态量误差协方差矩阵的正定性判断,还增加了对观测量的一致性判断,进一步提高了检测的可靠性。

具体地,采用观测量的观测量残余进行观测量一致性判定,包括:采用观测量的观测量残余计算第一检测量,判断第一检测量是否大于预设第一检测门限,如果大于,表示当前观测量不符合观测量一致性,如果小于等于,表示当前观测量符合观测量一致性。

在本实施方式中,上述逐一选取观测量对状态量进行校正,获取检测参数的步骤,包括:选取一观测量作为当前观测量,计算所述当前观测量的卡尔曼增益,利用所述当前观测量的卡尔曼增益对状态量估计值进行校正获得状态量的校正值及当前观测量的观测量残余,以及利用所述当前观测量的卡尔曼增益对状态量误差协方差矩阵先验矩阵进行校正获得校正后的状态量误差协方差矩阵;本次检验完成后,选取下一观测量作为当前观测量,并将上次检测过程中得到的最新的状态量以及状态量误差协方差矩阵作为本次检测过程的初始值,重复检测过程以及对检测参数是否满足要求的判断过程,直到所有观测量处理完毕。

其中,将上次检测过程中得到的最新的状态量以及状态量误差协方差矩阵作为本次检测过程的初始值,具体是将上一次检测时获得的状态量的校正值作为本次检测过程中的状态量估计值,将上一次检测时获得的状态量误差协方差矩阵作为本次检测的状态量误差协方差矩阵先验矩阵。需要说明的是,只有检测通过,及上一次检测结果为观测量满足要求,该检测过程中的参数才能作为下一次检测过程的初始值。

在另一个可选实施方式中,为了进一步提高可靠性,在剔除不符合要求的观测量之后,还可以对保留的满足要求的所有观测量进行卡尔曼滤波的整体检验,利用观测量的观测量残余计算第二检测量,判断所述第二检测量是否小于预设第二检测门限,如果小于,则输出所述保留的所有观测量,如果大于等于,则对所述保留的所有观测量进行局部检测,确定存在问题的观测量,并将其剔除。

在本实施方式中,局部检测过程包括:计算第三检测量,将所述第三检测量的最大值对应的观测量确定为存在问题的观测量。

采用本发明实施例方法,用卡尔曼滤波序贯处理法代替现有技术中的最小二乘法进行观测量的预处理,逐一对观测量进行处理,且处理的参数为标量,由此避免了矩阵变换、矩阵求逆等复杂运算,大大降低了接收机自主正直性检测的复杂度,增加检测的可靠性。上述实施例方法可以适用于多模接收机,但也可以适用于单模接收机。

实施例二

本实施例对上述方法实施例进行具体描述,如图2所示,包括以下步骤:

步骤20,根据卫星观测量计算卫星仰角,利用仰角(EL)阈值踢星;

卡尔曼滤波算法的状态方程和观测方程分别为:

x

y

其中,x为状态向量,k为定位历元,A为状态转移矩阵,w为过程噪声向量,其协方差矩阵为Q,y为观测量向量,H为状态量与观测量间的转换矩阵,v为测量噪声向量,其协方差矩阵为R。设P为状态量误差的协方差矩阵。

卡尔曼滤波定位算法包括预测和更新两个步骤,其中通过预测步骤获得状态量和状态量误差的协方差矩阵先验矩阵,更新步骤包括:计算卡尔曼增益,利用卡尔曼增益更新状态量以及状态量误差的协方差矩阵,具体包括以下参数的获得:

状态量的预测:

状态量误差的协方差矩阵的先验矩阵:

卡尔曼增益:

状态量的更新:

状态量的协方差矩阵的更新:

根据卫星提供的星历计算出卫星的位置和速度。由接收机的预设值,计算出每颗卫星的仰角,考虑到低仰角的卫星收多径等因素影响较大,设定仰角门限将低仰角的卫星剔除。设此时的观测量数目为N。

步骤21,采用卡尔曼滤波序贯处理法对获得的观测量进行预处理,即卡尔曼滤波序贯处理踢星过程;

对所有观测量采用卡尔曼滤波序贯处理法,如图3所示,包括以下步骤:

步骤30,状态量的预测,即确定状态量初始值;

在本实施例中,将最小二乘法定位结果作为卡尔曼滤波的初始量,在其他实施例中也可以采用其他值作为卡尔曼滤波的初始量,初始量精度越高踢星效果越好。判断接收机的运动状态,以此确定状态向量的元素,列出状态方程。将观测量y

步骤31,检测第j个观测量,计算K

根据状态量的初始值获得k历元的状态估计值

观测量的卡尔曼增益:

状态量的校正值:x

校正后的状态量误差的协方差矩阵:P

上述观测量的卡尔曼增益用于计算状态量校正值和校正后的状态量误差的协方差矩阵,校正后的状态量误差协方差矩阵用于进行观测量检测,在本次观测量检测成功后,校正后的状态量误差协方差矩阵将作为下一次的状态误差协方差矩阵先验矩阵,状态量校正值作为下一次的状态量初始值。

其中,y

步骤32,状态量的协方差矩阵的正定性判定,如果由j观测量得到的状态量误差的协方差矩阵P

步骤33,设b

序贯处理的过程相当于不同观测量对同一时刻状态量的校正。而b

如果B>B

如果B<B

步骤34,当前观测量存在问题应剔除,返回步骤31,处理下一个观测量;

卡尔曼滤波序贯处理踢星算法,对观测量采用单个逐一处理方式,这样处理的思路简单,而且避免了矩阵求逆等矩阵运算,极大的降低了运算量。而且在完成了所有的观测量检测以后,如果观测量还有一定的冗余量,则最后的输出的观测量将可用于定位解算。

步骤22,为了保证接收机自主检测的可靠性,接下来对序贯处理踢星后的观测量进行卡尔曼滤波的整体检验,以验证踢星是否完全,如果检测量结果表明存在有问题的量,执行步骤23,如果没有问题,则剩余的观测量可以作为定位解算使用;

首先,确定第二检测量。设观测量的残余向量为

b

根据预先设定好的虚警率P

步骤23,若整体检测中发现存在问题观测量,则进行局部检测,确定哪一个观测量存在问题,将其剔除;

计算第三检测量:

其中,h为剩余卫星的计数,k的范围为[1,k]。I

步骤24,判断剩余卫星是否足够(例如设置最小卫星数即最小观测量数目为6,则如果N<6则卫星数目不够,如果N≥6则表示剩余卫星足够),如果足够,则回到整体检测,看是否还存在问题观测量;如果剩余卫星不够,则发出卫星不足警告。

由于序贯处理法完成初步的踢星,使得剩余观测量中存在问题的概率大大的降低。而后期的整体验证和局部剔除主要用于保证踢星的可靠性。这样从整个踢星策略上看,基于卡尔曼滤波的导航卫星接收机的RAIM算法思路更为简单,运算量更少,鲁棒性更强。以上方法在多模导航卫星接收机中应用的效果更加突出。

实施例三

本实施例提供一种卫星导航定位接收机设备,用于实现上述实施例一或实施例二的方法,前述方法实施例中的描述也适用于本实施例,如图4所示,所述接收机包括观测量获取模块41和检测模块42,其中:

所述观测量获取模块41用于获得卫星的观测量;

所述检测模块42用于对同一时刻的所有观测量采用卡尔曼滤波序贯处理法,逐一对同一时刻的所有观测量进行检测,如果不满足要求,则当前观测量含有粗大误差,不适合用于定位解算,剔除所述当前观测量,如果满足要求,则当前观测量不含粗大误差,保留所述当前观测量以用于定位解算。

在一个可选实施例中,所述检测模块42对同一时刻的所有观测量采用卡尔曼滤波序贯处理法,逐一对同一时刻的所有观测量进行检测,包括:所述检测模块42逐一选取观测量对状态量进行校正,获得检测参数,判断所述检测参数是否满足要求。

在一个可选实施例中,所述检测参数包括:用当前观测量校正的状态量误差协方差矩阵;所述检测模块42判断检测参数是否满足要求,包括:所述检测模块42判断所述状态量误差协方差矩阵是否正定,如果正定则满足要求,如果不正定,则不满足要求。

上述检测模块42逐一选取观测量对状态量进行校正,获得检测参数,包括:所述检测模块42选取一观测量作为当前观测量,计算所述当前观测量的卡尔曼增益,利用所述当前观测量的卡尔曼增益对状态量误差协方差矩阵先验矩阵进行校正获得校正后的状态量误差协方差矩阵;本次检测完成后,选取下一观测量作为当前观测量,并将上一次检测过程中用满足要求的观测量校正的状态量误差协方差矩阵作为本次检测过程的状态量误差协方差矩阵先验矩阵,重复检测过程以及对检测参数是否满足要求的判断过程,直到所有观测量处理完毕。

在一个可选实施例中,所述检测参数还包括:观测量的观测量残余;

上述检测模块42判断检测参数是否满足要求,包括:所述检测模块42判断所述状态量误差协方差矩阵正定后,采用观测量的观测量残余进行观测量一致性判定,如果符合观测量一致性则满足要求,如果不符合观测量一致性则不满足要求。

上述检测模块42逐一选取观测量对状态量进行校正,获得检测参数,包括:所述检测模块42选取一观测量作为当前观测量,计算所述当前观测量的卡尔曼增益,利用所述当前观测量的卡尔曼增益对状态量估计值进行校正获得状态量的校正值及当前观测量的观测量残余,以及利用所述当前观测量的卡尔曼增益对状态量误差协方差矩阵先验矩阵进行校正获得校正后的状态量误差协方差矩阵;本次检验完成后,选取下一观测量作为当前观测量,并将上次检测过程中得到的最新的状态量以及状态量误差协方差矩阵作为本次检测过程的初始值,重复检测过程以及对检测参数是否满足要求的判断过程,直到所有观测量处理完毕。

在一个可选实施例中,所述检测模块42采用观测量的观测量残余进行观测量一致性判定,包括:所述检测模块42采用观测量的观测量残余计算第一检测量,判断第一检测量是否大于预设第一检测门限,如果大于,表示当前观测量不符合观测量一致性,如果小于等于,表示当前观测量符合观测量一致性。

在一个可选实施例中,所述检测模块42还用于:对保留的满足要求的所有观测量进行卡尔曼滤波的整体检验,利用观测量的观测量残余计算第二检测量,判断所述第二检测量是否小于预设第二检测门限,如果小于,则输出所述保留的所有观测量,如果大于等于,则对所述保留的所有观测量进行局部检测,确定存在问题的观测量,并将其剔除。

其中,所述检测模块42对保留的所有观测量进行局部检测,确定存在问题的观测量,包括:所述检测模块42计算第三检测量,将所述第三检测量的最大值对应的观测量确定为存在问题的观测量。

上述卫星导航定位接收机可以是一种计算机设备,其可以是如图5所示的结构,包括处理器51、存储器52以及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述程序时可实现实施例一或实施例二中部分或全部步骤。

应用示例

现以GPS和BDS组成的双模系统接收机为例实现基于卡尔曼滤波的多模导航卫星接收机的RAIM算法。观测地点:武汉;观测时间2015年12月20号11时22分42秒。根据卫星电文获得观测到的卫星信息位置和速度。接收机的初始位置的预设值为(-2271601.738,5009144.904,3218832.710)。不同系统下可见卫星(svid为卫星号)及其仰角(单位:度)为:

GPS:svid=1,el=-0.268;svid=3,el=12.0;svid=10,el=29.7;svid=14,el=62.1;svid=16,el=13.0;svid=22,el=40.3;svid=25,el=37.7;svid=26,el=42.8;svid=29,el=19.5;svid=31,el=59.1;svid=32,el=41.3。

BDS:svid=1,el=45.7;svid=3,el=53.9;svid=4,el=29.8;svid=5,el=20.1;svid=6,el=54.9;svid=7,el=70.9;svid=8,el=2.049;svid=9,el=75.8;svid=10,el=55.2svid=11,el=13.7。

设仰角门限为EL=10度,则GPS中svid=1和BDS中svid=8的卫星剔除,还剩余19颗卫星。

卡尔曼滤波的状态方程和观测方程分别为式(15)、式(16):

x

其中,x

为了区分两系统现将观测矩阵H分开写为H

以观测矩阵的行对应的观测量为其变号,对应的观测量测量误差分别为:r

r

r

r

根据上述序贯处理踢星法的流程可得到不满足条件的卫星GPS:svid=16,svid=3;BDS:svid=11,svid=5。

根据虚警率P

本领域普通技术人员可以理解,上文中所公开方法中的全部或某些步骤、系统、装置中的功能模块/单元可以被实施为软件、固件、硬件及其适当的组合。在硬件实施方式中,在以上描述中提及的功能模块/单元之间的划分不一定对应于物理单元的划分;例如,一个物理组件可以具有多个功能,或者一个功能或步骤可以由若干物理组件合作执行。某些组件或所有组件可以被实施为由处理器,如数字信号处理器或微处理器执行的软件,或者被实施为硬件,或者被实施为集成电路,如专用集成电路。这样的软件可以分布在计算机可读介质上,计算机可读介质可以包括计算机存储介质(或非暂时性介质)和通信介质(或暂时性介质)。如本领域普通技术人员公知的,术语计算机存储介质包括在用于存储信息(诸如计算机可读指令、数据结构、程序模块或其他数据)的任何方法或技术中实施的易失性和非易失性、可移除和不可移除介质。计算机存储介质包括但不限于RAM、ROM、EEPROM、闪存或其他存储器技术、CD-ROM、数字多功能盘(DVD)或其他光盘存储、磁盒、磁带、磁盘存储或其他磁存储装置、或者可以用于存储期望的信息并且可以被计算机访问的任何其他的介质。此外,本领域普通技术人员公知的是,通信介质通常包含计算机可读指令、数据结构、程序模块或者诸如载波或其他传输机制之类的调制数据信号中的其他数据,并且可包括任何信息递送介质。

虽然本发明所揭露的实施方式如上,但所述的内容仅为便于理解本发明而采用的实施方式,并非用以限定本发明。任何本发明所属领域内的技术人员,在不脱离本发明所揭露的精神和范围的前提下,可以在实施的形式及细节上进行任何的修改与变化,但本发明的专利保护范围,仍须以所附的权利要求书所界定的范围为准。

去获取专利,查看全文>
获取专利

客服邮箱:kefu@zhangqiaokeyan.com

京公网安备:11010802029741号 ICP备案号:京ICP备15016152号-6 六维联合信息科技 (北京) 有限公司©版权所有
  • 客服微信

  • 服务号