CN101395443B - 混合定位方法和设备 - Google Patents
混合定位方法和设备 Download PDFInfo
- Publication number
- CN101395443B CN101395443B CN2007800074677A CN200780007467A CN101395443B CN 101395443 B CN101395443 B CN 101395443B CN 2007800074677 A CN2007800074677 A CN 2007800074677A CN 200780007467 A CN200780007467 A CN 200780007467A CN 101395443 B CN101395443 B CN 101395443B
- Authority
- CN
- China
- Prior art keywords
- data
- delayed
- satellite
- range data
- fifo 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.)
- Expired - Fee Related
Links
Images
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/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining 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/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining 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
-
- 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
- G01C21/165—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 combined with non-inertial navigation instruments
-
- 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
- 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/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining 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/40—Correcting position, velocity or attitude
- G01S19/41—Differential correction, e.g. DGPS [differential 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/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining 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/42—Determining position
- G01S19/48—Determining 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/49—Determining 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Computer Security & Cryptography (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明涉及通过将惯性数据同飞行器与卫星之间距离的数据相组合来确定飞行器位置的方法,其中:a)将距离数据存储在FIFO存储器中,从而在存储器的输出处有经延迟的距离数据可用;b)将经延迟的距离数据与惯性数据相组合,以获得对飞行器的位置数据的估计;以及c)监视距离数据中差错的出现,并当检测到这样的差错时,修正存储在FIFO存储器中的数据中的至少一些以使得差错被中和。
Description
本发明涉及一种混合定位方法和设备。
本发明的技术领域是制造直升飞机上机载的导航***的技术领域。
本发明尤其涉及将惯性测量同与涉及承载该设备的移动体(尤其是旋翼飞机)和卫星之间距离的数据相组合的导航和/或定位方法及设备。
在本申请的用意中,并且在没有显性的或隐性指示相反意思时,术语“测量”、“数据”、“信号”、和它们的派生词被认为是等效的,并且术语“组合”、“混合”、“耦合”、和它们的派生词同样被认为是等效的。
一般而言,GPS接收机包括四个主要版块或模块:
-第一模块是HF头(也称为“RF前端”)并且它对由GPS接收机的天线拾取的信号进行前置放大,并执行变频;
-第二模块是为其它模块提供精确时间和频率基准的时钟;由于时钟的精确性并不是绝对的,因此其时间和频率误差藉由偏离来建模;
-第三模块是信号处理器模块,其解码来自卫星的导航消息,以提供有24颗卫星的星座的历书;此第一类数据对应于给出24颗卫星的位置(或三维向量 其中i=1到24);假定精确地知道时间,则这就构成计算这24个位置所需的数据;该模块也测量已接收到的信号来自视野中的那些卫星的传播时间,其中这类信号的数目或信道的数目(NCH)可变,并使用这些信号来计算与相应各测得的传播历时对应的距离;影响这些测量的公偏对应于时钟的偏移,并且可能等量于几千公里;如此确定的距离一般被称为“伪距”;在本申请中,除非显性或隐性地指示相反意思,否则术语“距离”和“伪距”可互换地用来指代由该接收机模块交付的距离数据;一些接收机还交付此量值的导数的测量(“伪距离”速率);以及
-用于“计算导航解”的第四模块求解以下方程组:
ri 2=(xi-x)2+(yi-y)2+(zi-z)2+Ct
i=1-NCH,并且其中 是天线的位置,t是时钟的偏移,而C是光速;这里有四个未知量(x,y,z,t),因此求解此方程组需要四个标量方程;当接收机信道的数目超过4时,过剩的数据被用来减小误差并增加完好性,例如通过使用最小二乘法以及通过检出偏离总走向的点来实现。
此版块由此交付针对偏离作了修正的接收机位置和时间,并且在恰当的场合还交付移动体的位置的导数——即承载体的速度的测量。
已知通过使用Kalman滤波器,可将这类相对于卫星的距离数据与由移动体机载的惯性单元交付的惯性数据相组合,从而来确定移动体的位置,例如在苏黎士ETH Hnggerberg的测地学和摄影测绘学研究所的文献“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 ofGlobal 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完全失效的情况下提供自愈模式,从而解决这个问题。
本发明的另一目的是提出一种机载的或适于飞行器机载用来通过将伪距与其它测量——尤其是惯性测量——混合来确定其位置的***,该***是改良的和/或至少部分地弥补这类***的短处和缺陷。
根据本发明的一个方面,卫星定位数据在被交付给用于将该数据与非卫星定位数据混合的模块之前先被暂存,并且在检测到差错信号的情况下,暂存的卫星数据中至少有一些被修正。
a)将距离数据存储在在FIFO存储器中以在存储器的输出处有经延迟的距离数据可用;
b)将经延迟的距离数据与惯性数据相组合以获得对移动***置数据的估计;以及
c)监视距离数据中差错的出现,并且当检测到这样的差错时,修正存储在FIFO存储器中的数据中的至少一些以中和(钝化)这些数据,即降低或消去其在组合操作中的权重(或贡献)。
根据本发明的有利特征:
-将估计卫星距离数据作为惯性数据的函数和作为卫星历书的函数存储在第二FIFO存储器(13)中,从而在所述存储器的输出处有经延迟的估计可用,这两个FIFO存储器的容量相等以使得经延迟的估计的最大延迟值与经延迟的距离数据的最大延迟值相同;
-组合操作可包括修正操作,所述修正操作包括从经延迟的距离数据减去经延迟的作为惯性数据的函数的距离数据估计,并用可为常量或变量的增益(K)对所述减法的结果加权(滤波);该增益可以是作为影响距离数据的误差的先验协方差(R)的函数计算得到的;
-最大延迟值是1秒到6秒的数量级;
-存储和组合操作可以至少0.5赫兹(Hz)数量级——尤其是在0.5Hz到5Hz数量级、或者在1Hz到10Hz数量级——的频度(以规律的时间间隔)执行;
-为了中和存储在第一FIFO存储器中的数据,可降低与所述数据相关联的置信度,也就是使误差协方差矩阵的逆减小或归零,和/或增大与所述数据相关联的误差协方差(尤其是设定在非常高的值)。
在本发明的另一方面,提出一种机载或适于飞行器机载的飞行器位置确定设备,该设备包括:
-惯性单元,用来交付惯性数据;和/或
-卫星距离接收机单元,用来交付距离数据;
-混合单元,其连接于惯性单元以接收惯性数据并且连接于卫星距离接收机单元以接收距离数据,所述混合单元交付作为惯性数据和距离数据的函数的估计位置数据;
-FIFO存储器,其与距离接收机单元和混合单元耦合(***在两者之间),用来向混合单元交付经延迟的距离数据;以及
-中和单元,其响应于关于距离数据的差错数据并被安排在所述差错数据出现时修正存储在存储器中的距离数据的至少一部分。
根据该设备的有利特征;
-混合单元可包括:
-估计器单元,其交付从惯性数据、来自接收机的估计位置数据、和卫星位置数据(历书)计算得到的距离估计;
-第二FIFO存储器,其被安排存储距离估计并输出经延迟的估计距离数据;
-修正单元,其包括被安排从由第一FIFO存储器交付的经延迟距离数据减去经延迟的估计距离数据的减法单元;以及
-增益(K)运算器,其被安排对由减法单元提供的数据加权;
-混合单元可包括递归滤波器,尤其是Kalman滤波器;并且
-中和单元可连接于距离接收机单元以接收差错数据。
本发明可由飞行器机载或适于飞行器机载的计算机的处理器实现,该计算机一旦检测到出错,就执行包括与本发明的方法的步骤对应的指令的程序。
a)将距离数据存储在FIFO存储器中以在存储器的输出处有经延迟的距离数据可用;
c)监视距离数据中差错(SV#i)的出现,并且当检测到差错时,修正存储在FIFO存储器中的数据中的至少一部分以使其在组合操作中的权重减小或归零;以及
d)将卫星距离数据估计作为惯性数据的函数存储于第二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)的综合表示,其中:
-标记了“z-1”或“D”的运算器是个体的延迟运算器;这种作用于向量的运算器对应于n个标量延迟运算器;
-F、H和B是该虚拟平台的特征矩阵(其状态表示的矩阵);矩阵H的计算涉及所有卫星的位置;
-是对过程的状态向量的估计,即至少是由三个欧拉角、三个速度分量、三个位置分量、以及GPS接收机时钟的偏离构成的集合。通常,还包括与回转仪、加速度计、和VCO的建模误差对应的马尔可夫状态;例如,给定有总共24维的向量则每轴每传感器两个附加状态,用于建模偏离和1/f噪声;
尽管虚拟平台不是线性过程,但这种表示对于影响测量即影响对最优混合有意义的量的误差是有效的。
这种表示示出虚拟平台接收六个“捷联式”惯性测量作为输入,并交付对承载体的状态向量的估计作为输出,并且其可被局部线性化。
图中所示的其它要素是:
-K,Kalman增益;以及
该图代表下列方程:
如果影响测得的伪距测量和惯性测量的误差为白噪声,如果R是影响伪距测量的误差的协方差矩阵,并且如果U是影响惯性测量的误差的协方差矩阵,则影响承载体状态估计的误差的Kalman增益K和协方差矩阵X是由***使用下列非线性递归方程来确定的:
Xk+1|k=FXk|kFT+BUBT
K=Xk+1|kHT(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的环路
其输入写成e且输出写成s的移位寄存器的两个相继状态(与索引为k和(k +1)的两次迭代对应)之间的关系可以写成下列形式:
或者以更紧凑的形式写成:
其中FF、BF和HF是基本上由大量0和少量1构成的互连矩阵,其中1首先对应于移位寄存器的“总”输入与寄存器的第一级的输入之间的连接,其次对应于一级的输出与下一级的输入之间的连接,最后对应于寄存器末级的输出与移位寄存器的“总”输出之间的连接。
配备有其移位寄存器的平台可由下列方程转写:
使用下列注记:
而这就可象任何其它Kalman滤波器那样来进行处理。
在本发明的方法中,要计算以供使用的向量和矩阵的维数增加。例如,对以6秒TTA并以1Hz提供12个位置分量的GPS接收机而言,这提供12×6×1=72个附加状态。因此,本发明所实现的滤波器可具有数十或数百个状态。
然而,由于所处理的矩阵基本是“空”的,因此一般不必为所有这些元素提供存储,也不必***地处理这些矩阵和这些向量的所有元素。
惯性/GPS耦合可以是紧耦合或松耦合;对于松耦合,可使用由GPS接收机交付的位置数据,在恰当的场合还有速度数据;对于紧耦合,可使用由GPS接收机交付的伪距数据,在恰当的场合还有伪速度数据。
本发明的***可包括气压高度传感器、磁力计、和/或空速传感器,以及用来将这些传感器所交付的测量与卫星距离测量组合并在适当的场合还与惯性测量组合的混合手段。由此可将卫星位置数据与空中(相对空气的)飞行器速度的测量、航向和磁场测量、和/或高度、和/或大气压测量相组合。
Claims (18)
a)将所述距离数据存储在第一FIFO存储器(10)中,从而在所述第一FIFO存储器的输出处有经延迟的距离数据可用;
c)监视所述距离数据中差错(DSi)的出现,并且当检测到这样的差错时,修正存储在所述第一FIFO存储器中的数据中的至少一些以减小或消除其在所述组合操作中的权重;以及
d)将估计卫星距离数据作为惯性数据的函数并作为卫星历书的函数存储在第二FIFO存储器(13)中,以在所述第二FIFO存储器的输出处有经延迟的估计可用,所述第一和第二FIFO存储器的容量相等,以使得所述经延迟的估计的最大延迟值与所述经延迟的距离数据的最大延迟值相同。
2.如权利要求1所述的方法,其特征在于,所述组合操作包括从所述经延迟的距离数据减去经延迟的作为所述惯性数据的函数的距离数据估计,并对所述减法的结果进行加权。
3.如权利要求2所述的方法,其特征在于,所述加权增益(K)是常量。
4.如权利要求2所述的方法,其特征在于,所述加权增益(K)是变量。
5.如权利要求4所述的方法,其特征在于,所述加权增益是作为影响所述距离数据的误差的先验协方差(R)的函数并作为星座的几何的函数来计算的。
6.如权利要求1所述的方法,其特征在于,所述最大延迟的值为1秒到6秒的数量级。
7.如权利要求1所述的方法,其特征在于,所述存储和组合操作是以至少0.5Hz或至少1Hz数量级的频度以规律的时间间隔来执行的。
10.如权利要求1所述的方法,其特征在于,为了中和存储在所述第一FIFO存储器中的数据,与所述数据相关联的置信度被降低。
11.如权利要求10所述的方法,其特征在于,与所述数据相关联的置信度是通过增大与所述数据相关联的误差的协方差来降低的。
12.一种飞行器机载或可机载的飞行器定位设备(18),所述设备包括:
所述设备的特征在于,其还包括:
-第一FIFO存储器(10),其与所述距离接收机单元(11)和所述混合单元耦合以将经延迟的距离数据交付给所述混合单元;以及
-中和单元(15),其响应于代表来自有错卫星(Si)的有错距离数据的差错数据(DSi),并被安排在所述差错数据出现时修正存储在所述第一FIFO存储器中的所述距离数据中的至少一些,
其中所述混合单元包括:
-估计器单元,其交付在惯性数据和估计位置数据的基础上计算得到的估计距离数据;
-第二FIFO存储器(13),其被安排存储所述估计距离数据并输出经延迟的估计距离数据;
-减法单元(16),其被安排从由所述第一FIFO存储器交付的经延迟距离数据减去所述经延迟的估计距离数据;以及
-加权单元(17),其被安排对由所述减法单元交付的数据进行加权。
13.如权利要求12所述的设备,其特征在于,所述第一FIFO存储器(10)***在所述距离接收机单元(11)与所述混合单元之间。
14.如权利要求12所述的设备,其特征在于,所述混合单元包括递归滤波器(12)。
15.如权利要求14所述的设备,其特征在于,所述递归滤波器是Kalman滤波器。
16.如权利要求12所述的设备,其特征在于,所述中和单元(15)连接于所述距离接收机单元(11)以从其接收所述差错数据。
a)用于将所述距离数据存储在第一FIFO存储器(10)中以在所述第一FIFO存储器的输出处有经延迟的距离数据可用的装置;
c)用于监视所述距离数据中差错(DSi)的出现,并且当检测到这样的差错时,修正存储在所述第一FIFO存储器中的所述数据中的至少一些以减小或消除其在所述组合操作中的权重的装置;以及
a)用于将所述距离数据存储在第一FIFO存储器(10)中从而在所述第一FIFO存储器的输出处有经延迟的距离数据可用的装置;
c)监视所述距离数据中差错(DSi)的出现,并且当检测到这样的差错时,修正存储在所述第一FIFO存储器中的数据中的至少一些以减小或消除其在所述组合操作中的权重的装置;以及
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 CN101395443A (zh) | 2009-03-25 |
CN101395443B true 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) |
Families Citing this family (14)
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 |
FR2951535B1 (fr) * | 2009-10-15 | 2011-12-02 | Sagem Defense Securite | Procede de detection de mouvements parasites lors de l'alignement d'une centrale inertielle |
FR2955934B1 (fr) * | 2010-01-29 | 2012-03-09 | Eurocopter France | Estimation stabilisee en virage des angles d'assiettes d'un aeronef |
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 |
CN110926483B (zh) * | 2019-11-25 | 2020-12-25 | 奥特酷智能科技(南京)有限公司 | 一种用于自动驾驶的低成本传感器组合定位***及方法 |
CN111044069B (zh) * | 2019-12-16 | 2022-04-29 | 驭势科技(北京)有限公司 | 一种车辆定位方法、车载设备及存储介质 |
CN113514810B (zh) * | 2021-07-07 | 2023-07-18 | 北京信息科技大学 | Mimo雷达观测噪声优化方法及装置 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6317688B1 (en) * | 2000-01-31 | 2001-11-13 | Rockwell Collins | Method and apparatus for achieving sole means navigation from global navigation satelite systems |
FR2866423A1 (fr) * | 2004-02-13 | 2005-08-19 | Thales Sa | Dispositif de surveillance de l'integrite des informations delivrees par un systeme hybride ins/gnss |
Family Cites Families (5)
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 |
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 |
US7471238B2 (en) * | 2005-11-01 | 2008-12-30 | The Aerospace Corporation | Multitarget tracking antispoofing receiver |
-
2006
- 2006-03-01 FR FR0601819A patent/FR2898196B1/fr active Active
-
2007
- 2007-02-12 DE DE602007006915T patent/DE602007006915D1/de active Active
- 2007-02-12 EP EP07730967A patent/EP1989510B1/fr active Active
- 2007-02-12 CN CN2007800074677A patent/CN101395443B/zh not_active Expired - Fee Related
- 2007-02-12 CA CA2644462A patent/CA2644462C/fr active Active
- 2007-02-12 WO PCT/FR2007/000255 patent/WO2007099211A2/fr active Application Filing
- 2007-02-12 US US11/915,217 patent/US7911380B2/en not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6317688B1 (en) * | 2000-01-31 | 2001-11-13 | Rockwell Collins | Method and apparatus for achieving sole means navigation from global navigation satelite systems |
FR2866423A1 (fr) * | 2004-02-13 | 2005-08-19 | Thales Sa | Dispositif de surveillance de l'integrite des informations delivrees par un systeme hybride ins/gnss |
Also Published As
Publication number | Publication date |
---|---|
CN101395443A (zh) | 2009-03-25 |
CA2644462A1 (fr) | 2007-09-07 |
US20090278740A1 (en) | 2009-11-12 |
WO2007099211A2 (fr) | 2007-09-07 |
FR2898196B1 (fr) | 2008-04-25 |
US7911380B2 (en) | 2011-03-22 |
DE602007006915D1 (de) | 2010-07-15 |
EP1989510A2 (fr) | 2008-11-12 |
EP1989510B1 (fr) | 2010-06-02 |
FR2898196A1 (fr) | 2007-09-07 |
CA2644462C (fr) | 2013-08-20 |
WO2007099211A3 (fr) | 2007-10-18 |
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 | |
Won et al. | Selective integration of GNSS, vision sensor, and INS using weighted DOP under GNSS-challenged environments | |
EP3009860B1 (en) | Method for computing an error bound of a Kalman filter based GNSS position solution | |
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) | 測位システム | |
François et al. | Non-Line-Of-Sight GNSS signal detection using an on-board 3D model of buildings | |
US20230341563A1 (en) | System and method for computing positioning protection levels | |
US9817126B2 (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 | |
US20240094415A1 (en) | System and method for detecting outliers in gnss observations | |
JP5994237B2 (ja) | 測位装置及びプログラム | |
Gehrt et al. | A pseudolite position solution within a Galileo test environment for automated vehicle applications | |
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 | |
Molina et al. | Integrity Aspects of Hybrid EGNOS-based Navigation on Support of Search-And-Rescue Missions with UAVs | |
Skaloud | Reliability in direct georeferencing: An overview of the current approaches and possibilities | |
Fasano et al. | An advanced system for performance evaluation of integrated navigation systems | |
Chan et al. | High-Integrity GPS/INS Integrated Navigation with Error Detection and Application to LAAS | |
Talaya López | Algorithms and methods for robust geodetic kinematic positioning |
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 |