CN101360971B - 定位装置及导航系统 - Google Patents
定位装置及导航系统 Download PDFInfo
- Publication number
- CN101360971B CN101360971B CN2007800015895A CN200780001589A CN101360971B CN 101360971 B CN101360971 B CN 101360971B CN 2007800015895 A CN2007800015895 A CN 2007800015895A CN 200780001589 A CN200780001589 A CN 200780001589A CN 101360971 B CN101360971 B CN 101360971B
- Authority
- CN
- China
- Prior art keywords
- estimated
- estimated position
- sensor
- vehicle
- map datum
- 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
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/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/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
- G01C21/30—Map- or contour-matching
-
- 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
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/01—Determining conditions which influence positioning, e.g. radio environment, state of motion or energy consumption
- G01S5/011—Identifying the radio environment
-
- 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
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/01—Determining conditions which influence positioning, e.g. radio environment, state of motion or energy consumption
- G01S5/017—Detecting state or type of motion
-
- G—PHYSICS
- G09—EDUCATION; CRYPTOGRAPHY; DISPLAY; ADVERTISING; SEALS
- G09B—EDUCATIONAL OR DEMONSTRATION APPLIANCES; APPLIANCES FOR TEACHING, OR COMMUNICATING WITH, THE BLIND, DEAF OR MUTE; MODELS; PLANETARIA; GLOBES; MAPS; DIAGRAMS
- G09B29/00—Maps; Plans; Charts; Diagrams, e.g. route diagram
- G09B29/10—Map spot or coordinate position indicators; Map reading aids
- G09B29/106—Map spot or coordinate position indicators; Map reading aids using electronic means
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/09—Arrangements for giving variable traffic instructions
- G08G1/0962—Arrangements for giving variable traffic instructions having an indicator mounted inside the vehicle, e.g. giving voice messages
- G08G1/0968—Systems involving transmission of navigation instructions to the vehicle
- G08G1/096805—Systems involving transmission of navigation instructions to the vehicle where the transmitted instructions are used to compute a route
- G08G1/096827—Systems involving transmission of navigation instructions to the vehicle where the transmitted instructions are used to compute a route where the route is computed onboard
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Business, Economics & Management (AREA)
- Mathematical Physics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Educational Administration (AREA)
- Educational Technology (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Instructional Devices (AREA)
- Traffic Control Systems (AREA)
Abstract
一种使用无线电导航定位单元(81)检测移动物体位置的定位装置(9),其特征在于,具有:检测移动物体动作信息的第1及第2自主传感器(2)、(4)、(3);将定位结果与通过第1自主传感器测得的信息进行累积,从而测出估计位置及估计方向的位置检测单元(82);依据估计位置并参考地图数据存储单元(5),测得距对应的连接线预定距离的地图数据估计位置的地图数据定位单元(83);将定位结果与通过第2自主传感器测得的信息进行累积,从而测出累积估计方向的方向检测单元(84);将估计位置及地图数据估计位置、与估计方向及累积估计方向适用于卡尔曼滤波器,从而估计出移动物体位置的最优位置估计单元(85)。
Description
技术领域
本发明涉及一种用于检测移动物体位置的定位装置及导航系统,尤其涉及一种通过在无线电导航获得的定位位置上累积自主传感器测得的信息,同时对地图数据进行规范从而估计位置的定位装置及导航系统。
背景技术
在导航系统中,依据从GPS(Global Positioning System)卫星发出的无线电波检测出车辆的位置,用车速传感器及陀螺传感器等累积行驶距离及行驶方向,高精度地估计车辆的当前位置。
但是,在无法收到GPS卫星发出的无线电波的状态下,包含在自主导航定位之中的误差将随时间的推移而被放大,因而位置的精度会逐渐下降。因此,提出了各种方法来对通过自主导航检测出的车辆位置进行补正。
例如,有利用导航系统的地图数据,对通过自主导航所定位的位置进行补正的地图匹配方法。由于地图数据是将节点(例如,交叉路口)间用连接线(例如,道路)进行结合而成,因此通过将自主导航所检测的位置与地图数据相对应,从而对车辆的位置进行补正以使车辆能够在道路上行驶。
但是,地图数据的精度并不太高,通过地图匹配进行的补正通常不能获得足够的精度。因此,现公开的技术有,例如从地图数据中选择与通过自主导航所定位的位置、方向最为符合的位置及方位的道路,并根据该道路而对位置、方向进行补正的方法。(例如,参照专利文献1)
专利文献1:特开2002-213979号公报
发明内容
但是,如上文所述,一般市售的导航系统的地图数据精度不是很高,此外,由于将道路网用连接交叉路口(节点)的直线状的连接线来表现,因此有时会与实际道路的形状不一致。
图1(a)表示了地图数据的连接线信息与实际道路形状偏离的一个示例。如图1(a)中所示,实际的道路有缓慢的弯曲,但是在地图数据中,将其用两条连接线来表现,因此出现了实际道路与连接线信息不相符的位置。例如,对于“车辆的实际位置”,当车辆正在行驶,并且能够捕捉到GPS卫星信号的状态下,可将“车辆的实际位置”作为车辆的位置进行识别;但是在不能捕捉到GPS卫星信号的状态下用直线状的连接线进行了地图匹配时,车辆的实际位置与定位的位置之间就会有误差L。
图1(b)表示了通过测量对误差L的程度进行了调查的地图数据精度的一个示例。在图1(b)中,横轴表示测量点(定位的识别序号),纵轴表示实际的道路形状与地图数据间的比较差值。如图1(b)所示,地图数据在交叉路口(节点)附近与实际道路间的误差较小,根据地点不同,有时与实际道路有6m左右的差距。因此,在不能捕捉到GPS卫星信号的状态下,对地图数据进行地图匹配从而对位置进行补正时,存在高精度定位比较困难的问题。
另一方面,为了获得高精度的地图数据,需要道路的正确测量及连接线的高精细化,因而很难对所有道路实现上述要求。
因此,本发明是鉴于上述问题点而进行的。鉴于上述课题,其目的在于,提供一种即使在GPS卫星信号捕捉困难的状态下,也能够使用现有的地图数据实现高精度定位的定位装置、导航系统。
根据本发明的一种观点,能够提供一种定位装置,其通过无线电导航定位单元检测移动物体的位置,其特征在于,具有:第1自主传感器,用于检测所述移动物体的动作信息;位置检测单元,用于将第1自主传感器检测的检测信息累积至所述无线电导航定位单元检测的定位结果,检测所述移动物体的估计位置;地图数据定位单元,用于根据所述位置检测单元检测的所述估计位置并参考地图数据存储单元,检测从对应于所述估计位置的连接线开始的预定距离的地图数据估计位置;最优位置估计单元,用于将所述估计位置及所述地图数据估计位置应用于卡尔曼滤波器,估计所述移动物体的所述位置。
根据本发明的其他观点,能够提供一种使用了下述定位装置的导航系统。一种定位装置,其通过无线电导航定位单元检测移动物体的位置,其特征在于,具有:第1自主传感器,用于检测所述移动物体的动作信息;位置检测单元,用于将第1自主传感器检测的检测信息累积至所述无线电导航定位单元检测的定位结果,检测所述移动物体的估计位置;地图数据定位单元,用于根据所述位置检测单元检测的所述估计位置并参考地图数据存储单元,检测从对应于所述估计位置的连接线开始的预定距离的地图数据估计位置;最优位置估计单元,用于将所述估计位置及所述地图数据估计位置应用于卡尔曼滤波器,估计所述移动物体的所述位置。
通过本发明,能够提供一种即使在GPS卫星信号捕捉困难的状态下,也能够使用现有的地图数据实现高精度定位的定位装置及导航系统。
附图说明
图1为表示地图数据的连接线信息与实际道路形状之间的偏离的一个示例的示意图。
图2为使用了定位装置的导航系统的概要构成图。
图3为,定位装置的功能框图及卡尔曼滤波器的耦合图像的示意图。
图4为,为了与卡尔曼滤波器耦合,通过两个传感器系统检测出的各个位置的示意图(其1)。
图5为,为了与卡尔曼滤波器耦合,通过两个传感器系统检测出的各个位置的示意图(其2)。
图6为,用于说明卡尔曼滤波器中使用的观测方程式的示意图。
图7为,定位装置依据GPS无线电波的捕捉状况对车辆位置进行定位的顺序的流程图。
图8为,通过定位装置进行实际定位获得的实验结果的示意图。
符号说明
1,GPS接收装置
2,车速传感器
3,横摆率传感器
4,转向角传感器
5,地图数据库
6,输入装置
7,显示装置
8,导航ECU
9,定位装置
10,导航系统
具体实施方式
以下参照图纸对本发明的最优实施形态进行说明。
图2中图示了使用了本实施形态中的定位装置9的导航系统10的概要构成图。
导航系统10受控制导航系统的导航ECU(Electrical ControlUnit)8控制。导航ECU8的构成为,将运行程序的CPU、存储程序的存储装置(硬盘、ROM)、临时存储数据及程序的RAM、数据输入及输出的输入输出装置、NV(Non Volatile:非易失)-RAM等通过总线连接在一起的计算机。
导航ECU8中连接有下列部件:接收来自GPS(Global PositioningSystem)卫星的无线电波的GPS接收装置1;检测车辆速度的车速传感器2;对围绕经过车的重心并沿车辆前后方向的轴线(侧倾轴)的转动角速度进行检测的横摆率传感器3;检测方向盘转向角的转向角传感器4;存储了地图数据的地图数据库(以下简称地图DB)5;用于操作导航系统10的输入装置6;显示地图中的当前位置的液晶或HUD(Head UpDisplay:抬头显示器)等显示装置7。
地图DB5中,将实际的道路网与节点(例如,道路与道路的交叉点、从交叉路口每按规定间隔分段的点等)以及连接线(连接节点与节点的道路)相对应,构成图表状的数据库。
导航ECU8,将检测出的当前位置周边的地图从地图DB5中提取,并按指定的缩小比例显示在设置于车厢内的显示装置7上。导航ECU8,根据需要在地图中重叠显示车辆的当前位置。
此外,从按键式的键盘及遥控器等输入装置6输入目的地时,从检测出的当前位置到目的地,例如用迪杰斯特拉算法(dijkstra)等已知的路线检索法进行路线检索,将路线在地图中重叠显示的同时,在左右转向的交叉路口前向驾驶员提示路线。
导航ECU5的CPU,通过运行存储于存储装置中的程序,实现本实施形态中所说明的定位。在图3(a)中图示了定位装置9的功能框图。
本实施形态中的定位装置9,能在GPS卫星信号捕捉困难及GPS定位的可靠性降低的状况下,对车辆位置进行高精度定位。下面对其概要进行说明,定位装置9,在通过自主导航进行的定位中,附加基于地图DB5的定位信息,然后将通过卡尔曼滤波器进行了最优估计的位置输出。与在自主导航获得的定位结果上进行地图匹配的情况相比,能够提高定位精度。通过后文详述的实际定位结果可以看出,本实施形态的位置补正,特别是对于与行进方向(道路长度方向)垂直的方向上的位置偏离的补正,具有很好的效果。
此外,对于卡尔曼滤波器的应用,需要使耦合的定位信息相互独立,因此,在本实施形态中,
A.车速传感器2及转向角传感器4
B.地图DB5及横摆率传感器3
划分为上述两个传感器系统。另外,也可以在A传感器系统使用横摆率传感器3、在B传感器系统使用转向角传感器4,还可以在检测车辆方向的传感器中使用陀螺传感器。
此外,应用卡尔曼滤波器时,将由两个传感器系统获得的输出结果通过观测方程式进行耦合,但是相对于在A传感器系统中检测出位置及方向,在B传感器系统中检测出的是与地图DB5中地图数据的相对距离及相对方向,二者不能直接耦合。因此,本实施形态的定位装置9,导出了用于将从两个传感器系统获得的检测值进行耦合的观测方程式。以下进行详细说明。
首先,GPS定位单元81是用已知的方法、依据来自GPS卫星的无线电波对车辆的位置进行定位。GPS定位单元81,从围绕规定轨道转动的多个GPS卫星中,选择4颗进入当前车辆位置的规定仰角内的GPS卫星,并接收从这些GPS卫星发出的无线电波。GPS定位单元81计算电波的到达时间,由到达时间与光速c算出距捕捉到的GPS卫星的距离。并且,将3个GPS卫星与车辆的距离交叉的一点作为车辆的位置进行定位。
定位装置9在接收GPS无线电波过程中,每隔规定时间对车辆位置进行定位。并且,如果GPS无线电波被屏蔽,则进入将最后定位的位置作为初始位置,将当时的行驶方向作为初始方向,将这些行驶距离及方向进行累积的自主导航定位。
图4(a)为通过自主导航(A传感器系统)检测出的位置的示意图。图4(a)中的道路21,是用从地图DB5中提取的两个连接线22、23构成的地图数据来表示的。设定车辆正在从连接线22向连接线23的方向行驶,GPS无线电波在初始位置24处被屏蔽。
从GPS卫星发出的无线电波被屏蔽时,INS(Inertial NavigationSensor)定位单元82,通过车速传感器2检测车速,通过转向角传感器4检测转向角,然后在初始位置24及初期方向上累积行驶距离及方向,从而通过自主导航对位置及方向进行估计(以下称为估计位置、估计方向)。在图4(a)中,图示了相对于车辆的实际位置25的、通过自主导航估计得到的估计位置26。
此外,为了使用卡尔曼滤波器,需要每个传感器系统的误差分散,而车速传感器2及转向角传感器4的误差根据速度及GPS无线电波屏蔽时间等为已知。因此,依据上述这些条件,累积得到的估计位置26的误差分散也为已知。在图4(a)中,估计位置26的误差分散是用虚线围成的椭圆来表示的。
图4(b)为,依据INS定位单元82估计的估计位置26,使其与地图DB(B传感器系统)5的连接线对应从而检测出的位置的示意图。INS定位单元82估计的估计位置26被输入到地图数据定位单元83,地图数据定位单元83将与估计位置26对应的连接线23从地图DB5中提取。
由于车辆被估计为存在于估计位置26与连接线23的周边,因此,地图数据定位单元83将车辆的存在位置(以下称为地图数据估计位置27)估计为,存在于从连接线23向估计位置26的方向隔着预定距离r(以下称为偏移量r)的线上的任意点上。
此偏移量r为,GPS屏蔽前的初始位置24与连接线22之间的距离。即,估计为GPS被屏蔽前的初始位置24与连接线22的偏移持续存在。
此外,估计位置26和偏移量r都只是估计值,因此,地图数据估计位置27为“隔着偏移量r的线上”的任意点。即,地图数据估计位置27并不限定于一点。
图5(c)为,通过横摆率传感器(B传感器系统)的检测值估计的车辆方向的示意图。通过GPS定位单元81获得的初始方向被输入到方向检测单元84,方向检测单元84在初始方向上累积通过横摆率传感器3检测出的横摆率的积分值(表示方向),从而估计车辆的方向(以下称为累积估计方向28)。因此,与A传感器系统分别进行车辆行驶方向的估计。
此外,如上文所述,地图数据估计位置27为本身包含误差分散的值,累积估计方向28也包含横摆率传感器3的检测误差等误差。地图数据估计单元83依据偏移量r、速度及GPS无线电波被屏蔽时间等,算出地图数据估计位置27、累积估计方向28的误差分散。
用上文所述方法,通过A、B传感器系统分别对车辆位置及方向进行估计时,卡尔曼滤波器运算单元85输出车辆位置及方向的最优位置。图5(d)为,依据通过A传感器系统获得的估计位置26及估计方向、和通过B传感器系统获得的地图数据估计位置27及累积估计方向28,运算得到的最终估计位置29的示意图。最终估计位置29中包含表示方向的信息。
图5(d)中,将两个传感器系统的误差分散,用估计位置26与地图数据估计位置27中有凸部的分散来表示,但是分散实际上有3维的扩散。图3(b)中图示了此分散及通过卡尔曼滤波器进行最优位置估计的图像。卡尔曼滤波器在一个系统的状态被各自独立的进行估计时,依据状态的概率密度分布,估计概率最高的状态(分布的积为最大的状态)。因此,通过将两个系统的定位信息用卡尔曼滤波器进行耦合,能够估计出存在概率最高的位置。
接下来,对卡尔曼滤波器中使用的观测方程式进行说明。
图6为用于说明卡尔曼滤波器中使用的观测方程式的示意图。如果设定适当的坐标系(例如,Y方向朝北),并用Xt表示车辆的实际位置、行驶方向,则Xt可以用2维平面位置(x,y)及行驶方向θ的函数来表示。
Xt=(x,y,θ)…(1)
此外,粗实线表示的是连接线23,连接线23相对于x轴的倾斜角设为α。另外,连接线23的交叉路口节点位置设为与y轴的交点(0,c),这样获取连接线23时,连接线23通过如下面所示的车道的公式来表示。
-x·sinα+y·cosα+c=0…(2)
Xt与连接线23的斜率设为φ,Xt与连接线23的距离设为r。斜率φ为,依据横摆率传感器3的检测值,由方向检测单元84检测出的值,距离r为GPS无线电波被屏蔽前的偏移量r。此外,在图6中,α以逆时针旋转为正,φ以顺时针旋转为正。
因此,可以首先设立使距连接线23的距离r成为零的观测方程式。此外,也可以设立使相对于连接线23的行驶方向的斜率θ成为零的观测方程式。
因此,将观测量S设为
S=(α,c,r,φ)
时,观测方程式可以用式(3)表示。此外,如式3所示的观测方程式为2行1列的行列式。
[数1]
上侧的要素表示从车道开始的距离的关系式,下侧的要素表示从车道开始的斜率的关系式。此外,当车辆在行驶直线下侧时,上侧的要素成为“xsinα-ycosα-c-r”。
关于式3的观测方程式向卡尔曼滤波器的应用,在后文进行详细说明。
图7为表示定位装置9依据GPS无线电波的捕捉状况对车辆位置进行定位的顺序的流程图。
定位装置9在GPS定位单元81的每个定位间隔,对GPS无线电波是否被屏蔽进行判断(S1)。如果GPS无线电波没有被屏蔽(S1为否),则利用GPS无线电波对车辆位置进行定位(S2)。
当GPS无线电波被屏蔽时(S1为是),INS定位单元82依据车速及转向角,在初始位置24及初始方向上累积行驶距离及行驶方向,从而通过自主导航对估计位置及估计方向进行估计(S3)。此外,INS定位单元82,根据车速传感器2及转向角传感器4的误差等,算出基于这些而累积的估计位置26以及估计方向的分散。
此外,方向检测单元84在GPS无线电波被屏蔽前的初始方向上累积横摆率的积分值,从而检测出车辆的累积估计方向(S4)。此外,方向检测单元84依据横摆率传感器3的检测误差等,算出累积估计方向的分散。
此外,地图数据定位单元83依据INS定位单元82所估计的估计位置,参照地图DB5,在与对应的连接线23相距偏移量r的线上的任意位置,检测地图数据估计位置(S5)。
其次,卡尔曼滤波器运算单元85,将来自A传感器系统的估计位置及估计方向、来自B传感器系统的地图数据估计位置及累积估计方向通过卡尔曼滤波器进行耦合(S5)。
用上述方法,能够依据由两个传感器系统独立检测出的位置及方向,输出概率最高的最终估计位置。此外,步骤S4与S5的顺序不同。
通过自主导航进行的位置估计,具有能反映车辆的行驶过程的优点和随着时间的推移误差会增大的缺点;基于地图DB的位置估计,具有能通过地图数据限定车辆位置的优点和其含有因地图数据的精度不足而产生的误差的缺点。
本实施形态的定位装置9,考虑到由这两个系统估计的位置的误差,用卡尔曼滤波器对最优位置进行估计,因而能够对双方取长补短。因此,能够使用地图数据,对通过自主导航检测出的位置进行高精度的补正。
由于即使GPS无线电波被屏蔽也能够进行高精度定位,因此能够在适当的时机向驾驶员提供在交叉路口等处的驾驶支持(车辆控制、唤起注意等)。
[应用于卡尔曼滤波器]
下面,对为了将观测方程式(3)应用于卡尔曼滤波器而对观测方程式(3)实施的操作进行说明。
首先,将观测方程式(3)线形化。为此,观测方程式(3)在时刻t的估计位置
[数2]
的周围进行泰勒(Taylor)展开。
[数3]
其中,Xt为真实位置
ΔS为测定误差
真实测定值
此外,Jx′,Js′为观测方程式的偏微分。
[数4]
将式(4)变形可以得到下式。
[数5]
进行标准化
在此,Jx,-Ws,Js分别可用下面的公式表示。
[数6]
此外,在卡尔曼滤波器中,由于状态方程式及观测方程式均以线形模型为前提,因此将Xs定义如下。
[数7]
并且,如果用乘以Jx的m维空间考虑,可以通过线形模型来表述。由式(7)可得,
-Ws=Xs+JsΔS …(8)
式(8)为线形模型。
由于观测量的测定误差ΔS被假定为白色高斯分散,因此,其平均值E(ΔS)=0。因此,
E(JsΔS)=0
E(JsΔSΔSTJs T)=JsE(ΔSΔST)Js T=JsQsJs T≡Qs′…(9)
将通过自主导航算出的估计位置的平均分散,用乘以Jx的m维空间考虑时,可以表示如下。
[数8]
但是,假定平均E(ΔXt)=0
根据上述内容,最优估计值可用如下方法求得。
[数9]
但是,
为使式(12)返回X=(x,y,θ)的空间,对其进行逆映射。
[数10]
[通过定位装置9获得的测定结果]
图8所示为,在一般道路上GPS无线电波被屏蔽的状况下,定位装置9的定位结果。定位时间与GPS无线电波被屏蔽的时间基本相等,约为950秒。
偏移量r相当于标准偏差10[m]、观测量S=(α,c,r,φ)的误差共分散行列式Qs设定如下。此外,误差共分散行列式Qs为α、c、r、φ的顺序。
[数11]
图8(a)所示为,相对于用其他系统进行定位的实际车道(作为真实值),通过自主导航检测出的估计位置及本实施形态的定位装置9定位而得的位置的偏离大小的试验结果。在图8(a)中,以定位时间(行驶时间)作为横轴,累积误差平均的距离[m]用纵轴表示。
如图8(a)所示,通过自主导航检测出的估计位置中,有相对于真实值偏离30m以上的情况,而用本实施形态的定位装置,即使行驶了950秒,相对于真实值也仅有10m左右的偏离。
此外,在图8(b)中分别图示了I.用其他系统定位的实际车道、II.通过自主导航检测出的估计位置、III.用本实施形态的定位装置9定位的位置。黑圆点为交叉路口。此外,在图8(b)中,I.用其他系统定位的实际车道,与地图DB5中提取的车道(连接线:细实线)基本重叠。
由于在通过自主导航检测出的估计位置中,在沿连接线的车道上有大幅度偏离的情况,因此,即使进行地图匹配,在匹配时也不可能不包含误差。但是,本实施形态的定位装置9定位的位置,与实际车道高精度的一致。此外,如图8(b)所示,本实施形态的位置补正,特别是对于与行驶方向垂直的方向上的补正具有很大效果。
以上通过实施例对本发明进行了说明,但是本发明并不仅限于所述实施例,在本发明的范围内,进行各种变形及改良均可。
本国际申请为,主张2006年7月25日提交的日本专利申请2006-202475号的优先权的申请,日本专利申请2006-202475号的全部内容都援引至本国际申请。
工业利用性
本发明能够适用于检测移动物体位置的定位装置及导航系统,特别是,能够适用于将通过无线电导航获得的定位位置与通过自主传感器测得的信息进行累积,同时基于地图数据,从而估计位置的定位装置及导航系统。
Claims (3)
1.一种定位装置,其通过无线电导航定位单元检测移动物体的位置,其特征在于,具有:
第1自主传感器,用于检测所述移动物体的动作信息;
第2自主传感器,用于检测所述移动物体的方向信息;
位置检测单元,用于将第1自主传感器检测的检测信息累积至所述无线电导航定位单元检测的定位结果,检测所述移动物体的估计位置和估计方向;
地图数据定位单元,用于根据所述位置检测单元检测的所述估计位置并参考地图数据存储单元,检测从对应于所述估计位置的连接线开始的预定距离的地图数据估计位置;
方向检测单元,用于将第2自主传感器检测的方向信息累积至所述无线电导航定位单元检测的定位结果,检测累积估计方向;
最优位置估计单元,用于将所述估计位置、所述估计方向、所述地图数据估计位置以及所述累积估计方向应用于卡尔曼滤波器,估计所述移动物体的所述位置。
3.一种导航系统,其使用了权利要求1至权利要求2中任意一项所述的定位装置。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP202475/2006 | 2006-07-25 | ||
JP2006202475A JP4124249B2 (ja) | 2006-07-25 | 2006-07-25 | 測位装置、ナビゲーションシステム |
PCT/JP2007/061609 WO2008012997A1 (fr) | 2006-07-25 | 2007-06-08 | dispositif de positionnement et système de navigation |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101360971A CN101360971A (zh) | 2009-02-04 |
CN101360971B true CN101360971B (zh) | 2011-09-28 |
Family
ID=38981312
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2007800015895A Active CN101360971B (zh) | 2006-07-25 | 2007-06-08 | 定位装置及导航系统 |
Country Status (5)
Country | Link |
---|---|
US (1) | US8041472B2 (zh) |
EP (1) | EP2045577B1 (zh) |
JP (1) | JP4124249B2 (zh) |
CN (1) | CN101360971B (zh) |
WO (1) | WO2008012997A1 (zh) |
Families Citing this family (33)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI378223B (en) * | 2008-06-24 | 2012-12-01 | Mstar Semiconductor Inc | Navigation apparatus and positioning method thereof |
KR20100070973A (ko) * | 2008-12-18 | 2010-06-28 | 박호철 | 헤드업 디스플레이 내비게이션 장치, 시스템 및 서비스 구현방법 |
JP4934167B2 (ja) | 2009-06-18 | 2012-05-16 | クラリオン株式会社 | 位置検出装置および位置検出プログラム |
US20110093583A1 (en) * | 2009-10-16 | 2011-04-21 | Apple Inc. | Triggering actions based on changes in a network connection |
US8706347B2 (en) * | 2010-01-19 | 2014-04-22 | GM Global Technology Operations LLC | Diagnosis of wheel alignment using GPS |
JP5017392B2 (ja) | 2010-02-24 | 2012-09-05 | クラリオン株式会社 | 位置推定装置および位置推定方法 |
US8655530B2 (en) * | 2010-04-21 | 2014-02-18 | Toyota Jidosha Kabushiki Kaisha | Parking assist device for vehicle and electrically powered vehicle including the same |
US20110307171A1 (en) * | 2010-06-10 | 2011-12-15 | Continental Automotive Systems, Inc. | GPS Location Refinement Method In Environments With Low Satellite Visibility |
KR101429954B1 (ko) * | 2010-06-25 | 2014-08-14 | 에스케이텔레콤 주식회사 | 인빌딩 전파 환경 맵 생성 방법과 그를 위한 장치 |
CN102023305A (zh) * | 2010-08-05 | 2011-04-20 | 深圳市赛格导航科技股份有限公司 | 一种定位方法、装置及车载终端 |
JP2012122819A (ja) * | 2010-12-08 | 2012-06-28 | Casio Comput Co Ltd | 測位装置、測位方法およびプログラム |
JP5639874B2 (ja) * | 2010-12-24 | 2014-12-10 | 株式会社日立製作所 | 運転支援装置 |
EP2698608B1 (en) | 2011-04-11 | 2015-08-26 | Clarion Co., Ltd. | Position calculation method and position calculation device |
KR101074638B1 (ko) * | 2011-05-04 | 2011-10-18 | 한국항공우주연구원 | 조향 모델을 이용한 주행차선 판단방법 |
US9182235B2 (en) | 2011-05-20 | 2015-11-10 | Hitachi, Ltd. | Locus correcting method, locus correcting apparatus, and mobile object equipment |
WO2013111189A1 (ja) * | 2012-01-25 | 2013-08-01 | トヨタ自動車株式会社 | 車両制御装置 |
JP2014009964A (ja) * | 2012-06-27 | 2014-01-20 | Ntt Docomo Inc | 移動端末、システム及び方法 |
DE102014011092A1 (de) * | 2014-07-25 | 2016-01-28 | Audi Ag | Verfahren zur Bestimmung eines ortsaufgelösten Fehlermaßes für eine Positionsbestimmung mit einem GNSS |
KR20170000282A (ko) * | 2015-06-23 | 2017-01-02 | 한국전자통신연구원 | 센서를 이용한 로봇 위치 정확도 정보 제공장치 및 그 방법 |
DE102015218042A1 (de) * | 2015-09-21 | 2017-03-23 | Bayerische Motoren Werke Aktiengesellschaft | Verfahren und Vorrichtung zum Betreiben eines Fahrzeugs und Fahrerassistenzsystem |
JP6611376B2 (ja) | 2015-12-03 | 2019-11-27 | アルプスアルパイン株式会社 | 位置検出システム |
JP6080998B1 (ja) * | 2016-03-18 | 2017-02-15 | 三菱電機株式会社 | 車両制御情報生成装置および車両制御情報生成方法 |
DE102016207576A1 (de) | 2016-05-03 | 2017-11-09 | Bayerische Motoren Werke Aktiengesellschaft | Verfahren und Vorrichtung zum Ermitteln einer absoluten Fahrttrajektorie eines Fahrzeugs |
GB201613105D0 (en) * | 2016-07-29 | 2016-09-14 | Tomtom Navigation Bv | Methods and systems for map matching |
JP6790638B2 (ja) * | 2016-09-15 | 2020-11-25 | 日産自動車株式会社 | 走行制御方法および走行制御装置 |
DE102016223999A1 (de) | 2016-12-02 | 2018-06-07 | Volkswagen Aktiengesellschaft | Bestimmen einer Referenztrajektorie mit einem Posen-Graphen |
EP3339807B1 (en) * | 2016-12-20 | 2024-03-13 | HERE Global B.V. | An apparatus and associated methods for determining the location of a vehicle |
DE102018206786A1 (de) | 2018-05-03 | 2019-11-07 | Robert Bosch Gmbh | Verfahren zur satellitengestützten Ermittlung einer Fahrzeugposition mittels eines Bewegungs- und Positionssensors |
US20200122711A1 (en) * | 2018-10-19 | 2020-04-23 | GEOSAT Aerospace & Technology | Unmanned ground vehicle and method for operating unmanned ground vehicle |
CN110060493B (zh) * | 2019-05-16 | 2020-11-03 | 维智汽车电子(天津)有限公司 | 车道定位方法、装置及电子设备 |
DE102019123538A1 (de) * | 2019-09-03 | 2021-03-04 | Bayerische Motoren Werke Aktiengesellschaft | Verfahren und Vorrichtung zur Ermittlung einer Trajektorie eines Fahrzeugs |
US11274930B1 (en) * | 2019-12-11 | 2022-03-15 | Amazon Technologies, Inc. | System for assessing an autonomously determined map |
KR102623536B1 (ko) * | 2021-11-30 | 2024-01-12 | 주식회사 웨이브에이아이 | 자율 주행 모빌리티 제어 시스템 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1530635A (zh) * | 2003-03-14 | 2004-09-22 | ���ǵ�����ʽ���� | 导航系统中检测可移动物体位置的设备及其方法 |
Family Cites Families (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3095189B2 (ja) * | 1991-09-10 | 2000-10-03 | 株式会社日立製作所 | ナビゲーション装置 |
JP2000046574A (ja) * | 1998-07-24 | 2000-02-18 | Honda Motor Co Ltd | 車両用ナビゲーション装置 |
JP3745165B2 (ja) | 1999-06-01 | 2006-02-15 | 三菱電機株式会社 | ロケータ装置 |
JP4414076B2 (ja) * | 2000-08-30 | 2010-02-10 | 本田技研工業株式会社 | 移動体用ナビゲーションシステム |
JP2002213979A (ja) | 2001-01-12 | 2002-07-31 | Clarion Co Ltd | 測位位置/方位の修正が可能なdr機能付きgpsレシーバ |
JP2004286724A (ja) * | 2003-01-27 | 2004-10-14 | Denso Corp | 車両挙動検出装置、車載処理システム、検出情報較正装置及び車載処理装置 |
JP4356566B2 (ja) | 2004-09-08 | 2009-11-04 | 日本ビクター株式会社 | カーナビゲーション装置 |
JP4450203B2 (ja) | 2004-11-01 | 2010-04-14 | 日本ビクター株式会社 | カーナビゲーション装置 |
KR100689371B1 (ko) * | 2005-05-30 | 2007-03-02 | 삼성전자주식회사 | 네비게이션 시스템을 이용한 약속 장소 설정 방법 및시스템 |
JP4192940B2 (ja) | 2005-11-18 | 2008-12-10 | トヨタ自動車株式会社 | 移動体用位置推定装置 |
JP2006202475A (ja) | 2006-03-02 | 2006-08-03 | Sony Corp | ファイル転送システムおよびファイル転送方法 |
CA2649990A1 (en) * | 2006-06-15 | 2007-12-21 | Uti Limited Partnership | Vehicular navigation and positioning system |
JP4341649B2 (ja) * | 2006-07-12 | 2009-10-07 | トヨタ自動車株式会社 | ナビゲーション装置、位置検出方法 |
-
2006
- 2006-07-25 JP JP2006202475A patent/JP4124249B2/ja active Active
-
2007
- 2007-06-08 US US12/089,651 patent/US8041472B2/en active Active
- 2007-06-08 CN CN2007800015895A patent/CN101360971B/zh active Active
- 2007-06-08 EP EP07744929A patent/EP2045577B1/en active Active
- 2007-06-08 WO PCT/JP2007/061609 patent/WO2008012997A1/ja active Application Filing
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1530635A (zh) * | 2003-03-14 | 2004-09-22 | ���ǵ�����ʽ���� | 导航系统中检测可移动物体位置的设备及其方法 |
Non-Patent Citations (2)
Title |
---|
JP特开2006-126101A 2006.05.18 |
Maan E. El Najjar et al.A Road-Matching Method for Precise Vehicle Localization Using Belief Theory and Kalman Filtering.《Autonomous Robots》.2005,第19卷(第2期),正文第175页左栏第3段-第179页右栏第3段、图1,4-6. * |
Also Published As
Publication number | Publication date |
---|---|
WO2008012997A1 (fr) | 2008-01-31 |
EP2045577A4 (en) | 2010-05-26 |
EP2045577B1 (en) | 2011-11-02 |
EP2045577A1 (en) | 2009-04-08 |
JP2008026282A (ja) | 2008-02-07 |
US8041472B2 (en) | 2011-10-18 |
US20080228395A1 (en) | 2008-09-18 |
CN101360971A (zh) | 2009-02-04 |
JP4124249B2 (ja) | 2008-07-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101360971B (zh) | 定位装置及导航系统 | |
CN109946732B (zh) | 一种基于多传感器数据融合的无人车定位方法 | |
CN104061899B (zh) | 一种基于卡尔曼滤波的车辆侧倾角与俯仰角估计方法 | |
EP3640599B1 (en) | Vehicle localization method and apparatus | |
CN111033176B (zh) | 地图信息提供系统 | |
US8315756B2 (en) | Systems and methods of vehicular path prediction for cooperative driving applications through digital map and dynamic vehicle model fusion | |
CN106289275B (zh) | 用于改进定位精度的单元和方法 | |
JP4897542B2 (ja) | 自己位置標定装置、自己位置標定方法および自己位置標定プログラム | |
KR101454153B1 (ko) | 가상차선과 센서 융합을 통한 무인 자율주행 자동차의 항법시스템 | |
CN101750086B (zh) | 导航信息修正方法及其导航装置 | |
CN101384919B (zh) | 定位系统、定位方法、以及汽车导航系统 | |
CN111426332B (zh) | 航向安装误差确定方法、装置、电子设备和存储介质 | |
CN104380046B (zh) | 道路学习装置 | |
CN110208842A (zh) | 一种车联网环境下车辆高精度定位方法 | |
CN107229063A (zh) | 一种基于gnss和视觉里程计融合的无人驾驶汽车导航定位精度矫正方法 | |
US20060224311A1 (en) | Navigation system | |
CN101995261B (zh) | 确定车辆路线的方法和导航系统 | |
CN105675006B (zh) | 一种道路偏离检测方法 | |
CN101201255A (zh) | 基于智能导航算法的车辆组合导航系统 | |
CN107247275A (zh) | 基于公交车的城市gnss脆弱性监测系统及其方法 | |
US10907972B2 (en) | 3D localization device | |
CN106643712A (zh) | 一种车载组合导航系统 | |
US20090271113A1 (en) | Method for modifying navigation information and navigation apparatus using the same | |
WO2022147924A1 (zh) | 车辆定位方法和装置、存储介质及电子设备 | |
CN113063415A (zh) | 车辆及其导航方法、惯性导航系统的修正方法、存储介质 |
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 |