CN101395443A - 混合定位方法和设备 - Google Patents

混合定位方法和设备 Download PDF

Info

Publication number
CN101395443A
CN101395443A CNA2007800074677A CN200780007467A CN101395443A CN 101395443 A CN101395443 A CN 101395443A CN A2007800074677 A CNA2007800074677 A CN A2007800074677A CN 200780007467 A CN200780007467 A CN 200780007467A CN 101395443 A CN101395443 A CN 101395443A
Authority
CN
China
Prior art keywords
data
delayed
range data
satellite
storer
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.)
Granted
Application number
CNA2007800074677A
Other languages
English (en)
Other versions
CN101395443B (zh
Inventor
J·-P·佩蒂珑
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Airbus Helicopters SAS
Original Assignee
Airbus Helicopters SAS
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Airbus Helicopters SAS filed Critical Airbus Helicopters SAS
Publication of CN101395443A publication Critical patent/CN101395443A/zh
Application granted granted Critical
Publication of CN101395443B publication Critical patent/CN101395443B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/45Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
    • G01S19/47Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; 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/16Navigation; 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
    • G01C21/165Navigation; 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 combined with non-inertial navigation instruments
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/01Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13Receivers
    • G01S19/20Integrity monitoring, fault detection or fault isolation of space segment
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/40Correcting position, velocity or attitude
    • G01S19/41Differential correction, e.g. DGPS [differential GPS]
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/48Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
    • G01S19/49Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an inertial position system, e.g. loosely-coupled

Abstract

本发明涉及通过将惯性数据同飞行器与卫星之间距离的数据相组合来确定飞行器位置的方法,其中:a)将距离数据存储在FIFO存储器中,从而在存储器的输出处有经延迟的距离数据可用;b)将经延迟的距离数据与惯性数据相组合,以获得对飞行器的位置数据的估计;以及c)监视距离数据中差错的出现,并当检测到这样的差错时,修正存储在FIFO存储器中的数据中的至少一些以使得差错被中和。

Description

混合定位方法和设备
本发明涉及一种混合定位方法和设备。
本发明的技术领域是制造直升飞机上机载的导航系统的技术领域。
本发明尤其涉及将惯性测量同与涉及承载该设备的移动体(尤其是旋翼飞机)和卫星之间距离的数据相组合的导航和/或定位方法及设备。
在本申请的用意中,并且在没有显性的或隐性指示相反意思时,术语“测量”、“数据”、“信号”、和它们的派生词被认为是等效的,并且术语“组合”、“混合”、“耦合”、和它们的派生词同样被认为是等效的。
一般而言,GPS接收机包括四个主要版块或模块:
- 第一模块是HF头(也称为“RF前端”)并且它对由GPS接收机的天线拾取的信号进行前置放大,并执行变频;
- 第二模块是为其它模块提供精确时间和频率基准的时钟;由于时钟的精确性并不是绝对的,因此其时间和频率误差藉由偏离来建模;
- 第三模块是信号处理器模块,其解码来自卫星的导航消息,以提供有24颗卫星的星座的历书;此第一类数据对应于给出24颗卫星的位置(或三维向量 p → SVi = x Svi y SVi z SVi T , 其中i=1到24);假定精确地知道时间,则这就构成计算这24个位置所需的数据;该模块也测量已接收到的信号来自视野中的那些卫星的传播时间,其中这类信号的数目或信道的数目(NCH)可变,并使用这些信号来计算与相应各测得的传播历时对应的距离;影响这些测量的公偏对应于时钟的偏移,并且可能等量于几千公里;如此确定的距离一般被称为“伪距”;在本申请中,除非显性或隐性地指示相反意思,否则术语“距离”和“伪距”可互换地用来指代由该接收机模块交付的距离数据;一些接收机还交付此量值的导数的测量(“伪距离”速率);以及
- 用于“计算导航解”的第四模块求解以下方程组:
ri 2=(xi-x)2+(yi-y)2+(zi-z)2+Ct
i=1-NCH,并且其中 p → = x y z T 是天线的位置,t是时钟的偏移,而C是光速;这里有四个未知量(x,y,z,t),因此求解此方程组需要四个标量方程;当接收机信道的数目超过4时,过剩的数据被用来减小误差并增加完好性,例如通过使用最小二乘法以及通过检出偏离总走向的点来实现。
此版块由此交付针对偏离作了修正的接收机位置和时间,并且在恰当的场合还交付移动体的位置的导数——即承载体的速度的测量。
已知通过使用Kalman滤波器,可将这类相对于卫星的距离数据与由移动体机载的惯性单元交付的惯性数据相组合,从而来确定移动体的位置,例如在苏黎士ETH 
Figure A200780007467D0006110227QIETU
的测地学和摄影测绘学研究所的文献“GPS and INS integrationwith Kalman filtering for direct geo-referencing of airborne imagery(将GPS和INS与Kalman滤波整合用于空中影像的直接地理连测)”中所描述的那样。
下文使用的常用简称的含义概括如下:
AAIM:飞行器自主完好性监视;
AFCS:自动飞行控制系统;
ARAS:基于飞行器的增强系统;
EGNOS:欧洲对地静止导航叠加系统;
FIFO:先进先出;
FMS:飞行管理系统;
GBAS:基于地面的增强系统;
GNSS:全球导航卫星系统;
GPS:全球定位系统;
INS:惯性系统;
PVT:位置、速度、时间;
RAIM:接收机自主完好性监视;
SBAS:基于空间的增强系统;
TTA:警告时间;
VCO:压控振荡器;
WAAS:广域增强系统。
本发明的具体目的是使GNSS中的故障被钝化并使混合GNSS/INS定位和/或导航系统能在自愈模式下继续工作。
在基于卫星的导航系统当中,在1970年代的使得能以公里级精度每90分钟一次地确定位置的“过渡性”卫星系统之后,出现了传送“明码”信号——也就是称为“粗捕获”(C/S)信号——的GPS导航系统。
这种系统主要的局限是它缺乏完好性。首先卫星的故障率是10-4每小时(h-1)的数量级。其次,GPS卫星并不相互通信并因此不彼此相互监视。最后,GPS系统的地面段不够密集,因此不足以提供对星座的连续监视。故障率因此很高,并且向最终用户通知故障所需的时间可达几个小时。这两个特征使GPS按其实际情况不能用在诸如确定仪表飞行规则状态(IFR)下的民航飞行器的位置等的应用中。
依靠视野中的卫星之间的冗余度,RAIM仅提供一种针对这种处境部分的弥补方案。当至少有五颗卫星被RAIM接收机拾取到并处理时,接收机能生成多个PVT解,将它们彼此进行比较,并当检测到失配时向用户通知异常。如果有五颗以上的卫星在被处理,则接收机可定位并排除已出故障的卫星。
其缺点在于这种类型的监视导致得到令精确进场不能实现可能的保护半径和有百米的警告半径。
SBAS的目的是至少部分地缓解这些局限性。SBAS包括由监视GPS星座的可视部分的地面站构成的大陆网络。对由该网络采集到的数据的实时处理用来标识出来自诸可视GPS卫星中的每一颗的误差,以足以使得在大陆上所议的任何点可能作出精确进场的三维分辨率来标识出由于电离层传播延迟在每个点上导致的误差。
由对地静止卫星构成的空间段能充当用于将修正信息和与GPS星座的健康状态有关的信息传送至最终用户的接收机的中继;这类对地静止卫星还充当额外的导航数据源,这是由于它们传送与来自GPS卫星的相同的导航消息。
通过十米数量级的所谓“10-7”保护半径(20米的垂直保护阈值在99.9%的时间可用),通过遵循Do229标准在检测和信令通知故障中有不超过6秒的TTA延迟,这些改进和添加使得能够达成米数量级的精度(在三维中)。
给定部署的大陆尺寸和对地静止卫星传送的信号的带宽限制,信息的处理和传递不可能是即时的。
在监测故障和通知最终用户当中的TTA延迟构成SBAS的成本因素之一。
Journal of Global Positioning Systems(全球定位系统期刊)2003第二卷第二号126-134页中由Charles S.Dixon所著的文献“GNSS local component integrityconcepts(GNSS本地组件完好性概念)”涉及缩减此延迟的长度的手段。
6秒的TTA值是回转率(航向变化率)不超过约3度每秒(3°/s)且其横摇角变化率被限制在约4°/s的飞行器所能接受的最大值。
然而,在陡坡度和低速度进场上的直升飞机的稳定性比以150节行驶在3°的ILS坡度上的客机差很多,因此直升飞机上机上必须实现具有远高于客机的4°/s—3°/s限制所强加的权威性的领航关系,而这与通常的TTA值是不兼容的。
因此,对于旋翼飞机和靶机而言可能是有用的导航数据源的SBAS(WAAS或EGNOS)并不适用于这些类型的飞行器。
本发明通过尤其使钝化SBAS检测到的GPS卫星故障变得可能、将检测和信令通知故障当中的延迟(TTA)缩减至零、并在SBAS完全失效的情况下提供自愈模式,从而解决这个问题。
本发明的另一目的是提出一种机载的或适于飞行器机载用来通过将伪距与其它测量——尤其是惯性测量——混合来确定其位置的系统,该系统是改良的和/或至少部分地弥补这类系统的短处和缺陷。
根据本发明的一个方面,卫星定位数据在被交付给用于将该数据与非卫星定位数据混合的模块之前先被暂存,并且在检测到差错信号的情况下,暂存的卫星数据中至少有一些被修正。
在本发明的另一方面,提供了一种通过将惯性数据
Figure A200780007467D00081
同有关移动体与卫星之间的距离的数据
Figure A200780007467D00082
相组合来定位该移动体的方法,该方法包括下列步骤:
a)将距离数据存储在在FIFO存储器中以在存储器的输出处有经延迟的距离数据可用;
b)将经延迟的距离数据与惯性数据相组合以获得对移动体位置数据的估计;以及
c)监视距离数据中差错的出现,并且当检测到这样的差错时,修正存储在FIFO存储器中的数据中的至少一些以中和(钝化)这些数据,即降低或消去其在组合操作中的权重(或贡献)。
根据本发明的有利特征:
- 将估计卫星距离数据
Figure A200780007467D00091
作为惯性数据的函数和作为卫星历书的函数存储在第二FIFO存储器(13)中,从而在所述存储器的输出处有经延迟的估计可用,这两个FIFO存储器的容量相等以使得经延迟的估计的最大延迟值与经延迟的距离数据的最大延迟值相同;
- 组合操作可包括修正操作,所述修正操作包括从经延迟的距离数据减去经延迟的作为惯性数据的函数的距离数据估计,并用可为常量或变量的增益(K)对所述减法的结果加权(滤波);该增益可以是作为影响距离数据的误差的先验协方差(R)的函数计算得到的;
- 最大延迟值是1秒到6秒的数量级;
- 存储和组合操作可以至少0.5赫兹(Hz)数量级——尤其是在0.5Hz到5Hz数量级、或者在1Hz到10Hz数量级——的频度(以规律的时间间隔)执行;
- 每个FIFO存储器可用来存储多个相继的数据向量
Figure A200780007467D00092
,尤其是存储至少约10个向量;对于每个接收信道(即卫星),每个距离数据向量
Figure A200780007467D00093
一般包括伪距测量以及影响该测量的误差的方差;
- 为了中和存储在第一FIFO存储器中的数据,可降低与所述数据相关联的置信度,也就是使误差协方差矩阵的逆减小或归零,和/或增大与所述数据相关联的误差协方差(尤其是设定在非常高的值)。
在本发明的另一方面,提出一种机载或适于飞行器机载的飞行器位置确定设备,该设备包括:
- 惯性单元,用来交付惯性数据;和/或
- 卫星距离接收机单元,用来交付距离数据;
- 混合单元,其连接于惯性单元以接收惯性数据并且连接于卫星距离接收机单元以接收距离数据,所述混合单元交付作为惯性数据和距离数据的函数的估计位置数据;
- FIFO存储器,其与距离接收机单元和混合单元耦合(插入在两者之间),用来向混合单元交付经延迟的距离数据;以及
- 中和单元,其响应于关于距离数据的差错数据并被安排在所述差错数据出现时修正存储在存储器中的距离数据的至少一部分。
根据该设备的有利特征;
- 混合单元可包括:
- 估计器单元,其交付从惯性数据、来自接收机的估计位置数据、和卫星位置数据(历书)计算得到的距离估计;
- 第二FIFO存储器,其被安排存储距离估计并输出经延迟的估计距离数据;
- 修正单元,其包括被安排从由第一FIFO存储器交付的经延迟距离数据减去经延迟的估计距离数据的减法单元;以及
- 增益(K)运算器,其被安排对由减法单元提供的数据加权;
- 混合单元可包括递归滤波器,尤其是Kalman滤波器;并且
- 中和单元可连接于距离接收机单元以接收差错数据。
本发明可由飞行器机载或适于飞行器机载的计算机的处理器实现,该计算机一旦检测到出错,就执行包括与本发明的方法的步骤对应的指令的程序。
因此,在本发明的一个方面,提供一种程序,其包括可由飞行器计算机使用来通过将惯性数据同有关飞行器与卫星之间的距离的距离数据
Figure A200780007467D00102
相组合来确定飞行器的位置的代码,所述代码包括:
a)将距离数据存储在FIFO存储器中以在存储器的输出处有经延迟的距离数据可用;
b)将经延迟的距离数据与惯性数据组合以得到对飞行器位置数据的估计
Figure A200780007467D00103
c)监视距离数据中差错(SV #i)的出现,并且当检测到差错时,修正存储在FIFO存储器中的数据中的至少一部分以使其在组合操作中的权重减小或归零;以及
d)将卫星距离数据估计
Figure A200780007467D00104
作为惯性数据的函数存储于第二FIFO存储器中,以在所述存储器的输出处有经延迟的估计可用,这两个FIFO存储器的容量相等以使得经延迟的估计中的最大延迟值与经延迟的距离数据中的最大延迟值相同。
本发明使得能够以与卫星故障相同的方式来钝化GPS接收机故障,由此使得能够对内建测试周期使用更长的历时,并且使得能够避免安装第二接收机。
本发明的其它方面、特征、和优势在以下说明中呈现,以下说明参照示出不带任何限定性特征的本发明优选实施例的附图。
图1是示出本发明系统中的第二寄存器的结构及其与系统的其它模块的连接的图。
图2是示出常规的包括Kalman滤波器的混合GPS/惯性设备或系统的架构的图。
图3是常规的混合系统中的滤波器增益计算和协方差计算模块的框图。
图4是示出根据本发明的混合GPS/惯性设备或系统的架构的图。
本发明基于对由GPS-SBAS接收机执行的测量加以隔离达长到足以保证其无误的历时(即,对于遵循Do229标准的SBAS是6秒期间)。这种隔离是由插在GPS-SBAS接收机11的输出与Kalman滤波器12之间(参看图4)的移位寄存器10(或FIFO存储器)执行的。
给定未曾设想在6秒“旧”的信息的基础上导航飞行器,该设备将GPS-SBAS测量与惯性测量混合。通过安装第二移位寄存器13(或FIFO存储器)以将惯性数据延迟达与GPS-SBAS数据相同的历时,就使得呈无延迟的混合惯性/距离数据(向量的分量)在第二寄存器的上游可用。另外,第二移位寄存器被视为状态机,从而使得GPS-SBAS接收机构成应用了Kalman滤波器技术的特殊动态观察器。
图4中所示设备包括两个移位寄存器:用于GPS数据的第一寄存器10;以及用于惯性数据的第二寄存器13;第二寄存器配备了中间输入e0-e59,如图1所示其使得Kalman滤波器能控制该寄存器的所有状态(借助于向量c),图1中60个标记了z-1的版块D0-D59是个体的延迟运算器,各自为同样多的状态。
图2是示出常规的包括Kalman滤波器的混合GPS/惯性设备或系统的架构的图。
该系统包括虚拟平台(VPF)的综合表示,其中:
Figure A200780007467D00111
是惯性测量(即构成在承载体参照系中对飞行器的加速度
Figure A200780007467D00112
和角速度
Figure A200780007467D00113
测量的两个3D向量的集合);
- 标记了“z-1”或“D”的运算器是个体的延迟运算器;这种作用于向量的运算器对应于n个标量延迟运算器;
- F、H和B是该虚拟平台的特征矩阵(其状态表示的矩阵);矩阵H的计算涉及所有卫星的位置;
Figure A200780007467D00121
是对过程的状态向量的估计,即至少是由三个欧拉角、三个速度分量、三个位置分量、以及GPS接收机时钟的偏离构成的集合。通常,
Figure A200780007467D00122
还包括与回转仪、加速度计、和VCO的建模误差对应的马尔可夫状态;例如,给定有总共24维的向量
Figure A200780007467D00123
,则每轴每传感器两个附加状态,用于建模偏离和1/f噪声;
Figure A200780007467D00124
是估计离卫星的伪距的向量。
尽管虚拟平台不是线性过程,但这种表示对于影响测量即影响对最优混合有意义的量的误差是有效的。
这种表示示出虚拟平台接收六个“捷联式”惯性测量作为输入,并交付对承载体的状态向量的估计作为输出,并且其可被局部线性化。
图中所示的其它要素是:
- K,Kalman增益;以及
,测得的离卫星的伪距的向量(这些测量来自GPS-SBAS接收机)。
该图代表下列方程:
x → ^ i + 1 | i = F x → ^ i + B u →            (预测)
x → ^ i + 1 | i + 1 = K ( r → ^ m + H x → ^ i + 1 | i )       (修正)
r → ^ = H x → ^ i + 1
如果影响测得的伪距测量和惯性测量的误差为白噪声,如果R是影响伪距测量的误差的协方差矩阵,并且如果U是影响惯性测量的误差的协方差矩阵,则影响承载体状态估计
Figure A200780007467D00129
的误差的Kalman增益K和协方差矩阵X是由系统使用下列非线性递归方程来确定的:
Xk+1|k=FXk|kFT+BUBT
K=Xk+1kHT(HXk+1|kHT+R)-1
Xk+1|k+1=(I-KH)Xk+1|k
与该系统对应的图示出于图3中。
本发明的对观察“加以隔离”的混合系统的表示示出于图4中。
滤波器的功能在GPS-SBAS系统的情形中是基于在测量设备中检测到故障所花费的时间的有界本质。举例而言,该时间对于遵循Do229的SBAS系统而言最多为6秒。
为了避免VPF受有误GPS-SBAS测量的任何污染,如由GPS-SBAS接收机计算出的伪距测量及对其方差的先验估计被“隔离”在移位寄存器10中,该移位寄存器10具有确保通过寄存器所花费的时间与规定的最大检测延迟一致(或稍大)所需数目的n级;举例而言,对于10Hz频度交付数据并具有6秒TTA的GPS-SBAS接收机,选择具有60级(6×10)的寄存器。
在检测到卫星Si出故障的情况下,如由信号DSi所指示的(图4),所有来自该卫星并包含在处在接收机11的输出处的移位寄存器10的各级中的伪距测量均被接收信号DSi的中和模块15标记为无效(即它们的方差被强制为无穷值)。
这些无穷方差测量因此被滤波器12忽略,滤波器12同时继续对与其它卫星有关的测量加以利用并提供具有额定精度(或在卫星数目仍保持足够的前提下几乎不降级)的有效位置测量。
在信号DSi消失后,在其后有效数据离开存储器的时间(例如1秒)取决于寄存器10的深度(级数)和迭代计算的频度。
在定位系统完全故障(包括接收机出故障)的情况下,来自所有卫星的所有数据都被标记为无效,且滤波器对任何观察皆不加以利用并且交付纯惯性的(工作在开环)而且尚未受污染的位置。
最优滤波器是通过应用构成并内联过程及其监测手段的模拟所需的已知规则来确定的。因此将第二移位寄存器13以与置于GPS-SBAS接收机的输出处的寄存器(11)对称的方式设置在VPF的输出处。该移位寄存器的各级有与Kalman滤波器一样多的附加状态(对于以1Hz并以6秒TTA交付测量的12信道GPS接收机有6×12=72个状态)。这些状态需要由滤波器控制,由此得到图4框图中从增益K至移位寄存器13的环路
Figure A200780007467D00131
其输入写成e且输出写成s的移位寄存器的两个相继状态(与索引为k和(k +1)的两次迭代对应)之间的关系可以写成下列形式:
d 0 d 1 · · · d n - 2 d n - 1 k + 1 = e d 0 · · · d n - 3 d n - 2 k = 0 0 · · · 0 0 1 0 · · · 0 0 · · · · · · · · · · · · · · · 0 0 · · · 0 0 0 0 · · · 1 0 d 0 d 1 · · · d n - 2 d n - 1 k + 1 0 · · · 0 0 e
s = 0 0 · · · 0 1 d 0 d 1 · · · d n - 2 d n - 1 k + 1
或者以更紧凑的形式写成:
d ‾ k + 1 = F F d ‾ k + B F e
s = H F d ‾ k + 1
其中FF、BF和HF是基本上由大量0和少量1构成的互连矩阵,其中1首先对应于移位寄存器的“总”输入与寄存器的第一级的输入之间的连接,其次对应于一级的输出与下一级的输入之间的连接,最后对应于寄存器末级的输出与移位寄存器的“总”输出之间的连接。
配备有其移位寄存器的平台可由下列方程转写:
x → ^ k + 1 d ‾ k + 1 = F 0 B F HF F F x → ^ k d ‾ k + B B F HB u ‾
r → ^ d = 0 H F x → ^ k d ‾ k
使用下列注记:
x → ^ = x ‾ ^ d ‾ ,
Figure A200780007467D00146
以及
Figure A200780007467D00148
         
可将其写成:而这就可象任何其它Kalman滤波器那样来进行处理。
在本发明的方法中,要计算以供使用的向量和矩阵的维数增加。例如,对以6秒TTA并以1Hz提供12个位置分量的GPS接收机而言,这提供12×6×1=72个附加状态。因此,本发明所实现的滤波器可具有数十或数百个状态。
然而,由于所处理的矩阵基本是“空”的,因此一般不必为所有这些元素提供存储,也不必系统地处理这些矩阵和这些向量的所有元素。
惯性/GPS耦合可以是紧耦合或松耦合;对于松耦合,可使用由GPS接收机交付的位置数据,在恰当的场合还有速度数据;对于紧耦合,可使用由GPS接收机交付的伪距数据,在恰当的场合还有伪速度数据。
本发明的系统可包括气压高度传感器、磁力计、和/或空速传感器,以及用来将这些传感器所交付的测量与卫星距离测量组合并在适当的场合还与惯性测量组合的混合手段。由此可将卫星位置数据与空中(相对空气的)飞行器速度的测量、航向和磁场测量、和/或高度、和/或大气压测量相组合。

Claims (17)

1.一种通过将惯性数据
Figure A200780007467C00021
同关于移动体与卫星之间的距离的数据
Figure A200780007467C00022
相组合来定位所述移动体的方法,所述方法的特征在于下列步骤:
a)将所述距离数据存储在FIFO存储器(10)中,从而在所述存储器的输出处有经延迟的距离数据可用;
b)将所述经延迟的距离数据与所述惯性数据相组合以获得对所述移动体的位置数据的估计;以及
c)监视所述距离数据中差错(DSi)的出现,并且当检测到这样的差错时,修正存储在所述FIFO存储器中的数据中的至少一些以减小或消除其在所述组合操作中的权重。
2.如权利要求1所述的方法,其特征在于,估计卫星距离数据作为惯性数据的函数并作为卫星历书的函数被存储在第二FIFO存储器(13)中,以在所述存储器的输出处有经延迟的估计可用,所述两个FIFO存储器的容量相等,以使得所述经延迟的估计的最大延迟值与所述经延迟的距离数据的最大延迟值相同。
3.如权利要求2所述的方法,其特征在于,所述组合操作包括从所述经延迟的距离数据减去经延迟的作为所述惯性数据的函数的距离数据估计,并对所述减法的结果进行加权。
4.如权利要求3所述的方法,其特征在于,所述加权增益(K)是常量。
5.如权利要求3所述的方法,其特征在于,所述加权增益(K)是变量。
6.如权利要求5所述的方法,其特征在于,所述加权增益是作为影响所述距离数据的误差的先验协方差(R)的函数并作为所述星座的几何的函数来计算的。
7.如权利要求2-6任何一项所述的方法,其特征在于,所述最大延迟的值为1秒到6秒的数量级。
8.如权利要求1-7任何一项所述的方法,其特征在于,所述存储和组合操作是以至少0.5Hz或至少1Hz数量级的频度以规律的时间间隔来执行的。
9.如权利要求7和8所述的方法,其特征在于,每个FIFO存储器用来记录多个、或数十个相继数据向量,对于每个接收信道,即对于每颗卫星,每个距离数据向量
Figure A200780007467C00026
包括伪距测量以及影响所述测量的误差的方差。
10.如权利要求1-9任何一项所述的方法,其特征在于,为了中和存储在所述第一FIFO存储器中的数据,与所述数据相关联的置信度被降低,尤其是通过增大与所述数据相关联的误差的协方差来降低。
11.一种飞行器机载或可机载的飞行器定位设备(18),所述设备包括:
-惯性单元(14),用来交付惯性数据
Figure A200780007467C00031
-单元(11),用来接收卫星距离和历书并向单元(11)交付距离和/或位置数据
Figure A200780007467C00032
以及
-混合单元(12、13、16、17、VPF),其连接于所述惯性单元以接收所述惯性数据,并连接于所述卫星距离接收机单元以接收所述距离数据,所述混合单元交付作为所述惯性数据和所述距离数据的函数的估计位置数据
Figure A200780007467C00033
所述设备的特征在于,其还包括:
-FIFO存储器(10),其与所述距离接收机单元(11)和所述混合单元耦合(插入在两者之间)以将经延迟的距离数据交付给所述混合单元;以及
-中和单元(15),其响应于代表来自有错卫星(Si)的有错距离数据的差错数据(DSi),并被安排在所述差错数据出现时修正存储在所述存储器中的所述距离数据中的至少一些。
12.如权利要求11所述的设备,其特征在于,所述混合单元包括:
-估计器单元,其交付在惯性数据和估计位置数据的基础上计算得到的估计距离数据;
-第二FIFO存储器(13),其被安排存储所述估计距离数据并输出经延迟的估计距离数据;
-减法单元(16),其被安排从由所述第一FIFO存储器交付的经延迟距离数据减去所述经延迟的估计距离数据;以及
-加权单元(17),其被安排对由所述减法单元交付的数据进行加权。
13.如权利要求11或12所述的设备,其特征在于,所述混合单元包括递归滤波器(12)。
14.如权利要求13所述的设备,其特征在于,所述递归滤波器是Kalman滤波器。
15.如权利要求11—14任何一项所述的设备,其特征在于,所述中和单元(15)连接于所述距离接收机单元(11)以从其接收所述差错数据。
16.一种程序,所述程序包括可由移动体的计算机使用来通过将惯性数据
Figure A200780007467C00034
同所述移动体与卫星之间的距离数据
Figure A200780007467C00041
相组合来确定所述移动体的代码,所述程序的特征在于下列步骤:
a)将所述距离数据存储在FIFO存储器(10)中以在所述存储器的输出处有经延迟的距离数据可用;
b)将所述经延迟的距离数据与所述惯性数据向组合以获得对所述移动体的位置数据的估计
Figure A200780007467C00042
c)监视所述距离数据中差错(DSi)的出现,并且当检测到这样的差错时,修正存储在所述FIFO存储器中的所述数据中的至少一些以减小或消除其在所述组合操作中的权重;
并且其中估计卫星距离数据作为惯性数据的函数记录于第二FIFO存储器(13)中以使得在所述存储器的输出处有经延迟的估计可用,所述两个FIFO存储器的容量相等,以使得所述经延迟的估计的最大延迟值与所述经延迟的距离数据的最大延迟值相同。
17.一种可由移动体的计算机使用以确定所述移动体的位置的程序,所述程序的特征在于其实现如权利要求1-10任何一项所述的方法。
CN2007800074677A 2006-03-01 2007-02-12 混合定位方法和设备 Expired - Fee Related CN101395443B (zh)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
FR0601819A FR2898196B1 (fr) 2006-03-01 2006-03-01 Procede et dispositif de positionnement hybride
FR0601819 2006-03-01
PCT/FR2007/000255 WO2007099211A2 (fr) 2006-03-01 2007-02-12 Procédé et dispositif de positionnement hybride

Publications (2)

Publication Number Publication Date
CN101395443A true CN101395443A (zh) 2009-03-25
CN101395443B CN101395443B (zh) 2011-11-16

Family

ID=37177827

Family Applications (1)

Application Number Title Priority Date Filing Date
CN2007800074677A Expired - Fee Related CN101395443B (zh) 2006-03-01 2007-02-12 混合定位方法和设备

Country Status (7)

Country Link
US (1) US7911380B2 (zh)
EP (1) EP1989510B1 (zh)
CN (1) CN101395443B (zh)
CA (1) CA2644462C (zh)
DE (1) DE602007006915D1 (zh)
FR (1) FR2898196B1 (zh)
WO (1) WO2007099211A2 (zh)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102192741A (zh) * 2010-01-29 2011-09-21 尤洛考普特公司 飞行器姿态角的旋转稳定估计
CN102575944A (zh) * 2009-10-15 2012-07-11 萨甘安全防护公司 一种检测寄生运动并调整惯性单元的方法
CN110926483A (zh) * 2019-11-25 2020-03-27 奥特酷智能科技(南京)有限公司 一种用于自动驾驶的低成本传感器组合定位系统及方法
CN111044069A (zh) * 2019-12-16 2020-04-21 驭势科技(北京)有限公司 一种车辆定位方法、车载设备及存储介质
CN113514810A (zh) * 2021-07-07 2021-10-19 北京信息科技大学 Mimo雷达观测噪声优化方法及装置

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2917175B1 (fr) * 2007-06-08 2010-04-16 Eurocopter France Procede et systeme d'estimation de la vitesse angulaire d'un mobile
US8260552B2 (en) 2008-04-30 2012-09-04 Honeywell International Inc. Systems and methods for determining location information using dual filters
DE102011103875A1 (de) * 2011-06-10 2012-12-13 Deutsches Zentrum für Luft- und Raumfahrt e.V. Verfahren zur Bestimmung der aktuellen Position eines Luftfahrzeuges
FR2989174B1 (fr) * 2012-04-06 2016-12-09 Thales Sa Dispositif pour la determination d'informations de localisation et de references primaires inertielles pour un aeronef
FR3002032B1 (fr) * 2013-02-08 2016-02-12 Dassault Aviat Systeme et procede d'aide a la navigation d'un aeronef
US8928527B2 (en) * 2013-03-19 2015-01-06 Honeywell International Inc. Systems and methods for reducing error detection latency in LPV approaches
US9547086B2 (en) 2013-03-26 2017-01-17 Honeywell International Inc. Selected aspects of advanced receiver autonomous integrity monitoring application to kalman filter based navigation filter
US9784844B2 (en) 2013-11-27 2017-10-10 Honeywell International Inc. Architectures for high integrity multi-constellation solution separation
DE102014012836B4 (de) * 2014-08-28 2018-09-13 Wirtgen Gmbh Selbstfahrende Baumaschine und Verfahren zur Visualisierung des Bearbeitungsumfeldes einer sich im Gelände bewegenden Baumaschine

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5420592A (en) * 1993-04-05 1995-05-30 Radix Technologies, Inc. Separated GPS sensor and processing system for remote GPS sensing and centralized ground station processing for remote mobile position and velocity determinations
US5948044A (en) * 1996-05-20 1999-09-07 Harris Corporation Hybrid GPS/inertially aided platform stabilization system
US6317688B1 (en) * 2000-01-31 2001-11-13 Rockwell Collins Method and apparatus for achieving sole means navigation from global navigation satelite systems
US6549829B1 (en) * 2001-10-31 2003-04-15 The Boeing Company Skipping filter for inertially augmented landing system
US6697736B2 (en) * 2002-02-06 2004-02-24 American Gnc Corporation Positioning and navigation method and system thereof
FR2866423B1 (fr) * 2004-02-13 2006-05-05 Thales Sa Dispositif de surveillance de l'integrite des informations delivrees par un systeme hybride ins/gnss
US7471238B2 (en) * 2005-11-01 2008-12-30 The Aerospace Corporation Multitarget tracking antispoofing receiver

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102575944A (zh) * 2009-10-15 2012-07-11 萨甘安全防护公司 一种检测寄生运动并调整惯性单元的方法
CN102192741A (zh) * 2010-01-29 2011-09-21 尤洛考普特公司 飞行器姿态角的旋转稳定估计
CN102192741B (zh) * 2010-01-29 2014-06-11 空客直升机 飞行器姿态角的旋转稳定估计
CN110926483A (zh) * 2019-11-25 2020-03-27 奥特酷智能科技(南京)有限公司 一种用于自动驾驶的低成本传感器组合定位系统及方法
CN111044069A (zh) * 2019-12-16 2020-04-21 驭势科技(北京)有限公司 一种车辆定位方法、车载设备及存储介质
CN111044069B (zh) * 2019-12-16 2022-04-29 驭势科技(北京)有限公司 一种车辆定位方法、车载设备及存储介质
CN113514810A (zh) * 2021-07-07 2021-10-19 北京信息科技大学 Mimo雷达观测噪声优化方法及装置
CN113514810B (zh) * 2021-07-07 2023-07-18 北京信息科技大学 Mimo雷达观测噪声优化方法及装置

Also Published As

Publication number Publication date
DE602007006915D1 (de) 2010-07-15
FR2898196A1 (fr) 2007-09-07
EP1989510B1 (fr) 2010-06-02
EP1989510A2 (fr) 2008-11-12
CA2644462C (fr) 2013-08-20
WO2007099211A3 (fr) 2007-10-18
US7911380B2 (en) 2011-03-22
FR2898196B1 (fr) 2008-04-25
US20090278740A1 (en) 2009-11-12
WO2007099211A2 (fr) 2007-09-07
CA2644462A1 (fr) 2007-09-07
CN101395443B (zh) 2011-11-16

Similar Documents

Publication Publication Date Title
CN101395443B (zh) 混合定位方法和设备
US10018729B2 (en) Selected aspects of advanced receiver autonomous integrity monitoring application to kalman filter based navigation filter
US7711482B2 (en) Hybrid INS/GNSS system with integrity monitoring and method for integrity monitoring
EP3009860B1 (en) Method for computing an error bound of a Kalman filter based GNSS position solution
Won et al. Selective integration of GNSS, vision sensor, and INS using weighted DOP under GNSS-challenged environments
Margaria et al. A novel local integrity concept for GNSS receivers in urban vehicular contexts
EP2037291A1 (en) Integrity monitoring method for GNSS navigation based on historical information
JP4723932B2 (ja) 測位システム
Francois et al. Non-Line-Of-Sight GNSS signal detection using an on-board 3D model of buildings
US8922426B1 (en) System for geo-location
US20160170026A1 (en) Methods for identifying whether or not a satellite has a line of sight
Won et al. GNSS carrier phase anomaly detection and validation for precise land vehicle positioning
EP3722834A1 (en) Integrity monitoring of primary and derived parameters
Han et al. GNSS/IMU tightly coupled scheme with weighting and FDE for rail applications
US20230341563A1 (en) System and method for computing positioning protection levels
JP5994237B2 (ja) 測位装置及びプログラム
Le Marchand et al. Performance evaluation of fault detection algorithms as applied to automotive localisation
Gehrt et al. A pseudolite position solution within a Galileo test environment for automated vehicle applications
El-Mowafy et al. Positioning integrity, availability and precision for journey planning and navigation using GNSS integrated with low-cost sensors
Skaloud Reliability of Direct Georeferencing Phase 1: An Overview of the Current Approaches and Possibilities., Checking and Improving of Digital Terrain Models/Reliability of Direct Georeferencing.
Montloin et al. GNSS multipath failures modes analysis for airport surface operations
Martin et al. Performance comparison of single and dual frequency closely coupled gps/ins relative positioning systems
Skaloud Reliability in direct georeferencing: An overview of the current approaches and possibilities
Molina et al. Integrity Aspects of Hybrid EGNOS-based Navigation on Support of Search-And-Rescue Missions with UAVs
Fasano et al. An advanced system for performance evaluation of integrated navigation systems

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
C56 Change in the name or address of the patentee

Owner name: AIRBUS HELICOPTER

Free format text: FORMER NAME: ULOCOPT S.A.

CP01 Change in the name or title of a patent holder

Address after: France, Anna

Patentee after: EUROCOPTER FRANCE

Address before: France, Anna

Patentee before: Ulocopt S. A.

CF01 Termination of patent right due to non-payment of annual fee
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20111116

Termination date: 20210212