CN105698787B - 利用航位推算和gps的复合导航系统及其方法 - Google Patents
利用航位推算和gps的复合导航系统及其方法 Download PDFInfo
- Publication number
- CN105698787B CN105698787B CN201410709719.2A CN201410709719A CN105698787B CN 105698787 B CN105698787 B CN 105698787B CN 201410709719 A CN201410709719 A CN 201410709719A CN 105698787 B CN105698787 B CN 105698787B
- Authority
- CN
- China
- Prior art keywords
- location information
- information
- dead reckoning
- gps
- moving body
- 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.)
- Active
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/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
- 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/03—Cooperating elements; Interaction or communication between different cooperating elements or between cooperating elements and receivers
- G01S19/05—Cooperating elements; Interaction or communication between different cooperating elements or between cooperating elements and receivers providing aiding data
-
- 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/03—Cooperating elements; Interaction or communication between different cooperating elements or between cooperating elements and receivers
- G01S19/07—Cooperating elements; Interaction or communication between different cooperating elements or between cooperating elements and receivers providing data for correcting measured positioning data, e.g. DGPS [differential GPS] or ionosphere corrections
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)
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明涉及一种利用航位推算和GPS的复合导航系统及其方法,通过补偿GPS接收数据的非连续性而提高了定位的稳健性。根据本发明的一实施例的利用航位推算和GPS的复合导航系统,包括:GPS接收部,接收GPS数据;航位推算部,利用轮速、转向角及角速度而生成航位推算信息;缓冲部,保存所述航位推算信息;及过滤部,利用所述GPS接收部的输出信息及保存到所述缓冲部的所述航位推算信息中的至少一个而生成移动体的定位信息。
Description
技术领域
本发明涉及利用航位推算和GPS的复合导航系统及其方法,更详细地说,涉及一种利用航位推算和GPS的复合导航系统及其方法,通过补偿GPS接收数据的非连续性而提高了定位的稳健性。
背景技术
因低级、小型、低电力、低价的全球定位系统(Global Positioning System:以下称"GPS")接收器的开发,商用车辆导航系统主要使用的定位传感器为GPS接收器,使GPS接收器获得的车辆位置信息与数字地图进行地图匹配(mapmatching)而向使用者提供基于位置的服务(LBS:Location Based Service),如提供自己的位置、速度等导航信息及引路、告知危险区域等。
但是,GPS接收器的问题点在于,在隧道、地下停车场、城市中心区域等会导致GPS信号完全/部分隔绝的地点,无法提供正确的位置信息。
因此,为了无间断地提供这种定位信息,结合由速度计、地磁场传感器、惯性传感器等构成的航位推算(DR:Dead Reckoning-航位推算)系统与GPS接收器而构成DR/GPS复合导航系统。
这种DR/GPS复合导航系统可根据航位推算(DR)的形态、复合技法、复合滤波器而构成为多种形态。
这里,作为复合滤波器,大部分使用卡尔曼滤波器。为了将用于线性系统的卡尔曼滤波器适用到非线性系统即DR/GPS复合导航系统而使用扩展卡尔曼滤波器(EKF:ExtendedKalman Filter)。
另外,GPS接收的数据相比同一时间输入的其他传感器数据而言,属于时间迟延(Delay)的数据,因此若不考虑此而结合GPS接收数据与DR数据,会降低自己位置推测的性能。
发明内容
(要解决的技术问题)
本发明要解决的技术问题是提供一种利用航位推算和GPS的复合导航系统及其方法,补偿GPS接收数据的非连续性而提高了定位的稳健性。
本发明的目的并不限定于以上涉及的目的,未涉及的其他目的可通过如下记载而被本领域从业者所明确理解。
(解决问题的手段)
如所述,为达成本发明,根据本发明的一实施例的利用航位推算与GPS的复合导航系统,包括:GPS接收部,接收GPS数据;航位推算部,利用轮速、转向角及角速度而生成航位推算信息;缓冲部,保存所述航位推算信息;及过滤部,利用所述GPS接收部的输出信息及保存到所述缓冲部的所述航位推算信息中的至少一个而生成移动体的定位信息。
所述航位推算部,包括:移动距离演算部,利用所述轮速而演算所述移动体的移动距离;曲率演算部,利用所述角速度及所述转向角而演算所述移动体的行驶曲率;推测部,利用演算的移动距离及演算的行驶曲率而推测所述移动体的定位信息。
所述航位推算部还包括:偏差补正部,补正所述角速度的偏移偏差(OffsetBias)。
所述缓冲部按照已设定的规定个数,保存从当前时点到之前时点所生成的所述航位推算信息。
当所述GPS接收部的输出信息被输入到所述复合导航系统的周期时,所述过滤部考虑到所述GPS接收部与所述航位推算部之间的时间迟延,从所述缓冲部选择所述GPS接收部的输出信息及同步的航位推算信息,利用所述GPS接收部的输出信息及所述被选的航位推算信息而生成所述移动体的定位信息。
当所述GPS接收部的输出信息未输入到所述复合导航系统的周期时,所述过滤部只利用所述航位推算信息而生成所述移动体的定位信息。
所述过滤部基于利用所述GPS接收部的输出信息及所述被选的航位推算信息而生成的所述移动体的定位信息,更新保存到所述缓冲部的所述航位推算信息。
并且,根据本发明的一实施例的利用航位推算和GPS的复合导航系统,还可包括:合并判断部,比较所述GPS接收部的输出信息与所述被选的航位推算信息之间的偏差和预期误差,判断所述GPS接收部的输出信息及所述被选的航位推算信息的合并与否。
当所述偏差超过所述预期误差时,所述合并判断部只利用所述被选的航位推算信息而生成所述移动体的定位信息。
为达成前述目的的,根据本发明的另一实施例的利用航位推算和GPS的复合导航系统,包括:GPS接收部,接收GPS数据而每第1周期提供可视卫星的位置及伪距信息;航位推算部,利用轮速、转向角及角速度而每第2周期生成航位推算信息;缓冲部,按照已设定的规定个数,保存从当前时点到之前时点所生成的所述航位推算信息;及过滤部,利用所述GPS接收部的输出信息及保存到所述缓冲部的所述航位推算信息中的至少一个而第3周期生成移动体的定位信息。
当所述第3周期所相应的时点,输入所述GPS接收部的输出信息时,所述过滤部考虑到所述GPS接收部及所述航位推算部之间的时间迟延,从所述缓冲部选择所述GPS接收部的输出信息及同步的航位推算信息,并利用所述GPS接收部的输出信息及所述被选的航位推算信息而生成所述移动体的定位信息。
并且,根据本发明的另一实施例的利用航位推算和GPS的复合导航系统,还可包括:合并判断部,比较所述GPS接收部的输出信息及所述被选的航位推算信息之间的偏差与预期误差,所述偏差超过所述预期误差时,判断为只利用所述被选的航位推算信息而生成所述移动体的定位信息。为达成前述目的的,根据本发明的另一实施例的利用航位推算和GPS的复合导航系统的位置推测方法,包括:处理已接收的GPS数据而生成移动体的第1位置信息的步骤;利用轮速、转向角及角速度而生成所述移动体的第2位置信息的步骤;保存所述第2位置信息的步骤;及利用所述第1位置信息及所述保存的第2位置信息中的至少一个而生成移动体的定位信息。
(发明的效果)
根据如上所述的本发明,其优点在于,通过补偿GPS接收数据的非连续性而保障定位的稳健性。
附图说明
图1是图示根据本发明的实施例的利用航位推算和GPS的复合导航系统的框图。
图2是用于说明图1中图示的过滤部中合并GPS接收部的输出信息与航位推算信息的方法的图。
图3是图示根据本发明的实施例的利用航位推算和GPS的复合导航系统的位置推测方法的顺序图。
具体实施方式
本发明的优点及特征,以及达成这些的方法,可通过参照附图和详细说明的实施例而明确理解。但本发明并不限定于以下公开的实施例,而是以多种形态体现,提出这些实施例的目的在于,使本发明公开完整,并向本发明所述技术领域具有一般知识的人完整地告知本发明的范畴,本发明根据权利要求的范围而定义。另外,本说明书中使用的用语是为了说明本发明,而不是为了限制本发明。除了有特殊说明的以外,本说明书中的单数型包括复数型。说明书中使用的“包括(comprises)”及/或“包括的(comprising)”涉及的构成要素、阶段、动作及/或要素并不排除一个以上的其他构成要素、阶段、动作及/或要素的存在或增加。
下面,参照附图详细说明根据本发明的优选实施例。首先,关于为各附图的构成要素附加参照符号,相同的构成要素即使标示在不同的附图上,也尽可能使用了相同的符号。并且,说明本发明时,判断为相关的公开构成或功能的具体说明有可能会混淆本发明的技术要旨时,省略其详细的说明。
图1是图示根据本发明的实施例的利用航位推算和GPS的复合导航系统的框图。
参照图1,根据本发明的实施例的利用航位推算和GPS的复合导航系统包括:GPS接收部100、航位推算部200、缓冲部300、合并判断部400、过滤部500。
GPS接收部100从GPS卫星接收移动体的定位数据(纬度、经度,前进方向)、误差信息(DOP,Stdev)、模式信息、卫星数量等信息,并对此进行处理后输出所述移动体的第1位置信息。
航位推算部200利用用于测定移动体的行驶距离的传感器(例如,速度计、行驶距离计、加速度计等)所测定的轮速、用于测定所述移动体的旋转角的传感器(例如,地磁传感器、陀螺仪传感器等)所测定的角速度(Yaw rate)及转向角,推测对所述移动体的第2位置信息。
航位推算部200由偏差补正部210、曲率演算部220、移动距离演算部230、推测部240构成,生成对所述移动体的第2位置信息,即航位推算信息。
偏差补正部210补正已测定的角速度的偏移偏差(Offset bias)。测定角速度的传感器存在偏移偏差,原则上,在移动体停止或直线移动时,角速度应为0值。因此,通过测定初期时点(速度为0时)的偏移偏差并从速度测定值减去该偏移偏差的方法而补正角速度的偏移偏差。
曲率演算部220利用已补正的角速度及转向角而推测移动体的行驶曲率。利用角速度推测曲率时,会存在推测噪声,尤其,低速时的推测噪声较大。另外,利用转向角的曲率推测呈现较高的连续性,但存在推测偏向。因角速度及转向角呈现互补性的一面,若合并该两项而推测曲率,会获得精确的行驶曲率。这时,使用卡尔曼滤波器。
移动距离演算部230利用已测定的轮速及方向盘大小而演算所述移动体的移动速度。
推测部240利用已通过轮速演算的移动距离(ds)及推测度或曲率(k)而通过DeadReckoning(航位推算,DR)推测移动体的定位(例如,移动体的纬度、经度、前进方向)。k*ds为前进方向的变化量,利用该变化量而更新维度、经度信息且同时演算各要素的协方差(Covariance)值。
缓冲部300保存所述航位推算部200所推测的所述移动体的第2位置信息。
通过一系列过程而推测的所述第2位置信息在后述的过滤部500中,与所述GPS接收部100输出的第1位置信息合并而生成移动体的定位信息。
一般地说,GPS接收部100处理接收的GPS数据并输出所述第1位置信息需要处理数据的时间。因这种理由,即使相同时间生成所述第1位置信息及所述第2位置信息,2个信息之间会发生时间迟延(Delay)。大致地说,所述第1位置信息比所述第2位置信息迟延60ms。即,t=0时生成的第1位置信息与-60ms时生成的第2位置信息具有同步的时间。
因此,为了合并GPS接收部100生成的所述第1位置信息及与此同步的第2位置信息,需要在规定的时间内,或按照规定的个数,保存所述第2位置信息。根据本发明的实施例的利用航位推算和GPS的复合导航系统,缓冲部300在规定的时间内,或按照规定的个数,保存所述第2位置信息,从而提供后述的过滤部500能够合并时间同步的第1及第2位置信息的方案。
另外,即使所述GPS接收部100接收到GPS数据,但可能会因信号不良或其他原因而导致定位弹出。这时,除了所述GPS接收部100输出的第1位置信息以外,优选地,只利用所述航位推算部200推测的第2位置信息而生成移动体的定位信息。
合并判断部400在发生前述的定位弹出时,判断为不合并所述第1及第2位置信息而只利用所述第2位置信息而生成所述移动体的定位信息。即,所述合并判断部400判断所述第1及第2位置信息的合并与否。
合并判断部400判断所述第1位置信息及所述第2位置信息之间的偏差是否超过已设定的预期误差,其结果为所述偏差超过所述预期误差时,判断为定位弹而不合并2个信息,判断为只利用所述第2位置信息而生成所述移动体的定位信息。以下数学式1是合并判断部400为了决定2个信息的合并与否而利用的数学式。这里,DRx为第2位置信息,GPSx为第1位置信息,P_DRx为第2位置信息的预期误差方差,P_GPSx为第1位置信息的预期误差方差,ε为预期误差。
[数学式1]
另外,所述合并判断部400中作为所述第1位置信息的比较对象的第2位置信息,注意是保存到所述缓冲部300的多个位置信息中与所述第1位置信息时间同步的位置信息。
过滤部500利用所述GPS接收部100输出的第1位置信息及保存到所述缓冲部300的所述第2位置信息中的至少一个而生成所述移动体的定位信息。这时,可使用卡尔曼滤波器。
例如,假设根据本发明的实施例的利用航位推算和GPS的复合导航系统的周期为20ms,GPS接收部100的周期为100ms,航位推算部200的周期为10ms。据此,所述GPS接收部100以100ms周期输出第1位置信息,所述航位推算部200以10ms周期输出第2位置信息,所述过滤部500以20ms为单位合并所述第1与第2位置信息。
根据具体情况,所述过滤部500想要合并所述第1与第2位置信息时,可能会发生不存在所述GPS接收部100输出的第1位置信息的情况。这时,所述过滤部500只利用所述第2位置信息而生成所述移动体的定位信息。
另一方面,所述过滤部500想要合并所述第1与第2位置信息时,若存在所述GPS接收部100输出的第1位置信息且所述合并判断部400判断为合并2个位置信息,所述过滤部500利用所述第1位置信息及所述第2位置信息而生成所述移动体的定位信息。这时,所述第2位置信息是与所述第1位置信息时间同步的。
图2是用于说明图1中图示的过滤部中合并GPS接收部的输出信息与航位推算信息的方法的图。
参照图2,例示性地图示了所述缓冲部300保存了航位推算信息,即以20ms周期保存4个(-60ms、-40ms、-20ms、0ms(当前时间))第2位置信息。
所述GPS接收部100以100ms周期而输出4个第1位置信息(-300ms、-200ms、-100ms、0ms(当前时间)),假设所述第1位置信息与所述第2位置信息之间存在60ms的时间迟延,当前时间(0ms)输出的第1位置信息实际上是-60ms输出的,与此相同,-300ms输出的第1位置信息实际上是-360ms输出的。
因此,当前时间(0ms)输出的第1位置信息及时间同步的第2位置信息相当于-60ms时点输出的信息(DR4),所述过滤部300在保存到所述缓冲部300的多个第2位置信息中选择与所述第1位置信息时间同步的位置信息(DR4)并合并(DR4+GPS)2个信息。如所述,根据本发明的实施例的利用航位推算和GPS的复合导航系统,考虑时间迟延而合并GPS数据及航位推算信息,从而提高了移动体的定位性能。
以下,本参照图1至图3,说明根据本发明的实施例的利用航位推算和GPS的复合导航系统的位置推测方法。
图3是图示根据本发明的实施例的利用航位推算和GPS的复合导航系统的位置推测方法的顺序图。
首先,GPS接收部100从GPS卫星接收移动体的定位数据(纬度、经度、前进方向)、误差信息(DOP,Stdev)、模式信息、卫星数量等信息并对此进行处理而输出所述移动体的第1位置信息(S100)。
而且,航位推算部200利用用于测定移动体的行驶距离的传感器(例如,速度计、行驶距离计、加速度计等)所测定的轮速、用于测定所述移动体的旋转角的传感器(例如,地磁传感器、陀螺仪传感器等)所测定的角速度(Yaw rate)及转向角,推测对所述移动体的第2位置信息(S200)。
而且,要合并所述第1与第2位置信息时,过滤部500判断是否存在所述GPS接收部100输出的第1位置信息(S300)。
根据具体情况,所述过滤部500想要合并所述第1与第2位置信息时,可能会发生不存在所述GPS接收部100输出的第1位置信息的情况。这时,所述过滤部500只利用所述第2位置信息而生成所述移动体的定位信息(S700)。
另一方面,所述过滤部500想要合并所述第1与第2位置信息时,若存在所述GPS接收部100输出的第1位置信息,在保存到缓冲部300的多个第2位置信息中选择与所述第1位置信息时间同步的第2位置信息(S400)。
选择与所述第1位置信息时间同步的第2位置信息的过程已通过图3进行了说明,因此省略对此的具体说明。
然后,合并判断部400判断所述第1位置信息与所述第2位置信息之间的偏差是否超过已设定的预期误差(S500)。
其结果为所述偏差超过所述预期误差时,合并判断部400将此判断为定位弹而不合并2个信息,只利用所述第2位置信息而生成所述移动体的定位信息。这时,这时,所述过滤部500只利用所述第2位置信息而生成所述移动体的定位信息(S700)。
另一方面,所述合并判断部400判断为合并2个位置信息时,所述过滤部500利用所述第1位置信息与所述第2位置信息而生成所述移动体的定位信息(S600)。这时,所述第2位置信息是与所述第1位置信息时间同步的。
在本发明所属技术领域具有一般知识的人能够理解本发明无需变更技术思想或必要特征而能够实施为其他具体形态。因此,应理解为以上所述的实施例在整个方面是例示性的,而不是限定性的。本发明的保护范围应根据所述的权利要求范围所解释,权利要求范围及与其同等概念导出的所有变更或变形形态都属于本发明。
Claims (15)
1.利用航位推算和GPS的复合导航系统,包括:
GPS接收部,接收GPS数据;
航位推算部,利用轮速、转向角及角速度而生成航位推算信息;
缓冲部,保存所述航位推算信息;
过滤部,利用所述GPS接收部的输出信息及保存到所述缓冲部的所述航位推算信息中的至少一个而生成移动体的定位信息;及
合并判断部,比较所述GPS接收部的输出信息与保存到所述缓冲部的所述航位推算信息之间的偏差和预期误差,判断所述GPS接收部的输出信息与保存到所述缓冲部的所述航位推算信息的合并与否,
所述合并判断部利用数学式1决定所述输出信息与保存到所述缓冲部的所述航位推算信息之间的合并与否,
数学式1:
其中,DRx为根据保存到所述缓冲部的所述航位推算信息的第2位置信息,GPSx为根据所述GPS接收部的输出信息的第1位置信息,P_DRx为第2位置信息的预期误差方差,P_GPSx为第1位置信息的预期误差方差,ε为预期误差。
2.根据权利要求1所述的利用航位推算和GPS的复合导航系统,
所述航位推算部,包括:
移动距离演算部,利用所述轮速而演算所述移动体的移动距离;
曲率演算部,利用所述角速度及所述转向角而演算所述移动体的行驶曲率;
推测部,利用演算的移动距离及演算的行驶曲率而推测所述移动体的定位信息。
3.根据权利要求2所述的利用航位推算和GPS的复合导航系统,
所述航位推算部,还包括:
偏差补正部,补正所述角速度的偏移偏差。
4.根据权利要求1所述的利用航位推算和GPS的复合导航系统,
所述缓冲部,按照已设定的规定个数,保存从当前时点到之前时点所生成的所述航位推算信息。
5.根据权利要求1所述的利用航位推算和GPS的复合导航系统,
当所述GPS接收部的输出信息被输入到所述复合导航系统的周期时,所述过滤部考虑到所述GPS接收部与所述航位推算部之间的时间迟延,从所述缓冲部选择与所述GPS接收部的输出信息同步的航位推算信息,利用所述GPS接收部的输出信息及所述被选的航位推算信息而生成所述移动体的定位信息。
6.根据权利要求1所述的利用航位推算和GPS的复合导航系统,
当所述GPS接收部的输出信息未输入到所述复合导航系统的周期时,所述过滤部只利用所述航位推算信息而生成所述移动体的定位信息。
7.根据权利要求5所述的利用航位推算和GPS的复合导航系统,
所述过滤部,基于利用所述GPS接收部的输出信息及被选的所述航位推算信息而生成的所述移动体的定位信息,更新保存到所述缓冲部的所述航位推算信息。
8.根据权利要求5所述的利用航位推算和GPS的复合导航系统,
所述合并判断部,
当所述偏差超过所述预期误差时,所述合并判断部只利用被选的所述航位推算信息而生成所述移动体的定位信息。
9.一种利用航位推算和GPS的复合导航系统,包括:
GPS接收部,接收GPS数据而每第1周期提供可视卫星的位置及伪距信息;
航位推算部,利用轮速、转向角及角速度而每第2周期生成航位推算信息;
缓冲部,按照已设定的规定个数,保存从当前时点到之前时点所生成的所述航位推算信息;及
过滤部,利用所述GPS接收部的输出信息及保存到所述缓冲部的所述航位推算信息中的至少一个而每第3周期生成移动体的定位信息;
当所述第3周期所相应的时点,输入所述GPS接收部的输出信息时,所述过滤部考虑到所述GPS接收部及所述航位推算部之间的时间迟延,从所述缓冲部选择与所述GPS接收部的输出信息同步的航位推算信息,并利用所述GPS接收部的输出信息及所述被选的航位推算信息而生成所述移动体的定位信息,所述利用航位推算和GPS的复合导航系统,还包括:
合并判断部,比较所述GPS接收部的输出信息及所述被选的航位推算信息之间的偏差与预期误差,所述偏差超过所述预期误差时,判断为只利用所述被选的航位推算信息而生成所述移动体的定位信息,
所述合并判断部利用数学式1决定所述输出信息与所述被选的航位推算信息之间的合并与否,
数学式1:
其中,DRx为根据所述被选的航位推算信息的第2位置信息,GPSx为根据所述GPS接收部的输出信息的第1位置信息,P_DRx为第2位置信息的预期误差方差,P_GPSx为第1位置信息的预期误差方差,ε为预期误差。
10.一种利用航位推算和GPS的复合导航系统的位置推测方法,包括:
处理已接收的GPS数据而生成移动体的第1位置信息的步骤;
利用轮速、转向角及角速度而生成所述移动体的第2位置信息的步骤;
保存所述第2位置信息的步骤;及
利用所述第1位置信息及所述保存的第2位置信息中的至少一个而生成移动体的定位信息的步骤,
其中,所述生成移动体的定位信息的步骤,包括:
比较所述第1位置信息与所述第2位置信息之间的偏差和预期误差,判断所述第1位置信息与所述第2位置信息的合并与否的步骤,
判断合并与否的所述步骤是利用数学式1决定所述第1位置与所述第2位置之间的合并与否,
数学式1:
其中,DRx为第2位置信息,GPSx为第1位置信息,P_DRx为第2位置信息的预期误差方差,P_GPSx为第1位置信息的预期误差方差,ε为预期误差。
11.根据权利要求10所述的利用航位推算和GPS的复合导航系统的位置推测方法,
所述生成第2位置信息的步骤,包括:
利用所述轮速而演算所述移动体的移动距离的步骤;
利用所述角速度及所述转向角而演算所述移动体的行驶曲率的步骤;及
利用演算的移动距离及演算的行驶曲率而推测所述移动体的定位信息的步骤。
12.根据权利要求10所述的利用航位推算和GPS的复合导航系统的位置推测方法,
所述生成移动体的定位信息的步骤,包括:
所述复合导航系统的周期中生成所述第1位置信息时,考虑到所述第1位置信息与所述第2位置信息之间的时间迟延而选择与所述第1位置信息同步的第2位置信息的步骤;及
利用所述第1位置信息及所述被选的第2位置信息而生成所述移动体的定位信息的步骤。
13.根据权利要求10所述的利用航位推算和GPS的复合导航系统的位置推测方法,
所述生成移动体的定位信息的步骤,包括:
所述复合导航系统的周期中不生成所述第1位置信息时,只利用所述第2位置信息而生成所述移动体的定位信息的步骤。
14.根据权利要求12所述的利用航位推算和GPS的复合导航系统的位置推测方法,
所述生成移动体的定位信息的步骤,
基于利用所述第1位置信息及所述被选的第2位置信息而生成的所述移动体的定位信息,更新所述保存的第2位置信息的步骤。
15.根据权利要求12所述的利用航位推算和GPS的复合导航系统的位置推测方法,
所述判断合并与否的步骤,
所述偏差超过所述预期误差时,判断为只利用所述被选的第2位置信息而生成所述移动体的定位信息。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR10-2014-0134323 | 2014-10-06 | ||
KR1020140134323A KR101697645B1 (ko) | 2014-10-06 | 2014-10-06 | 추측 항법과 gps를 이용한 복합 항법 시스템 및 그 방법 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105698787A CN105698787A (zh) | 2016-06-22 |
CN105698787B true CN105698787B (zh) | 2019-03-19 |
Family
ID=55632709
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410709719.2A Active CN105698787B (zh) | 2014-10-06 | 2014-11-28 | 利用航位推算和gps的复合导航系统及其方法 |
Country Status (3)
Country | Link |
---|---|
US (1) | US9405016B2 (zh) |
KR (1) | KR101697645B1 (zh) |
CN (1) | CN105698787B (zh) |
Families Citing this family (43)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102014211175A1 (de) * | 2014-06-11 | 2015-12-17 | Continental Teves Ag & Co. Ohg | Verfahren und System zur Initialisierung eines Sensorfusionssystems |
JP6082415B2 (ja) * | 2015-03-03 | 2017-02-15 | 富士重工業株式会社 | 車両の走行制御装置 |
US10803420B2 (en) | 2016-09-30 | 2020-10-13 | Staples, Inc. | Hybrid modular storage fetching system |
US10683171B2 (en) | 2016-09-30 | 2020-06-16 | Staples, Inc. | Hybrid modular storage fetching system |
US10589931B2 (en) | 2016-09-30 | 2020-03-17 | Staples, Inc. | Hybrid modular storage fetching system |
DE102016219379A1 (de) * | 2016-10-06 | 2018-04-12 | Continental Teves Ag & Co. Ohg | Verfahren zur Ermittlung einer Orientierung eines Fahrzeugs |
CN106781271A (zh) * | 2016-11-21 | 2017-05-31 | 南京邮电大学 | 一种基于加速度传感器的老年人跌倒救助系统和方法 |
JP6739378B2 (ja) * | 2017-03-10 | 2020-08-12 | 三菱電機株式会社 | 航法システムおよび航法方法 |
KR20190014726A (ko) * | 2017-08-03 | 2019-02-13 | 한국항공우주연구원 | 데이터 동기화 및 위치 추정 기법을 사용한 실시간 위치 제공 장치 및 방법 |
KR102109953B1 (ko) * | 2017-11-24 | 2020-05-12 | 현대오트론 주식회사 | 요레이트 센서를 이용한 차량 위치 추정 장치 및 그것의 차량 위치 추정 방법 |
KR102396855B1 (ko) * | 2017-12-05 | 2022-05-11 | 현대모비스 주식회사 | 측위 방향각 추정 시스템 및 방법 |
US10593133B2 (en) * | 2017-12-07 | 2020-03-17 | International Business Machines Corporation | Determining a current position of a vehicle in real-time |
CN110109161A (zh) * | 2018-02-01 | 2019-08-09 | 高德信息技术有限公司 | 一种指纹特征采集方法和装置 |
CN110361003B (zh) * | 2018-04-09 | 2023-06-30 | 中南大学 | 信息融合方法、装置、计算机设备和计算机可读存储介质 |
CN111033423B (zh) * | 2018-04-18 | 2023-11-21 | 百度时代网络技术(北京)有限公司 | 用于评估自动驾驶车辆的定位系统的方法 |
CN109001789B (zh) * | 2018-06-05 | 2020-05-22 | 西安交通大学 | 一种基于互相关熵配准的无人车定位融合方法 |
US11084410B1 (en) | 2018-08-07 | 2021-08-10 | Staples, Inc. | Automated guided vehicle for transporting shelving units |
US11590997B1 (en) | 2018-08-07 | 2023-02-28 | Staples, Inc. | Autonomous shopping cart |
US11630447B1 (en) | 2018-08-10 | 2023-04-18 | Staples, Inc. | Automated guided vehicle for transporting objects |
US11662477B2 (en) | 2018-11-16 | 2023-05-30 | Westinghouse Air Brake Technologies Corporation | System and method for determining vehicle position by triangulation |
US11180069B2 (en) | 2018-12-31 | 2021-11-23 | Staples, Inc. | Automated loading of delivery vehicles using automated guided vehicles |
US11119487B2 (en) | 2018-12-31 | 2021-09-14 | Staples, Inc. | Automated preparation of deliveries in delivery vehicles using automated guided vehicles |
KR20200119920A (ko) * | 2019-03-19 | 2020-10-21 | 현대모비스 주식회사 | 자동 발렛 파킹 시스템의 위치 추정 장치 및 방법 |
US11124401B1 (en) | 2019-03-31 | 2021-09-21 | Staples, Inc. | Automated loading of delivery vehicles |
CN110174103A (zh) * | 2019-04-02 | 2019-08-27 | 合肥杰发科技有限公司 | 一种车载导航方法及装置 |
KR102285090B1 (ko) * | 2019-04-18 | 2021-08-03 | (주)굿게이트 | 복수의 디바이스 각각에서 객체의 위치를 결정하기 위한 방법, 시스템 및 비일시성의 컴퓨터 판독 가능한 기록 매체 |
CN110068338A (zh) * | 2019-04-30 | 2019-07-30 | 杭州视氪科技有限公司 | 一种路线记忆系统及方法 |
KR20210152549A (ko) | 2019-05-01 | 2021-12-15 | 스위프트 내비게이션, 인크. | 고-무결성 위성 포지셔닝을 위한 시스템 및 방법 |
WO2021025729A1 (en) * | 2019-08-07 | 2021-02-11 | John Rankin | Determining proximity and attraction of objects within a coordinate system |
CN110324783B (zh) * | 2019-08-14 | 2021-06-18 | 百度在线网络技术(北京)有限公司 | 车辆航迹推算服务的控制方法、装置、设备及存储介质 |
US11300689B2 (en) | 2020-02-14 | 2022-04-12 | Swift Navigation, Inc. | System and method for reconverging GNSS position estimates |
US11452064B2 (en) | 2020-03-09 | 2022-09-20 | Rankin Labs, Llc | Locating and detecting mobile communication devices in a defined geographic area |
US11378699B2 (en) | 2020-07-13 | 2022-07-05 | Swift Navigation, Inc. | System and method for determining GNSS positioning corrections |
US11550067B2 (en) | 2020-12-17 | 2023-01-10 | Swift Navigation, Inc. | System and method for fusing dead reckoning and GNSS data streams |
US11733397B2 (en) | 2021-07-24 | 2023-08-22 | Swift Navigation, Inc. | System and method for computing positioning protection levels |
US11693120B2 (en) | 2021-08-09 | 2023-07-04 | Swift Navigation, Inc. | System and method for providing GNSS corrections |
KR102358547B1 (ko) * | 2021-09-09 | 2022-02-08 | 동아항업 주식회사 | 유동성을 지닌 mms의 실측치 실시간 보정을 통한 수집데이터 출력시스템 |
CN113607176B (zh) * | 2021-10-11 | 2021-12-10 | 智道网联科技(北京)有限公司 | 组合导航系统轨迹输出方法及装置 |
KR20230083250A (ko) * | 2021-12-02 | 2023-06-09 | 김현수 | 복합추측항법 기능을 이용한 항법위성 신호 실시간 생성 시스템 |
US11860287B2 (en) | 2022-03-01 | 2024-01-02 | Swift Navigation, Inc. | System and method for detecting outliers in GNSS observations |
WO2023167899A1 (en) | 2022-03-01 | 2023-09-07 | Swift Navigation, Inc. | System and method for fusing sensor and satellite measurements for positioning determination |
WO2024050094A1 (en) | 2022-09-01 | 2024-03-07 | Swift Navigation, Inc. | System and method for determining gnss corrections |
WO2024058999A1 (en) | 2022-09-12 | 2024-03-21 | Swift Navigation, Inc. | System and method for gnss correction transmission |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR19980058112A (ko) * | 1996-12-30 | 1998-09-25 | 김영환 | Gps를 이용한 자동차 항법장치의 맵 매칭방법 |
KR20140006166A (ko) * | 2012-06-27 | 2014-01-16 | 주식회사 만도 | 차량의 위치 보정 장치 및 그 방법 |
Family Cites Families (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5394333A (en) * | 1991-12-23 | 1995-02-28 | Zexel Usa Corp. | Correcting GPS position in a hybrid naviation system |
US5590043A (en) * | 1993-06-17 | 1996-12-31 | Trimble Navigation Limited | Satellite positioning system filter |
DE4332945A1 (de) * | 1993-09-28 | 1995-03-30 | Bosch Gmbh Robert | Ortungs- und Navigationsgerät mit Satellitenstützung |
FI942218A0 (fi) * | 1994-05-13 | 1994-05-13 | Modulaire Oy | Automatiskt styrningssystem foer obemannat fordon |
US6091359A (en) * | 1997-07-14 | 2000-07-18 | Motorola, Inc. | Portable dead reckoning system for extending GPS coverage |
US6470272B2 (en) * | 2000-06-09 | 2002-10-22 | Automotive Systems Laboratory, Inc. | Situation awareness processor |
KR100520166B1 (ko) | 2003-03-14 | 2005-10-10 | 삼성전자주식회사 | 네비게이션시스템에서 이동체의 위치검출장치 및 그 방법 |
KR100557081B1 (ko) * | 2003-12-18 | 2006-03-03 | 삼성전자주식회사 | 복합항법 시스템에서 지.피.에스 수신기의 시간 지연 추정방법 및 그 장치 |
US7222007B2 (en) * | 2004-01-07 | 2007-05-22 | Ford Global Technologies, Llc | Attitude sensing system for an automotive vehicle relative to the road |
WO2005103385A1 (de) * | 2004-04-21 | 2005-11-03 | J. Müller AG | Verfahren zur vermessung von fahrbahnen |
KR100742612B1 (ko) | 2005-08-19 | 2007-07-25 | 한국전자통신연구원 | 추측 항법과 지피에스를 이용한 복합 항법 장치 및 그 방법 |
US8165806B2 (en) * | 2007-09-28 | 2012-04-24 | General Motors Llc | Vehicle compass using telematics unit and vehicle sensor information |
JP4842335B2 (ja) * | 2009-02-12 | 2011-12-21 | 日立建機株式会社 | 電動車両の旋回補助装置 |
EP2339378B1 (en) * | 2009-12-17 | 2013-03-20 | u-blox AG | Hybrid satellite positioning receiver |
US20110208424A1 (en) * | 2010-02-23 | 2011-08-25 | Eric Hirsch | Road Map Feedback Corrections in Tightly Coupled GPS and Dead Reckoning Vehicle Navigation |
US20110257882A1 (en) * | 2010-04-15 | 2011-10-20 | Mcburney Paul W | Road map feedback server for tightly coupled gps and dead reckoning vehicle navigation |
JP6010364B2 (ja) * | 2011-08-24 | 2016-10-19 | 株式会社デンソー | 走行軌跡記憶装置 |
KR101789073B1 (ko) | 2011-08-24 | 2017-10-23 | 현대모비스 주식회사 | 차량의 곡률 반경 추정 방법 및 그 장치 |
JP2013088208A (ja) | 2011-10-14 | 2013-05-13 | Furuno Electric Co Ltd | 密結合gpsおよび推測航法車両航法用のロードマップ・フィードバック・サーバ |
US8843314B2 (en) * | 2013-01-04 | 2014-09-23 | General Motors Llc | High fidelity horizontal position error estimation for vehicular GPS/DR navigation |
-
2014
- 2014-10-06 KR KR1020140134323A patent/KR101697645B1/ko active IP Right Grant
- 2014-11-04 US US14/532,541 patent/US9405016B2/en active Active
- 2014-11-28 CN CN201410709719.2A patent/CN105698787B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR19980058112A (ko) * | 1996-12-30 | 1998-09-25 | 김영환 | Gps를 이용한 자동차 항법장치의 맵 매칭방법 |
KR20140006166A (ko) * | 2012-06-27 | 2014-01-16 | 주식회사 만도 | 차량의 위치 보정 장치 및 그 방법 |
Also Published As
Publication number | Publication date |
---|---|
KR20160040867A (ko) | 2016-04-15 |
KR101697645B1 (ko) | 2017-01-18 |
CN105698787A (zh) | 2016-06-22 |
US9405016B2 (en) | 2016-08-02 |
US20160097862A1 (en) | 2016-04-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105698787B (zh) | 利用航位推算和gps的复合导航系统及其方法 | |
KR101326889B1 (ko) | 이동 기준국을 이용한 차량간 상대 위치 제어 방법 및 그 시스템 | |
JP5270184B2 (ja) | 衛星航法/推測航法統合測位装置 | |
US20090088975A1 (en) | Navigation device | |
WO2014002211A1 (ja) | 測位装置 | |
JP5586994B2 (ja) | 位置標定装置、位置標定装置の位置標定方法および位置標定プログラム | |
EP3312634B1 (en) | Positioning apparatus | |
JP5742450B2 (ja) | 位置算出方法及び位置算出装置 | |
JP5602070B2 (ja) | 位置標定装置、位置標定装置の位置標定方法および位置標定プログラム | |
JP6060642B2 (ja) | 自己位置推定装置 | |
US20110202204A1 (en) | System and Method of Navigation based on State Estimation Using a Stepped Filter | |
CN102538780A (zh) | 定位装置及定位方法 | |
KR101878685B1 (ko) | 지도 정보를 이용한 차량 측위 시스템 및 방법 | |
JP5892845B2 (ja) | キャリブレーション良否判定装置及び方法 | |
JP6008509B2 (ja) | 計測装置及び計測方法 | |
JP2013044562A (ja) | 路面勾配算出装置及び方法 | |
JP2008256620A (ja) | 地図データ修正装置、地図データ修正方法、及び地図データ修正プログラム | |
KR102174531B1 (ko) | 차량의 위치정보 보정 장치 및 방법 | |
JP5994237B2 (ja) | 測位装置及びプログラム | |
US20160349057A1 (en) | Multiple data sources pedestrian navigation system | |
RU2539131C1 (ru) | Бесплатформенная интегрированная навигационная система средней точности для мобильного наземного объекта | |
JP4376738B2 (ja) | 角速度センサのゼロ点誤差検出装置および方法 | |
JP5597080B2 (ja) | 地図表示装置が地図データを処理するためのコンピュータプログラム、地図表示装置及び方法 | |
KR20140132959A (ko) | 누적 헤딩 변화량을 이용한 맵매칭 시스템 및 방법 | |
KR101964059B1 (ko) | 실내 주차장 안내 시스템을 위한 바퀴 속력 센서 기반 차량 측위 시스템 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |