CN108089210A - 一种惯性信息辅助raim检测方法 - Google Patents
一种惯性信息辅助raim检测方法 Download PDFInfo
- Publication number
- CN108089210A CN108089210A CN201611037067.8A CN201611037067A CN108089210A CN 108089210 A CN108089210 A CN 108089210A CN 201611037067 A CN201611037067 A CN 201611037067A CN 108089210 A CN108089210 A CN 108089210A
- Authority
- CN
- China
- Prior art keywords
- msup
- mrow
- msub
- mtd
- mtr
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/20—Integrity monitoring, fault detection or fault isolation of space segment
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/24—Acquisition or tracking or demodulation of signals transmitted by the system
- G01S19/25—Acquisition or tracking or demodulation of signals transmitted by the system involving aiding data received from a cooperating element, e.g. assisted GPS
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/24—Acquisition or tracking or demodulation of signals transmitted by the system
- G01S19/25—Acquisition or tracking or demodulation of signals transmitted by the system involving aiding data received from a cooperating element, e.g. assisted GPS
- G01S19/258—Acquisition or tracking or demodulation of signals transmitted by the system involving aiding data received from a cooperating element, e.g. assisted GPS relating to the satellite constellation, e.g. almanac, ephemeris data, lists of satellites in view
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Computer Security & Cryptography (AREA)
- Automation & Control Theory (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明属于卫星导航接收机信息处理领域,具体一种惯性信息辅助RAIM检测方法,跟踪卫星进行位同步和帧同步,提取帧同步后的数据得到各颗卫星的发射时刻、伪距和星历参数,再确定卫星位置速度,确定载体位置和接收机钟差,确定各颗卫星的惯性辅助的伪距残差,如果惯性辅助伪距残差均方根值超过门限则认为存在故障。采用伪距残差排序后得到的均方根值最小的一组4点组合作为基准值,因此在5颗卫星时,也能够识别出其中的一颗故障卫星。相比于传统算法只有在单系统6颗卫星才能剔除故障星的情况,有效提高了卫星接收机定位的稳定性和可靠性。
Description
技术领域
本发明属于卫星导航接收机信息处理领域,具体涉及一种惯性辅助的自主完好性检测(RAIM)方法。
背景技术
随着卫星导航技术应用领域的多样化,标准定位服务(Standard PositioningService,SPS)已无法满足用户对高精度、高可靠性的需求,这就需要对系统的定位精度、连续性、可用性和完好性有更加严格的要求。完好性是其中具有非常重要意义的指标之一,它是指卫星定位误差超过允许极限的时候,在一定时间内向用户发出告警的能力。从数学本质上来说,完好性就是对系统所提供信息正确性的置信度测量。
当前完好性监测的主要方法分为两种:一种是完好性通道(Integrity Channel,GIC);另一种就是接收机自主完好性监测(Receiver Autonomous Integrity Monitoring,RAIM)。RAIM由于其可以不依赖外部增强系统而独立工作,逐渐成为了完好性监测的主要工作方法和研究热点之一。
接收机自主完好性监测技术涉及两方面的含义,一是故障监测,即卫星是否存在故障;二是故障排除,即将存在故障的卫星剔除,而且其信号也不用于导航解算。前监测算法中效果较好的RAIM算法是利用当前伪距观测的快照方法,包括伪距比较法、最小二乘残差法和奇偶矢量法,这三种方法对于存在一个故障的情况有较好的效果,并且三者的本质是一样的。其中的奇偶矢量法计算是相对比较简单的,故被普遍采用,也被RTCA推荐为基本算法。目前单系统进行完好性监测的RAIM算法都要求可见星数在5颗以上才可以检测出故障星,6颗以上才可以剔除存在故障的卫星。但是由于信号遮掩,易受干扰等各种因素的影响,量测时常常不能提供足够的卫星余度信息,不能满足一般RAIM算法要求,并且单独的RAIM方法并不能很好地为卫星导航提供满足需求的完好性监测。因此,为了定位的满足高精度、高可靠性的要求,需要利用其它辅助系统来增加余度信息,满足冗余条件。目前国内外研究较多的增加冗余信息的卫星导航完好性监测方法是采用多星座组合,比如GPS、GLONASS以及BD2星座的相互组合,虽然在一定程度上增加了完好性监测的手段,但仍然是导航卫星的自主完好性监测,避免不了导航卫星自身的不足。在航空、航天以及武器装备等科技领域,INS通常是必备的导航系统,因此采用惯性辅助进行卫星导航的完好性监测将是具有潜力的方法。
发明内容
本发明的目的是提供一种惯性信息辅助RAIM检测方法,实现在单系统定位、有惯导信息辅助的情况下,故障卫星稳定的剔除,保持定位稳定性。
本发明的技术方案如下:
一种伪距残差确定方法,该方法包括如下步骤:
1)卫星捕获跟踪与同步,跟踪卫星进行位同步和帧同步;
2)提取帧同步后的卫星码NCO、码片计数、1ms计数、位计数、字计数和帧计数,得到完成帧同步后的各颗卫星的发射时刻、伪距和星历参数;
3)确定卫星位置速度;
4)建立联立方程
其中(XJ,YJ,ZJ)为第J颗卫星的空间三维坐标,(XU,YU,ZU)为卫星导航兼容接收机的空间三维坐标,ρJ为伪距,J=1,2...N,N为卫星总数,C为光速,tu为接收机钟差;
5)建立观测观测方程z=Hx+ε
其中x是4×1矢量,分别是(XU,YU,ZU,tu),z是n×1矢量,其元素是伪距测量值与基于在初始位置预测的距离之间的差值,
其中,ε是n×1测量误差矢量;
6)利用下式确定载体位置(XU,YU,ZU)和接收机钟差tU
其中,(XU0,YU0,ZU0)为载体初始位置,对应改正数为tU0为接收机概略钟差,对应改正数为
7)利用下式确定参与解算的各颗卫星的伪距残差r
r=z-H(HTH)-1HTz=[In-H(HTH)-1HT]z
其中In是n×n的单位矩阵;
8)利用下式确定伪距残差r的均方根值,
9)将该值与步骤2)得到的伪距做差,第J颗卫星的惯性辅助伪距残差ΔρJ
其中(XJ,YJ,ZJ)为第J颗卫星的空间三维坐标,(XINS,YINS,ZINS)为惯性辅助得到的本地点坐标;
一种基于伪距残差进行惯性信息辅助RAIM检测方法,包括如下步骤:
1)确定第J颗卫星的惯性辅助伪距残差ΔρJ,J=1,2...N,N为卫星总数;
2)对得到的每颗星的惯性辅助伪距残差由大到小排序,对完成排序后的伪距残差从前到后进行滑动,每4个点分为一组(如1、2、3、4一组,2、3、4、5一组,以此类推),分别计算每组残差均方根值;找出残差均方根值最小的一组,求得该组的平均值,此平均值作为故障识别的门限值;
3)将每颗星的惯性辅助伪距残差与求得的平均值做比较,大于门限的卫星即是有故障的卫星。
本发明的显著效果如下:
卫星导航定位步骤一般包括捕获跟踪、位同步和帧同步、伪距和卫星位置计算以及最小二乘解算载体位置。惯性信息辅助RAIM检测方法在最小二乘解算的基础上增加伪距残差均方根值计算(步骤7和步骤8),如果惯性辅助伪距残差均方根值超过门限则认为存在故障。
一旦判定定位结果存在故障,本方法创新性提出利用惯导辅助的本地坐标以及计算得到的卫星位置求得接收机与卫星之间距离,扣除各颗卫星伪距得到伪距残差(步骤9),将每颗星伪距残差进行由大到小排序,找出残差均方根最小的4点组合,求得该组合的平均值,此平均值作为故障识别的门限值(步骤10),然后将每颗星的伪距残差与求得的平均值做比较,找出超过门限的卫星并剔除(步骤11)。
卫星导航完好性检测方法在单系统定位时,只有6颗卫星才能检测并剔除故障星,而且在存在大于等于2颗故障卫星时,完好性检测方法误警或虚警的概率显著增加。
本发明方法引入惯性信息辅助,通过惯导位置信息求得各颗卫星的惯性辅助伪距残差,由于不受伪距误差的影响,该残差值相比最小二乘解算的伪距残差更为可靠,因此在存在大于等于2颗故障卫星时,本方法可以有效识别多颗故障卫星;同时本方法采用伪距残差排序后得到的均方根值最小的一组4点组合作为基准值,因此在5颗卫星时,也能够识别出其中的一颗故障卫星。相比于传统算法只有在单系统6颗卫星才能剔除故障星的情况,有效提高了卫星接收机定位的稳定性和可靠性。
采用本方法能够实现在单系统有惯性信息辅助的情况下,大于等于5颗参与定位卫星时能够检测是否存在故障卫星,并将故障卫星剔除。相比于传统算法只有在单系统6颗卫星才能剔除故障星的情况,有效提高了卫星接收机定位的稳定性和可靠性。
具体实施方式
下面通过具体实施方式对本发明作进一步说明。
1)卫星捕获跟踪与同步
依次捕获GPS、BD2、GLONASS卫星,跟踪卫星进行位同步和帧同步;
2)提取帧同步后的卫星码NCO、码片计数、1ms计数、位计数、字计数和帧计数,得到完成帧同步后的各颗GPS、BD2、GLONASS卫星的发射时刻、伪距和星历参数;
3)确定卫星位置速度
按照卫星导航接口控制文件(ICD)提供的卫星位置计算方法,输入卫星发射时刻计算得到卫星位置和速度,此部分属于现有技术,不再赘述。
4)根据步骤2)得到的跟踪卫星伪距,以及步骤3)得到的跟踪卫星位置和速度,建立联立方程如下:
其中(XJ,YJ,ZJ)为第J颗卫星的空间三维坐标,(XU,YU,ZU)为卫星导航兼容接收机的空间三维坐标,ρJ为伪距,J=1,2...N,N为卫星总数,C为光速,tu为接收机钟差。
5)根据步骤4)建立观测观测方程z=Hx+ε
其中x是4×1矢量,分别是(XU,YU,ZU,tu),z是n×1矢量,其元素是伪距测量值与基于在初始位置预测的距离之间的差值
ε是n×1测量误差矢量,它可同时包含随机(测距随机抖动)和确定(偏差)项。
6)利用下式确定载体位置(XU,YU,ZU)和接收机钟差tU
其中,(XU0,YU0,ZU0)为载体初始位置,对应改正数为tU0为接收机概略钟差,对应改正数为
7)利用下式确定参与解算的各颗卫星的伪距残差r
r=z-H(HTH)-1HTz=[In-H(HTH)-1HT]z
其中In是n×n的单位矩阵,H和z定义同上。
8)利用下式确定伪距残差r的均方根值,
当超过正常工作时的残差门限时,给出存在故障的告警标志,并进入后续步骤,否则认为计算的载体位置正常,输出正常信息,流程结束。
9)将该值与步骤2)得到的伪距做差,第J颗卫星的惯性辅助伪距残差ΔρJ
其中(XJ,YJ,ZJ)为第J颗卫星的空间三维坐标,(XINS,YINS,ZINS)为惯性辅助得到的本地点坐标;
10)对得到的每颗星的惯性辅助伪距残差由大到小排序,对完成排序后的伪距残差从前到后进行滑动,每4个点分为一组(如1、2、3、4一组,2、3、4、5一组,以此类推),分别计算每组残差均方根值;找出残差均方根值最小的一组,求得该组的平均值,此平均值作为故障识别的门限值;
11)将每颗星的惯性辅助伪距残差与求得的平均值做比较,大于门限的卫星即是有故障的卫星。
Claims (2)
1.一种伪距残差确定方法,其特征在于,该方法包括如下步骤:
1)卫星捕获跟踪与同步,跟踪卫星进行位同步和帧同步;
2)提取帧同步后的卫星码NCO、码片计数、1ms计数、位计数、字计数和帧计数,得到完成帧同步后的各颗卫星的发射时刻、伪距和星历参数;
3)确定卫星位置速度;
4)建立联立方程
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&rho;</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<msup>
<mi>R</mi>
<mn>1</mn>
</msup>
<mrow>
<mo>(</mo>
<msub>
<mi>X</mi>
<mi>U</mi>
</msub>
<mo>,</mo>
<msub>
<mi>Y</mi>
<mi>U</mi>
</msub>
<mo>,</mo>
<msub>
<mi>Z</mi>
<mi>U</mi>
</msub>
<mo>,</mo>
<msub>
<mi>t</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>X</mi>
<mn>1</mn>
</msup>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>Y</mi>
<mn>1</mn>
</msup>
<mo>-</mo>
<msub>
<mi>Y</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>Z</mi>
<mn>1</mn>
</msup>
<mo>-</mo>
<msub>
<mi>Z</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
<mo>+</mo>
<msub>
<mi>Ct</mi>
<mi>u</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&rho;</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<msup>
<mi>R</mi>
<mn>2</mn>
</msup>
<mrow>
<mo>(</mo>
<msub>
<mi>X</mi>
<mi>U</mi>
</msub>
<mo>,</mo>
<msub>
<mi>Y</mi>
<mi>U</mi>
</msub>
<mo>,</mo>
<msub>
<mi>Z</mi>
<mi>U</mi>
</msub>
<mo>,</mo>
<msub>
<mi>t</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>X</mi>
<mn>2</mn>
</msup>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>Y</mi>
<mn>2</mn>
</msup>
<mo>-</mo>
<msub>
<mi>Y</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>Z</mi>
<mn>2</mn>
</msup>
<mo>-</mo>
<msub>
<mi>Z</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
<mo>+</mo>
<msub>
<mi>Ct</mi>
<mi>u</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>...</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&rho;</mi>
<mi>N</mi>
</msub>
<mo>=</mo>
<msup>
<mi>R</mi>
<mi>N</mi>
</msup>
<mrow>
<mo>(</mo>
<msub>
<mi>X</mi>
<mi>U</mi>
</msub>
<mo>,</mo>
<msub>
<mi>Y</mi>
<mi>U</mi>
</msub>
<mo>,</mo>
<msub>
<mi>Z</mi>
<mi>U</mi>
</msub>
<mo>,</mo>
<msub>
<mi>t</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>X</mi>
<mi>N</mi>
</msup>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>Y</mi>
<mi>N</mi>
</msup>
<mo>-</mo>
<msub>
<mi>Y</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>Z</mi>
<mi>N</mi>
</msup>
<mo>-</mo>
<msub>
<mi>Z</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
<mo>+</mo>
<msub>
<mi>Ct</mi>
<mi>u</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
其中(XJ,YJ,ZJ)为第J颗卫星的空间三维坐标,(XU,YU,ZU)为卫星导航兼容接收机的空间三维坐标,ρJ为伪距,J=1,2...N,N为卫星总数,C为光速,tu为接收机钟差;
5)建立观测观测方程z=Hx+ε
其中x是4×1矢量,分别是(XU,YU,ZU,tu),z是n×1矢量,其元素是伪距测量值与基于在初始位置预测的距离之间的差值,
<mrow>
<mi>z</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>...</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>z</mi>
<mi>N</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&rho;</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>X</mi>
<mn>1</mn>
</msup>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>Y</mi>
<mn>1</mn>
</msup>
<mo>-</mo>
<msub>
<mi>Y</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>Z</mi>
<mn>1</mn>
</msup>
<mo>-</mo>
<msub>
<mi>Z</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&rho;</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>X</mi>
<mn>2</mn>
</msup>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>Y</mi>
<mn>2</mn>
</msup>
<mo>-</mo>
<msub>
<mi>Y</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>Z</mi>
<mn>2</mn>
</msup>
<mo>-</mo>
<msub>
<mi>Z</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>...</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&rho;</mi>
<mi>N</mi>
</msub>
<mo>-</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>X</mi>
<mi>N</mi>
</msup>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>Y</mi>
<mi>N</mi>
</msup>
<mo>-</mo>
<msub>
<mi>Y</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>Z</mi>
<mi>N</mi>
</msup>
<mo>-</mo>
<msub>
<mi>Z</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
<mrow>
<mi>H</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msup>
<mi>H</mi>
<mn>1</mn>
</msup>
</mtd>
</mtr>
<mtr>
<mtd>
<msup>
<mi>H</mi>
<mn>2</mn>
</msup>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>...</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<msup>
<mi>H</mi>
<mi>N</mi>
</msup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>a</mi>
<mi>X</mi>
<mn>1</mn>
</msubsup>
</mtd>
<mtd>
<msubsup>
<mi>a</mi>
<mi>Y</mi>
<mn>1</mn>
</msubsup>
</mtd>
<mtd>
<msubsup>
<mi>a</mi>
<mi>Z</mi>
<mn>1</mn>
</msubsup>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>a</mi>
<mi>X</mi>
<mn>2</mn>
</msubsup>
</mtd>
<mtd>
<msubsup>
<mi>a</mi>
<mi>Y</mi>
<mn>2</mn>
</msubsup>
</mtd>
<mtd>
<msubsup>
<mi>a</mi>
<mi>Z</mi>
<mn>2</mn>
</msubsup>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow></mrow>
</mtd>
<mtd>
<mn>...</mn>
</mtd>
<mtd>
<mrow></mrow>
</mtd>
<mtd>
<mrow></mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>a</mi>
<mi>X</mi>
<mi>N</mi>
</msubsup>
</mtd>
<mtd>
<msubsup>
<mi>a</mi>
<mi>Y</mi>
<mi>N</mi>
</msubsup>
</mtd>
<mtd>
<msubsup>
<mi>a</mi>
<mi>Z</mi>
<mi>N</mi>
</msubsup>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
<mrow>
<msubsup>
<mi>a</mi>
<mi>X</mi>
<mi>J</mi>
</msubsup>
<mo>=</mo>
<mrow>
<mo>(</mo>
<msup>
<mi>X</mi>
<mi>J</mi>
</msup>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>/</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>X</mi>
<mi>J</mi>
</msup>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>Y</mi>
<mi>J</mi>
</msup>
<mo>-</mo>
<msub>
<mi>Y</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>Z</mi>
<mi>J</mi>
</msup>
<mo>-</mo>
<msub>
<mi>Z</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mrow>
<mrow>
<msubsup>
<mi>a</mi>
<mi>Y</mi>
<mi>J</mi>
</msubsup>
<mo>=</mo>
<mrow>
<mo>(</mo>
<msup>
<mi>Y</mi>
<mi>J</mi>
</msup>
<mo>-</mo>
<msub>
<mi>Y</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>/</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>X</mi>
<mi>J</mi>
</msup>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>Y</mi>
<mi>J</mi>
</msup>
<mo>-</mo>
<msub>
<mi>Y</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>Z</mi>
<mi>J</mi>
</msup>
<mo>-</mo>
<msub>
<mi>Z</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mrow>
<mrow>
<msubsup>
<mi>a</mi>
<mi>Z</mi>
<mi>J</mi>
</msubsup>
<mo>=</mo>
<mrow>
<mo>(</mo>
<msup>
<mi>Z</mi>
<mi>J</mi>
</msup>
<mo>-</mo>
<msub>
<mi>Z</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>/</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>X</mi>
<mi>J</mi>
</msup>
<mo>-</mo>
<msub>
<mi>X</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>Y</mi>
<mi>J</mi>
</msup>
<mo>-</mo>
<msub>
<mi>Y</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>Z</mi>
<mi>J</mi>
</msup>
<mo>-</mo>
<msub>
<mi>Z</mi>
<mi>U</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mrow>
其中,ε是n×1测量误差矢量;
6)利用下式确定载体位置(XU,YU,ZU)和接收机钟差tU
其中,(XU0,YU0,ZU0)为载体初始位置,对应改正数为tU0为接收机概略钟差,对应改正数为
7)利用下式确定参与解算的各颗卫星的伪距残差r
r=z-H(HTH)-1HTz=[In-H(HTH)-1HT]z
其中In是n×n的单位矩阵;
8)利用下式确定伪距残差r的均方根值,
<mrow>
<mi>&sigma;</mi>
<mo>=</mo>
<msqrt>
<mfrac>
<mrow>
<msup>
<mi>r</mi>
<mi>T</mi>
</msup>
<mi>r</mi>
</mrow>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>4</mn>
</mrow>
</mfrac>
</msqrt>
</mrow>
9)将该值与步骤2)得到的伪距做差,第J颗卫星的惯性辅助伪距残差ΔρJ
<mrow>
<msub>
<mi>&Delta;&rho;</mi>
<mi>J</mi>
</msub>
<mo>=</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>X</mi>
<mi>J</mi>
</msup>
<mo>-</mo>
<msub>
<mi>X</mi>
<mrow>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>Y</mi>
<mi>J</mi>
</msup>
<mo>-</mo>
<msub>
<mi>Y</mi>
<mrow>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>Z</mi>
<mi>J</mi>
</msup>
<mo>-</mo>
<msub>
<mi>Z</mi>
<mrow>
<mi>I</mi>
<mi>N</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
<mo>-</mo>
<msub>
<mi>&rho;</mi>
<mi>J</mi>
</msub>
</mrow>
其中(XJ,YJ,ZJ)为第J颗卫星的空间三维坐标,(XINS,YINS,ZINS)为惯性辅助得到的本地点坐标;
2.一种基于伪距残差进行惯性信息辅助RAIM检测方法,其特征在于,包括如下步骤:
1)确定第J颗卫星的惯性辅助伪距残差ΔρJ,J=1,2...N,N为卫星总数;
2)对得到的每颗星的惯性辅助伪距残差由大到小排序,对完成排序后的伪距残差从前到后进行滑动,每4个点分为一组,分别计算每组残差均方根值;找出残差均方根值最小的一组,求得该组的平均值,此平均值作为故障识别的门限值;
3)将每颗星的惯性辅助伪距残差与求得的平均值做比较,大于门限的卫星即是有故障的卫星。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611037067.8A CN108089210A (zh) | 2016-11-23 | 2016-11-23 | 一种惯性信息辅助raim检测方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611037067.8A CN108089210A (zh) | 2016-11-23 | 2016-11-23 | 一种惯性信息辅助raim检测方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN108089210A true CN108089210A (zh) | 2018-05-29 |
Family
ID=62168687
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611037067.8A Pending CN108089210A (zh) | 2016-11-23 | 2016-11-23 | 一种惯性信息辅助raim检测方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108089210A (zh) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109728868A (zh) * | 2018-11-27 | 2019-05-07 | 中国科学院光电研究院 | 一种基于多重完好性检验的gnss基站组网时间同步方法 |
CN110879407A (zh) * | 2019-12-12 | 2020-03-13 | 北京眸星科技有限公司 | 一种基于完好性风险模型的卫星导航观测量新息检测方法 |
CN111060133A (zh) * | 2019-12-04 | 2020-04-24 | 南京航空航天大学 | 一种用于城市复杂环境的组合导航完好性监测方法 |
CN111142128A (zh) * | 2018-11-02 | 2020-05-12 | 千寻位置网络有限公司 | 导航完好性的监测方法及装置、无人机 |
CN111142125A (zh) * | 2018-11-02 | 2020-05-12 | 千寻位置网络有限公司 | 一种卫星完好性监测方法和系统 |
CN112505728A (zh) * | 2020-12-10 | 2021-03-16 | 中电科西北集团有限公司 | 时间完好性监测方法 |
US10976440B2 (en) * | 2018-08-03 | 2021-04-13 | Realtek Semiconductor Corporation | Method of positioning a device, positioning device and non-transitory computer readable medium |
CN113253321A (zh) * | 2021-04-14 | 2021-08-13 | 长沙学院 | 一种适用于接收机时间误差为秒级的agps定位方法 |
CN114114351A (zh) * | 2022-01-24 | 2022-03-01 | 浙江时空道宇科技有限公司 | 卫星导航测量故障的排除方法、装置、设备及存储介质 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6204806B1 (en) * | 1999-02-26 | 2001-03-20 | Rockwell Collins, Inc. | Method of enhancing receiver autonomous GPS navigation integrity monitoring and GPS receiver implementing the same |
CN101629997A (zh) * | 2009-07-24 | 2010-01-20 | 南京航空航天大学 | 惯性辅助卫星导航完好性检测装置及检测方法 |
EP1729145B1 (en) * | 2005-06-02 | 2013-08-07 | GMV Aerospace and Defence S.A. | Method and system for providing GNSS navigation position solution with guaranteed integrity in non-controlled environments |
-
2016
- 2016-11-23 CN CN201611037067.8A patent/CN108089210A/zh active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6204806B1 (en) * | 1999-02-26 | 2001-03-20 | Rockwell Collins, Inc. | Method of enhancing receiver autonomous GPS navigation integrity monitoring and GPS receiver implementing the same |
EP1729145B1 (en) * | 2005-06-02 | 2013-08-07 | GMV Aerospace and Defence S.A. | Method and system for providing GNSS navigation position solution with guaranteed integrity in non-controlled environments |
CN101629997A (zh) * | 2009-07-24 | 2010-01-20 | 南京航空航天大学 | 惯性辅助卫星导航完好性检测装置及检测方法 |
Non-Patent Citations (2)
Title |
---|
娄上月 等: "接收机自主完好性监测技术研究", 《导航定位与授时》 * |
蒋德杰: "基于惯性辅助卫星导航完好性监测研究", 《中国优秀硕士学位论文全文数据库信息科技辑》 * |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10976440B2 (en) * | 2018-08-03 | 2021-04-13 | Realtek Semiconductor Corporation | Method of positioning a device, positioning device and non-transitory computer readable medium |
CN111142128A (zh) * | 2018-11-02 | 2020-05-12 | 千寻位置网络有限公司 | 导航完好性的监测方法及装置、无人机 |
CN111142125A (zh) * | 2018-11-02 | 2020-05-12 | 千寻位置网络有限公司 | 一种卫星完好性监测方法和系统 |
CN109728868A (zh) * | 2018-11-27 | 2019-05-07 | 中国科学院光电研究院 | 一种基于多重完好性检验的gnss基站组网时间同步方法 |
CN109728868B (zh) * | 2018-11-27 | 2020-10-13 | 中国科学院光电研究院 | 一种基于多重完好性检验的gnss基站组网时间同步方法 |
CN111060133A (zh) * | 2019-12-04 | 2020-04-24 | 南京航空航天大学 | 一种用于城市复杂环境的组合导航完好性监测方法 |
CN110879407A (zh) * | 2019-12-12 | 2020-03-13 | 北京眸星科技有限公司 | 一种基于完好性风险模型的卫星导航观测量新息检测方法 |
CN110879407B (zh) * | 2019-12-12 | 2023-08-18 | 北京眸星科技有限公司 | 一种基于完好性风险模型的卫星导航观测量新息检测方法 |
CN112505728A (zh) * | 2020-12-10 | 2021-03-16 | 中电科西北集团有限公司 | 时间完好性监测方法 |
CN112505728B (zh) * | 2020-12-10 | 2024-03-22 | 中电科西北集团有限公司 | 时间完好性监测方法 |
CN113253321A (zh) * | 2021-04-14 | 2021-08-13 | 长沙学院 | 一种适用于接收机时间误差为秒级的agps定位方法 |
CN114114351A (zh) * | 2022-01-24 | 2022-03-01 | 浙江时空道宇科技有限公司 | 卫星导航测量故障的排除方法、装置、设备及存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108089210A (zh) | 一种惯性信息辅助raim检测方法 | |
CN109521443B (zh) | 一种探测星历异常的方法 | |
CN108508461B (zh) | 基于gnss载波相位高精度定位完好性监测方法 | |
CN110007317B (zh) | 一种选星优化的高级接收机自主完好性监测方法 | |
Castaldo et al. | P‐RANSAC: An Integrity Monitoring Approach for GNSS Signal Degraded Scenario | |
CN111060133B (zh) | 一种用于城市复杂环境的组合导航完好性监测方法 | |
CN101866009B (zh) | 一种适用于卫导系统缺星情况下的完好性监测方法 | |
EP3356856A2 (en) | Monitor based ambiguity verification for enhanced guidance quality | |
CN108196281A (zh) | 一种基于位置域曲线约束的单频动态周跳探测与修复方法 | |
JP2002520625A (ja) | Gps信号障害隔離モニタ | |
CN105487088A (zh) | 一种卫星导航系统中基于卡尔曼滤波的raim算法 | |
CN105549033A (zh) | 一种基于最小二乘残差边缘检验的完好性处理方法 | |
CN109031356B (zh) | 特征斜率加权的最小二乘残差接收机自主完好性监测方法 | |
WO2021052511A1 (zh) | 北斗机载设备raim性能符合性测试方法及系统 | |
CN104020482B (zh) | 一种高动态卫星导航接收机精确测速方法 | |
CN104199051A (zh) | 一种卫星导航raim多星故障检测与识别方法 | |
CN105116391A (zh) | 面向海用雷达误差标定的有效目标序列集联合分析方法 | |
CN107783154A (zh) | 一种接收机自主完好性故障检测及排除方法 | |
CN105511481A (zh) | 一种星载定轨优化方法 | |
US7868822B2 (en) | Method and apparatus for determining an integrity risk in a satellite reference system | |
CN106483533A (zh) | 一种惯性信息辅助raim检测方法 | |
CN113589331A (zh) | 静态导航欺骗干扰源的定位装置、系统及方法 | |
CN112198533A (zh) | 一种多假设下的地基增强系统完好性评估系统及方法 | |
CN113341438B (zh) | 一种基于粗差反解的多星故障识别方法及系统 | |
CN115062097A (zh) | 一种定位完好性监测方法、终端及计算机存储介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20180529 |