CN109937341A - 自己的位置的估计 - Google Patents
自己的位置的估计 Download PDFInfo
- Publication number
- CN109937341A CN109937341A CN201780070019.5A CN201780070019A CN109937341A CN 109937341 A CN109937341 A CN 109937341A CN 201780070019 A CN201780070019 A CN 201780070019A CN 109937341 A CN109937341 A CN 109937341A
- Authority
- CN
- China
- Prior art keywords
- position measurement
- measurement
- positioning system
- measurements
- autocorrelation
- 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
Links
- 238000005259 measurement Methods 0.000 claims abstract description 204
- 238000000034 method Methods 0.000 claims abstract description 60
- 230000000875 corresponding effect Effects 0.000 description 13
- 230000007613 environmental effect Effects 0.000 description 6
- 230000004927 fusion Effects 0.000 description 4
- 238000001914 filtration Methods 0.000 description 3
- 230000002123 temporal effect Effects 0.000 description 3
- 238000002604 ultrasonography Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000007781 pre-processing Methods 0.000 description 2
- 239000002904 solvent Substances 0.000 description 2
- 238000005311 autocorrelation function Methods 0.000 description 1
- 230000003139 buffering effect Effects 0.000 description 1
- 230000002596 correlated effect Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
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/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
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/86—Combinations of radar systems with non-radar systems, e.g. sonar, direction finder
-
- 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
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- 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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/86—Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
-
- 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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- 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
-
- 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
-
- 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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/4808—Evaluating distance, position or velocity data
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
- Automation & Control Theory (AREA)
Abstract
本发明涉及一种用于估计自己的位置的方法。为了改善对例如车辆的自己的位置的估计,提出通过第一定位系统(14)提供至少一个第一位置测量,并且通过至少一个第二定位系统(15、16)提供至少一个第二位置测量。此外,通过第一定位系统(14)提供第三位置测量。第三位置测量在时间上在第一和第二位置测量之后进行。至少根据第三位置测量和至少一个位置误差值估计自己的位置。位置误差值根据至少一个第一位置测量和至少一个第二位置测量来确定。
Description
技术领域
本发明涉及一种用于估计自己的位置、尤其是用于估计车辆的自己的位置的设备和方法。
背景技术
在许多车辆中使用车辆的自己的位置的确定或者估计,以便在达到目的地位置时借助导航系统支持车辆的驾驶员。车辆例如可以包括轿车、货车、轮船或者飞机或者任意的陆地车辆、船只或者飞行器。例如利用全球卫星导航系统、例如GPS,可以在几米内准确地确定车辆的自己的位置。这种精度一般对于借助导航系统进行目的地引导来说足够了,虽然更高的精度是有利的。例如,利用更高的精度,可以支持和检查车道选择或者更准确地指示拐弯。因此,通常借助数据融合将全球卫星导航系统的数据与例如车辆的测距数据组合,以提高自己的位置的确定或者估计的精度。
自己的位置的确定或者估计的另一种应用在于自动车辆引导。对于自动驾驶功能来说,高精度的车辆自定位是重要的任务,以便例如可以确定相对于路边、相对于其它车辆或者周围环境中的物体的距离。
DE 69034047 T2例如涉及一种集成车辆定位和导航系统。用于沿着预先确定的路径对车辆进行自动导航的基于计算机的系统,具有用于确定车辆位置的第一部件和用于促使车辆遵循预先确定的路径的第二部件。第一部件包括第一位置确定系统,其适用于基于来自地面位置确定系统的第一信号确定车辆的第一位置估计。此外,第一部件包括第二位置确定系统,用于基于从惯性参考单元和车辆转速表获得的第二信号对车辆进行第二位置估计。最后,第一部件包括处理系统,用于根据第一位置估计和第二位置估计的加权组合确定车辆的第三位置估计。该系统还具有第三部件,用于在车辆跟随预先确定的路径期间,使得车辆检测并且避开障碍物。
在组合不同的定位系统的位置估计时,可能有意义的是,考虑不同的定位系统的可能的定位误差。
在这种情境下,EP 0161688 A2公开了一种用于车辆的导航方法。导航设备从车辆自己的传感器并且从附加的输入部件获得信号。车辆自己的传感器包括诸如航向传感器和速度传感器或者行程传感器的传感器。附加的输入部件例如是所在地的手动输入或者针对无线电或者卫星导航方法的接收装置、例如GPS。借助Kalman滤波器对确定的航向和速度误差以及随机的航向误差分量和随机的车辆纵向运动误差部分进行补偿。在误差可以通过高斯白噪声、即正态分布的不相关噪声来描述的假设下,对在(例如由GPS进行的)位置修正中出现的误差进行数学模型化。
然而,经常在实践中出现如下情况,在这些情况下,定位系统、例如全球卫星导航系统进行的位置测量具有自相关误差。
发明内容
因此,本发明要解决的技术问题是,在确定自己的位置时考虑并且补偿位置测量的自相关误差。
根据本发明,上述技术问题通过根据权利要求1的用于估计自己的位置的方法和根据权利要求9的相应的设备来解决。从属权利要求定义了本发明的实施方式。
根据本发明,提供一种用于估计自己的位置的方法。在所述方法中,通过第一定位系统提供至少一个第一位置测量,并且通过至少一个第二定位系统提供至少一个第二位置测量。此外,通过第一定位系统提供第三位置测量。第三位置测量在时间上在第一和至少一个第二位置测量之后进行。至少根据第三位置测量和至少一个位置误差值估计自己的位置。根据至少一个第一位置测量和至少一个第二位置测量确定位置误差值。
换言之,提供第一定位系统和至少一个第二定位系统。两个定位系统例如持续提供位置测量。根据第一定位系统的过去的位置测量(至少一个第一位置测量)和至少一个第二定位系统的过去的位置测量(至少一个第二位置测量)确定位置误差值。使用第一定位系统的当前的位置测量(第三位置测量),结合位置误差值,来估计自己的位置。在此,通过位置误差值来校正当前的位置测量。
由此可以实现下面的优点。除了随机的测量误差分布(白噪声)以外,许多定位系统的测量误差还具有在时间上自相关的特性。然而,两个不同的定位系统的在时间上自相关的特性通常也是不同的,从而位置误差值具有与第一定位系统的位置测量不同的自相关特性。由此可以减小自相关影响,进行所谓的去相关。尤其是对于第二定位系统的位置测量不具有自相关特性的情况,可以在第一定位系统的测量误差中明显减小自相关的影响。根据第一定位系统的自相关特性,在估计自己的位置时,可以使用多个位置误差值来校正位置测量(第三位置测量)。例如可以根据相应的过去的第一和第二位置测量来确定相应的位置误差值。
根据一个实施方式,将至少一个位置误差值中的相应的位置误差值,确定为至少一个第一位置测量中的一个第一位置测量与至少一个第二位置测量中的一个第二位置测量之间的差值。例如可以在三个时间点分别进行第一位置测量和第二位置测量。将第一时间点的位置误差确定为相应的第一时间点的第一位置测量与第二位置测量之间的差。将第二时间点的位置误差值确定为第二时间点的第一位置测量与第二时间点的第二位置测量之间的差。因此,将第三时间点的位置误差值确定为相应的第三时间点的第一与第二位置测量之间的差。根据第一定位系统的位置测量的自相关特性,可以以简单的方式提供适当数量的位置误差值,并且用于校正当前的位置测量。
例如可以由第一定位系统提供位置测量的自相关阶数A。至少根据第三位置测量和A个位置误差值来估计自己的位置。根据A个第一位置测量和A个第二位置测量确定A个位置误差值。可以基于相应的自相关模型例如通过参考位置测量事先、即离线地确定自相关阶数A。替换地,也可以在线地确定自相关阶数A。根据自相关阶数A,例如可以确定所需的位置误差值的数量。例如,对于自相关阶数3,在估计自己的位置时,可以相应地考虑3个位置误差值。通过确定自相关阶数,可以以简单的方式确定所需的适当数量的位置误差值,以使得能够进行适当的校正,由此估计自己的位置。
例如,借助自相关模型,还可以提供相应的自相关系数,在估计自己的位置时考虑自相关系数。根据阶数A,可以提供相应的数量A个自相关系数,并且可以附加地根据该A个自相关系数估计自己的位置。在上面的示例(其中在估计自己的位置时考虑3个位置误差值)中,自相关阶数例如可以是3,因此可以附加地考虑3个自相关系数。
根据一个实施方式,根据下面的方程来估计自己的位置:
在此,表示自己的位置,并且i表示位置测量的不同的时间点。用za表示利用第一定位系统进行的位置测量,并且用zw表示利用第二定位系统进行的测量。当前的时间点例如是时间点i,因此利用j得到先前的过去的时间点i-j,j从1计数到自相关阶数A。因此,根据上面的定义,第三位置测量、即第一定位系统进行的当前的位置测量用表示。过去的时间点i-1至i-A的第一位置测量用表示。过去的时间点i-1至i-A的第二位置测量用表示。γj(其中,j=1至A)表示A个自相关系数。
上面的方程的计算运算可以利用比较简单的计算部件在短时间内进行,从而可以快速地以简单的方式确定自己的位置。在自相关阶数A增大的情况下,计算的复杂性也仅线性地增加。
根据一个实施方式,至少一个第一位置测量、至少一个第二位置测量和第三位置测量分别包括绝对位置测量。绝对位置测量例如以经度和纬度以及可选的高度信息的形式示出绝对地理位置。相应的第一和第二定位系统例如可以包括卫星支持的全球定位系统或者地面支持的全球定位系统、例如基于移动无线电系统的定位系统。提供绝对位置测量的其它定位系统例如可以包括基于照相机、激光、雷达或者超声波的定位系统,其结合详细的地图资料或者环境资料,通过将采集的环境信息与地图资料或者环境资料进行比较来确定位置。
根据另一个实施方式,至少一个第一位置测量、至少一个第二位置测量和第三位置测量分别包括相对位置测量。相对位置测量示出关于相应的先前的位置测量的相对地理位置。相对位置测量例如可以借助确定车辆的运动的车辆传感器来采集。这种传感器也称为测距传感器。测距传感器例如包括速度传感器、加速度传感器和转向角传感器。此外,通过借助基于照相机、激光、雷达或者超声波的系统来确定车辆相对于周围环境的相对位置改变,相对位置测量也可以以基于照相机、激光、雷达或者超声波的系统为基础。
因此,上面的方法可以同样地用于示出绝对地理位置的定位系统和示出相对地理位置的定位系统。如从上面的方程中可以看到的,优选可以将相同类别的定位系统的位置测量以简单的方式相互组合。换言之,前面描述的方法特别适用于仅将绝对位置测量相互组合或者仅将相对位置测量相互组合。
在另一个实施方式中,使用Q个位置确定源来估计自己的位置。在此,Q至少是3,即提供至少3个不同的位置确定源。针对从1到Q中的每个k,利用前面描述的方法估计相应的临时的自己的位置。因此,估计Q个临时的自己的位置。在此,位置确定源k用作前面描述的方法中的第一定位系统。其余位置确定源、即除了k以外的从1至Q的位置确定源用作至少一个第二定位系统。通过将除了k以外的位置确定源1至Q的位置测量组合,来确定至少一个第二位置测量的每个位置测量。
因此,通过将位置确定源中的一个用作第一定位系统,并且将其余位置确定源用作第二定位系统,来确定Q个临时的自己的位置。在此,以每个位置确定源都用作第一定位系统一次的方式,来切换位置确定源。得到Q个临时的自己的位置,将其组合为最终的自己的位置。由此,也可以利用多于两个的位置确定源来使用前面描述的方法。因此,在使用其余位置确定源的位置测量的情况下,临时的自己的位置原则上基于位置确定源的位置测量的去相关。因此,在使用其余位置确定源的情况下,对不同的位置确定源的每个位置测量进行一次去相关,并且将这样去相关的临时的自己的位置组合为最终的自己的位置。
此外,根据本发明,提供一种包括接口和至少一个处理器的设备。接口能够接收第一定位系统的位置测量和至少一个第二定位系统的位置测量。处理器被设计为用于执行下面的步骤。首先,处理器提供第一定位系统的至少一个第一位置测量。此外,处理器提供至少一个第二定位系统的至少一个第二位置测量。处理器基于第一定位系统提供第三位置测量。第三位置测量在时间上在第一和第二位置测量之后进行。处理器至少根据第三位置测量和至少一个位置误差值估计自己的位置。位置误差值由处理器根据至少一个第一位置测量和至少一个第二位置测量确定。至少一个第一位置测量可以包括在时间上在第三位置测量之前依次进行的多个位置测量。至少一个第二位置测量同样可以包括在时间上在第三位置测量之前依次进行的多个位置测量。优选在近似相同的时间点采集、即成对地采集第一位置测量和第二位置测量。可以根据相应的第一和第二位置测量对来确定相应的位置误差值。
此外,所述设备可以被设计为用于执行前面描述的方法,因此也包括结合所述方法描述的优点。
在前面的描述中彼此独立地描述了本发明的实施方式。然而,这些实施方式可以任意地相互组合。
附图说明
下面,参考附图详细描述本发明。
图1示意性地示出了具有根据本发明的一个实施方式的设备的车辆。
图2示意性地示出了根据本发明的一个实施方式的方法的方法步骤。
图3示意性地示出了根据本发明的另一个实施方式的方法的方法步骤。
具体实施方式
下面,参考附图借助不同的实施方式描述本发明。
图1示出了具有设备11的车辆10,设备11能够估计车辆10的自己的位置。设备11包括接口(IF)12和处理器(CPU)13。设备11通过接口12与车辆10的第一定位系统14和多个第二定位系统15、16耦合。第二定位系统的数量是任意的,然而存在至少一个第二定位系统15或者16。
定位系统14-16尤其是可以包括所谓的绝对定位系统,其例如以经度、维度和可选的高度信息的形式提供绝对位置测量。这种定位系统14-16例如可以包括卫星支持的全球位置确定系统、例如GPS或者Galileo。替换地或者附加地,绝对定位系统可以包括光学照相机系统、激光传感器、Lidar传感器、雷达传感器或者超声波传感器,利用其采集车辆的周围环境的二维或者三维图像。在周围环境的图像中提取特征、例如车道或者深度边缘(Tiefenkante)。将这些特征与在详细的地图数据中存储的特征进行比较。地图数据附加地包括关于这些特征的全球位置信息,并且基于比较,可以确定车辆相对于这些特征的相对位置,因此基于这些传感器数据来确定车辆的全球位置。
定位系统14-16的每个位置确定通常具有一定的不精确或者一定的误差。这些不准确或者误差可能由于数据采集、例如GPS信号或者激光信号的接收或者由于进一步处理、例如对GPS信号的过滤或者采集的环境特征与地图中的环境特征的比较方法引起。因此,下面描述减小这种误差的方法。在此,应当注意,使用不同的定位系统的位置测量。例如可以以如下方式来区分两个定位系统,即,其基于不同的信息,例如基于激光传感器的信息和基于GPS接收器的信息。然而,也可以以如下方式来区分两个定位系统,即,其以不同的方式处理相同的信息。例如可以利用不同的过滤方法处理GPS接收器的信息,因此GPS接收器的信息在本发明的意义上是不同的定位系统的位置测量。例如,同样可以在车辆处接收两个不同的位置的GPS信号,因此其代表两个不同的定位系统。最后,作为绝对位置测量的替换,也可以使用相应的定位系统的相对位置测量。例如可以由车辆的测距传感器、例如转向角传感器、速度传感器和/或加速度传感器提供相对位置测量。然而,优选在下面描述的方法中仅使用一种类别的定位系统,即仅使用绝对定位系统或者仅使用相对定位系统。
在详细讨论本发明的方法之前,首先描述组合、即所谓的融合位置测量时的基本问题。
为了改善自己的位置估计的精度和可靠性,在具有自动驾驶功能的车辆中存在提供位置测量的多个定位系统。这些位置测量具有不确定性。在融合位置测量时经常作出如下假设,即,可以通过白噪声来描述第i个位置测量zi w的测量误差。假设具有白噪声的测量zi w为:
其中,pi是第i个测量的真正的位置,并且ei w是第i个位置测量的测量误差。在此,ei w=vi w,其中,模型化为白噪声。在此,如下协方差矩阵表示空间测量精度,
表示第i个位置测量的第d个向量项(例如X和Y方向上的二维向量或者X、Y和Z方向上的三维向量),并且Cov(·,·)表示两个函数自变量的协方差。
然而,在实践中经常出现如下情况,在这些情况下,测量误差也与先前的测量误差有关,即存在自相关。在这种情况下适用具有自相关误差的测量
其中,可以通过阶数为A的离散自相关如下来描述
在此,和γj表示第j个自相关系数。总之,因此,第i个位置测量的误差不仅与第i个测量有关,而且与以前的A个位置误差有关。在实践中,例如当所包含的误差与在短的时间段内恒定的环境因素有关时,例如在GPS信号中可以观察到这种误差。包含在许多传感器中的对信号的预处理(例如利用Kalman滤波器进行滤波)同样可以人为地产生这种误差模型。
如已经提到的,在数据融合中经常作出如下假设,即,可以如在方程(1)中那样将位置测量的误差模型化。因此,感兴趣的是如在方程(3)中那样改善位置测量的方法,使得这种假设更适用。因此,这种改善形成位置测量的“误差去相关”。如果忽略自相关误差部分,并且假设仅具有白噪声,则这尤其是在估计或者优化问题中可能导致错误的估计,或者导致太低的不确定性估计。
因此,下面描述一种方法,其使得能够(在不知道如何提升(erhoben)这些位置测量的准确方式的情况下)在类型za的位置测量中,在考虑类型zw的位置测量的情况下,实现这种误差去相关。
在这种方法中,假设存在误差的特性根据方程(3)的位置测量的集合和误差的特性根据方程(1)的位置测量的集合位置测量例如由第一定位系统14提供。位置测量例如由第二定位系统15提供。为了清楚起见,假设这些测量在相同的时间段内存在,并且对于两个定位系统来说,第i个测量描述相同的时间点。这在需要时可以通过简单的预处理借助缓冲(Pufferung)和插值来实现。此外,假设所有位置测量可以与两个集合za或者zw中的一个唯一地相关联。在实践中,这些位置测量经常由不同的定位系统来测量,因此可以容易地进行区分。
为了进行期望的误差去相关,要确定自相关的误差部分的自相关模型。因为位置测量通常在时间上离散地存在,因此对于位置测量的位置误差,可以假设阶数A的离散的自相关模型。尤其是要确定模型阶数A和相应的自相关系数γj。
借助事先执行的自相关分析、即所谓的离线自相关分析,可以确定自相关模型的阶数A。为此,在离线自相关分析中,记录具有位置测量的数据组。此外,附加地在相同的时间段中记录具有参考位置测量的数据组。现在,在每个时间点通过参考位置测量和的差来确定误差这产生位置误差的时间序列。随后,分析ea的自相关函数。模型阶数A例如根据数量级明显与0不同的自相关系数的最大指数(Index)来确定。
基于模型阶数A,可以针对位置误差ea的时间序列确定相应阶数的自回归模型。对此,在文献中已知不同的方法。在离线方法中,最简单的方法是,针对γj使用已经计算的自相关系数。替换地,可以在线地使用如下方法,该方法例如基于尤尔-沃克(Yule-Waiker)方程、最小二乘法或者Burg法。
下面,参考图2描述使用第一定位系统14的位置测量和第二定位系统15的位置测量的方法20。
首先,在步骤21中,缓存第一定位系统14的第一位置测量的足够的集合。在步骤22中,缓存第二定位系统15的第二位置测量的足够的集合。相应的第一位置测量和第二位置测量的数量A(=自相关模型的阶数)是足够的。
最后,在步骤23中,在当前的时间点,由第一定位系统14采集第三位置测量应当注意,第一位置测量和第二位置测量在时间上在第三位置测量之前进行。
现在,在步骤24中,对于每个过去的时间点i,根据位置测量和计算位置测量的位置误差的估计
从下面的方程(6)和(7)中可以看到,位置误差的估计对应于相应的第一位置测量的自相关的位置误差与相应的第二位置测量的位置误差之间的差。
同样缓存数量A个位置误差估计
假设两个测量的误差彼此不相关,则误差估计的特性根据即与原始的位置测量相比更少地自相关。
在步骤25中,可以使用所缓存的A个位置误差估计来确定位置的改善的估计。为此,根据下面的方程,从当前确定的第三位置测量中减去位置误差的自相关部分:
下面的方程(9)至(14)示出了现在同样可以借助白噪声将该估计(根据方程14)的位置误差模型化,并且适用方程(15)。
总之,提供了一种用于将位置误差去相关的方法。在此,将误差自相关的位置测量的集合与误差通过白噪声来确定的位置测量的集合进行比较。由此确定仅还受白噪声影响的位置
参考图3描述方法30,当提供至少三个定位系统14-16时,可以使用方法30。三个定位系统14-16的位置测量可以任意地具有与在时间上相关的误差或者在时间上不相关的误差。然而,在不同的定位系统14-16的干扰之间不存在相关性。该方法基于参考图2描述的方法。如先前参考图2所描述的,至少三个定位系统14-16在特定时间点i提供位置测量。下面,用Q表示定位系统的数量。
多次执行该方法的一些步骤(步骤32-39),例如执行的次数与存在的定位系统一样多,即例如执行Q次。因为在该方法的不同的执行中改变不同的定位系统14-16的使用,因此将定位系统14-16从1连续编号至Q。
在步骤31中,将运行变量(Laufvariable)k设置为值1。如从对该方法的进一步描述中将看到的,在该方法的Q次执行中,运行变量k从1增加到Q。
在步骤32中,缓存第k个定位系统的第一位置测量的足够的集合。在步骤33中,缓存其余定位系统的位置测量的足够的集合。其余定位系统包括第k个定位系统之外的所有定位系统。在步骤34中,将其余定位系统的位置测量和相应的第二位置测量融合。为此,在每个测量时间点,将其余定位系统的相应的位置测量与相应的第二位置测量融合。相应的第一位置测量和第二位置测量的数量A(=第k个定位系统的自相关模型的阶数)是足够的。
最后,在步骤35中,在当前的时间点,由第k个定位系统采集第三位置测量。应当注意,第一位置测量和第二位置测量在时间上在第三位置测量之前进行。
如先前参考步骤24(图2)所描述的,在步骤36中确定第三位置测量的位置误差的估计,并且在步骤37中确定相应的临时的自己的位置k。可以以与步骤25(图2)中的自己的位置相同的方式确定临时的自己的位置。
在步骤38中,将运行变量k增加1,并且从步骤32开始继续执行该方法,直到k大于Q(步骤39)。总之,由此确定Q个临时的自己的位置。在步骤40中,将Q个临时的自己的位置合成为融合的自己的位置。融合的自己的位置的误差项不可能具有比Q个临时的自己的位置上的最大的时间上的误差相关性更高的时间上的相关性。这是因为不同的自己的位置的误差项彼此不具有相关性。
附图标记列表
10 车辆
11 设备
12 接口
13 处理器
14 第一定位系统
15、16 第二定位系统
20 方法
21-25 步骤
30 方法
31-40 步骤
Claims (10)
1.一种用于估计自己的位置的方法,所述方法包括:
-通过第一定位系统(14)提供至少一个第一位置测量,
-通过至少一个第二定位系统(15、16)提供至少一个第二位置测量,
-通过第一定位系统(14)提供第三位置测量,所述第三位置测量在时间上在第一和第二位置测量之后进行,以及
-至少根据第三位置测量和至少一个位置误差值来估计自己的位置,所述位置误差值根据所述至少一个第一位置测量和所述至少一个第二位置测量来确定。
2.根据权利要求1所述的方法,其特征在于,所述至少一个位置误差值中的一个位置误差值,包括所述至少一个第一位置测量中的一个第一位置测量与所述至少一个第二位置测量中的一个第二位置测量之间的差值。
3.根据权利要求1或权利要求2所述的方法,其特征在于,
所述方法还包括:
-提供第一定位系统(14)的位置测量的自相关阶数A,以及
至少根据所述第三位置测量和A个位置误差值来估计自己的位置,所述A个位置误差值根据A个第一位置测量和A个第二位置测量来确定。
4.根据权利要求3所述的方法,其特征在于,
所述方法还包括:
-提供A个自相关系数,以及
还至少根据所述A个自相关系数来估计自己的位置。
5.根据权利要求4所述的方法,其特征在于,根据下面的方程来估计自己的位置
其中:
为时间点i的第三位置测量;
γj为A个自相关系数;
为时间点i-1至i-A的A个第一位置测量;以及
为在时间点i-1至i-A的A个第二位置测量。
6.根据前述权利要求中任一项所述的方法,其特征在于,所述第三位置测量、所述至少一个第一位置测量和所述至少一个第二位置测量分别包括绝对位置测量,所述绝对位置测量示出绝对地理位置。
7.根据权利要求1至5中任一项所述的方法,其特征在于,所述第三位置测量、所述至少一个第一位置测量和所述至少一个第二位置测量分别包括相对位置测量,所述相对位置测量示出关于相应的先前的位置测量的相对地理位置。
8.一种使用Q个位置确定源来估计自己的位置的方法,其中,Q大于或者等于3,所述方法包括:
-对于从1到Q中的每个k,按照根据前述权利要求中任一项所述的方法估计相应的临时的自己的位置,其中,
将位置确定源k作为第一定位系统,以及
通过借助将除了k之外的位置确定源1至Q的位置测量组合来确定至少一个第二位置测量,将除了k之外的位置确定源1至Q作为至少一个第二定位系统,以及
-将Q个临时的自己的位置组合为自己的位置。
9.一种设备,所述设备包括:
-接口(12),所述接口被配置为接收第一定位系统(14)的位置测量和至少一个第二定位系统(15、16)的位置测量,
-至少一个处理器(13),所述处理器被配置为执行下面的步骤:
-提供所述第一定位系统(14)的至少一个第一位置测量,
-提供所述至少一个第二定位系统(15、16)的至少一个第二位置测量,
-提供所述第一定位系统(14)的第三位置测量,所述第三位置测量在时间上在第一和第二位置测量之后进行,以及
-至少根据第三位置测量和至少一个位置误差值估计自己的位置,所述位置误差值根据所述至少一个第一位置测量和所述至少一个第二位置测量来确定。
10.根据权利要求9所述的设备,其特征在于,所述设备(11)被设计为用于执行根据权利要求1至8中任一项所述的方法。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE102016222272.4 | 2016-11-14 | ||
DE102016222272.4A DE102016222272B4 (de) | 2016-11-14 | 2016-11-14 | Schätzen einer Eigenposition |
PCT/EP2017/078814 WO2018087257A1 (de) | 2016-11-14 | 2017-11-09 | Schätzen einer eigenposition |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109937341A true CN109937341A (zh) | 2019-06-25 |
CN109937341B CN109937341B (zh) | 2023-06-20 |
Family
ID=60293967
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201780070019.5A Active CN109937341B (zh) | 2016-11-14 | 2017-11-09 | 用于估计自己的位置的方法和设备 |
Country Status (5)
Country | Link |
---|---|
US (1) | US11079236B2 (zh) |
EP (1) | EP3538843B1 (zh) |
CN (1) | CN109937341B (zh) |
DE (1) | DE102016222272B4 (zh) |
WO (1) | WO2018087257A1 (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI726810B (zh) * | 2020-09-10 | 2021-05-01 | 財團法人車輛研究測試中心 | 結合圖資之障礙物追蹤系統及方法 |
CN112985385A (zh) * | 2019-12-13 | 2021-06-18 | 江凯伟 | 应用高精地图的定位定向系统与定位定向方法 |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102016222272B4 (de) * | 2016-11-14 | 2018-05-30 | Volkswagen Aktiengesellschaft | Schätzen einer Eigenposition |
DE102017108130B4 (de) | 2017-04-13 | 2024-02-29 | Volkswagen Aktiengesellschaft | Verfahren zur Datenfusion eines Datensatzes, entsprechende Recheneinheit und Fahrzeug welches mit einer entsprechenden Recheneinheit ausgestattet ist sowie Computerprogramm |
JP7020348B2 (ja) * | 2018-08-30 | 2022-02-16 | トヨタ自動車株式会社 | 自車位置推定装置 |
DE102019216104A1 (de) * | 2019-10-18 | 2021-04-22 | Zf Friedrichshafen Ag | Verfahren zum Verarbeiten von GPS-Positionssignalen bei einem Fahrzeug |
EP4111233A1 (en) | 2020-02-27 | 2023-01-04 | Volvo Truck Corporation | Ad or adas aided maneuvering of a vehicle |
DE102020214148A1 (de) | 2020-11-11 | 2022-05-12 | Robert Bosch Gesellschaft mit beschränkter Haftung | Verfahren und Vorrichtung zum Betreiben eines automatisierten Fahrzeugs |
DE102020133330A1 (de) | 2020-12-14 | 2022-06-15 | Bayerische Motoren Werke Aktiengesellschaft | Computerimplementiertes Verfahren zur Schätzung einer Fahrzeugposition |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6240367B1 (en) * | 1998-11-27 | 2001-05-29 | Ching-Fang Lin | Full fusion positioning method for vehicle |
US20090248301A1 (en) * | 2008-03-31 | 2009-10-01 | Honeywell International Inc. | Position estimation for navigation devices |
US20100169006A1 (en) * | 2006-02-20 | 2010-07-01 | Toyota Jidosha Kabushiki Kaisha | Positioning system, positioning method and car navigation system |
CN102216802A (zh) * | 2008-11-19 | 2011-10-12 | 丰田自动车株式会社 | 移动单元位置测量设备和移动单元位置测量方法 |
CN102914785A (zh) * | 2011-08-03 | 2013-02-06 | 哈曼贝克自动系统股份有限公司 | 基于卫星定位数据和车辆传感器数据的车辆导航 |
Family Cites Families (31)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE3418081A1 (de) | 1984-05-16 | 1985-11-21 | Teldix Gmbh, 6900 Heidelberg | Ortungsverfahren fuer fahrzeuge, insbesondere fuer landfahrzeuge |
DE3418339C2 (de) | 1984-05-17 | 1986-03-27 | Gebrüder Holder GmbH & Co, 7430 Metzingen | Behälteranordnung für landwirtschaftliche Spritzgeräte |
AU642638B2 (en) | 1989-12-11 | 1993-10-28 | Caterpillar Inc. | Integrated vehicle positioning and navigation system, apparatus and method |
US5774829A (en) * | 1995-12-12 | 1998-06-30 | Pinterra Corporation | Navigation and positioning system and method using uncoordinated beacon signals in conjunction with an absolute positioning system |
US5923286A (en) * | 1996-10-23 | 1999-07-13 | Honeywell Inc. | GPS/IRS global position determination method and apparatus with integrity loss provisions |
US6826478B2 (en) * | 2002-04-12 | 2004-11-30 | Ensco, Inc. | Inertial navigation system for mobile objects with constraints |
WO2006052941A1 (en) * | 2004-11-05 | 2006-05-18 | Panasonic Avionics Corporation | System and method for receiving broadcast content on a mobile platform during international travel |
US7848881B2 (en) * | 2005-07-05 | 2010-12-07 | Containertrac, Inc. | Automatic past error corrections for location and inventory tracking |
US8718937B2 (en) * | 2005-09-28 | 2014-05-06 | Honeywell International Inc. | Methods and apparatus for real time position surveying using inertial navigation |
US8688375B2 (en) * | 2006-05-31 | 2014-04-01 | Trx Systems, Inc. | Method and system for locating and monitoring first responders |
US20080033645A1 (en) * | 2006-08-03 | 2008-02-07 | Jesse Sol Levinson | Pobabilistic methods for mapping and localization in arbitrary outdoor environments |
JP5046601B2 (ja) * | 2006-09-28 | 2012-10-10 | ハネウェル・インターナショナル・インコーポレーテッド | 慣性航法を使用した実時間位置測量のための方法及び装置 |
JP4453728B2 (ja) * | 2007-08-07 | 2010-04-21 | 株式会社デンソー | 位置補正装置 |
NZ584205A (en) * | 2007-09-28 | 2012-12-21 | Leica Geosystems Ag | A positioning system and method integrating measurements from Global Navigation Satellite Systems (GNSS) and Inertial Navigation Systems (INS) |
US8965604B2 (en) * | 2008-03-13 | 2015-02-24 | General Electric Company | System and method for determining a quality value of a location estimation of a powered system |
US8165728B2 (en) * | 2008-08-19 | 2012-04-24 | The United States Of America As Represented By The Secretary Of The Navy | Method and system for providing a GPS-based position |
CN102575938A (zh) * | 2009-10-23 | 2012-07-11 | 梅思安安全设备有限公司 | 导航系统初始化系统、方法和配置 |
US20110238308A1 (en) * | 2010-03-26 | 2011-09-29 | Isaac Thomas Miller | Pedal navigation using leo signals and body-mounted sensors |
US8756001B2 (en) * | 2011-02-28 | 2014-06-17 | Trusted Positioning Inc. | Method and apparatus for improved navigation of a moving platform |
ITTO20110686A1 (it) * | 2011-07-28 | 2013-01-29 | Sisvel Technology Srl | Metodo per garantire la continuità di servizio di un dispositivo di navigazione personale e relativo dispositivo |
US8843314B2 (en) * | 2013-01-04 | 2014-09-23 | General Motors Llc | High fidelity horizontal position error estimation for vehicular GPS/DR navigation |
US8862394B2 (en) * | 2013-01-22 | 2014-10-14 | Ensco, Inc. | System and method for tracking and locating a person, animal, or machine |
US9766322B2 (en) * | 2013-03-14 | 2017-09-19 | Ensco, Inc. | Geolocation with radio-frequency ranging |
DE102014211166A1 (de) | 2013-11-20 | 2015-05-21 | Continental Teves Ag & Co. Ohg | Verfahren, Fusionsfilter und System zur Fusion von Sensorsignalen mit unterschiedlichen zeitlichen Signalausgabeverzügen zu einem Fusionsdatensatz |
FR3018383B1 (fr) * | 2014-03-07 | 2017-09-08 | Airbus Operations Sas | Procede et dispositif de determination de parametres de navigation d'un aeronef lors d'une phase d'atterrissage. |
US9612325B2 (en) * | 2014-06-02 | 2017-04-04 | Ensco, Inc. | Unwrapping and prediction of distance and velocity measurements using carrier signals |
US9271258B2 (en) * | 2014-06-02 | 2016-02-23 | Ensco, Inc. | Distance and velocity measurements using carrier signals |
IL234691A (en) * | 2014-09-16 | 2017-12-31 | Boyarski Shmuel | A method and system for inertial navigation using a world-wide fastening system |
US9945100B2 (en) * | 2015-07-09 | 2018-04-17 | Caterpillar Inc. | Positioning system and method for determining location of machine |
US9964949B2 (en) * | 2015-12-18 | 2018-05-08 | Gm Global Technology Operation Llc | Operating modes for autonomous driving |
DE102016222272B4 (de) * | 2016-11-14 | 2018-05-30 | Volkswagen Aktiengesellschaft | Schätzen einer Eigenposition |
-
2016
- 2016-11-14 DE DE102016222272.4A patent/DE102016222272B4/de active Active
-
2017
- 2017-11-09 CN CN201780070019.5A patent/CN109937341B/zh active Active
- 2017-11-09 US US16/349,032 patent/US11079236B2/en active Active
- 2017-11-09 WO PCT/EP2017/078814 patent/WO2018087257A1/de active Application Filing
- 2017-11-09 EP EP17797146.2A patent/EP3538843B1/de active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6240367B1 (en) * | 1998-11-27 | 2001-05-29 | Ching-Fang Lin | Full fusion positioning method for vehicle |
US20100169006A1 (en) * | 2006-02-20 | 2010-07-01 | Toyota Jidosha Kabushiki Kaisha | Positioning system, positioning method and car navigation system |
US20090248301A1 (en) * | 2008-03-31 | 2009-10-01 | Honeywell International Inc. | Position estimation for navigation devices |
CN102216802A (zh) * | 2008-11-19 | 2011-10-12 | 丰田自动车株式会社 | 移动单元位置测量设备和移动单元位置测量方法 |
CN102914785A (zh) * | 2011-08-03 | 2013-02-06 | 哈曼贝克自动系统股份有限公司 | 基于卫星定位数据和车辆传感器数据的车辆导航 |
Non-Patent Citations (1)
Title |
---|
ANNE-CHRISTINE ESCHER 等: "GPS/IRS hybridization : definition of exclusion radius using solution separation method", 《IFIS 2002, 12TH INTERNATIONAL FLIGHT INSPECTION SYMPOSIUM》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112985385A (zh) * | 2019-12-13 | 2021-06-18 | 江凯伟 | 应用高精地图的定位定向系统与定位定向方法 |
TWI726810B (zh) * | 2020-09-10 | 2021-05-01 | 財團法人車輛研究測試中心 | 結合圖資之障礙物追蹤系統及方法 |
Also Published As
Publication number | Publication date |
---|---|
DE102016222272A1 (de) | 2018-05-17 |
DE102016222272B4 (de) | 2018-05-30 |
US11079236B2 (en) | 2021-08-03 |
EP3538843A1 (de) | 2019-09-18 |
EP3538843B1 (de) | 2024-08-07 |
CN109937341B (zh) | 2023-06-20 |
US20190265041A1 (en) | 2019-08-29 |
WO2018087257A1 (de) | 2018-05-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109937341B (zh) | 用于估计自己的位置的方法和设备 | |
KR102463176B1 (ko) | 위치 추정 장치 및 방법 | |
EP2133662B1 (en) | Methods and system of navigation using terrain features | |
JP5673071B2 (ja) | 位置推定装置及びプログラム | |
KR101535873B1 (ko) | 위성측위시스템과 추측 항법을 융합한 차량 위치 추정 시스템 및 방법 | |
JP6656886B2 (ja) | 情報処理装置、制御方法、プログラム及び記憶媒体 | |
US7792330B1 (en) | System and method for determining range in response to image data | |
EP3321632A1 (en) | A navigation system | |
JP5261842B2 (ja) | 移動体位置検出方法および移動体位置検出装置 | |
CN110889808A (zh) | 一种定位的方法、装置、设备及存储介质 | |
CN113670334B (zh) | 一种飞行汽车的初始对准方法和装置 | |
JP6060642B2 (ja) | 自己位置推定装置 | |
KR20210143696A (ko) | 차량의 위치 표시 방법 및 장치 | |
JP2016080460A (ja) | 移動体 | |
KR101764222B1 (ko) | 고정밀 측위 시스템 및 방법 | |
CN110637209B (zh) | 估计机动车的姿势的方法、设备和具有指令的计算机可读存储介质 | |
CN107764273B (zh) | 一种车辆导航定位方法及系统 | |
Magnusson et al. | Improving absolute position estimates of an automotive vehicle using GPS in sensor fusion | |
CN114279454A (zh) | 用于在环境中导航移动平台的方法和系统 | |
KR20130036145A (ko) | 이동 정보 결정 장치, 수신기 및 그에 의한 방법 | |
Georgy | Advanced nonlinear techniques for low cost land vehicle navigation | |
KR101141984B1 (ko) | Dr/gps 데이터 융합 방법 | |
KR102622587B1 (ko) | 정밀측위 시스템의 종방향 위치 오차를 보정하기 위한 장치 및 방법 | |
EP3508884B1 (en) | Intelligent satellite exclusion for multipath mitigation based on line of sight | |
KR20170015768A (ko) | Gnss 음영 지역에서의 위치 보정 시스템 및 방법 |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |