CN103424119B - 导航装置 - Google Patents
导航装置 Download PDFInfo
- Publication number
- CN103424119B CN103424119B CN201310182138.3A CN201310182138A CN103424119B CN 103424119 B CN103424119 B CN 103424119B CN 201310182138 A CN201310182138 A CN 201310182138A CN 103424119 B CN103424119 B CN 103424119B
- Authority
- CN
- China
- Prior art keywords
- link
- correction
- node
- road
- correction amount
- 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
- 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
-
- 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/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- 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
- 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/38—Electronic maps specially adapted for navigation; Updating thereof
- G01C21/3804—Creation or updating of map data
- G01C21/3807—Creation or updating of map data characterised by the type of data
- G01C21/3815—Road data
-
- 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/38—Electronic maps specially adapted for navigation; Updating thereof
- G01C21/3804—Creation or updating of map data
- G01C21/3833—Creation or updating of map data characterised by the source of data
- G01C21/3844—Data obtained from position sensors only, e.g. from inertial navigation
Abstract
导航装置具备:地图信息存储部,其存储与道路相关的道路信息;位置推定部,其推定移动体的位置;地图匹配部,其使用道路信息来确定与由位置推定部推定出的移动体的位置对应的多个链路候补点;并行路检测部,其基于多个链路候补点来检测彼此并行的并行路的各链路;行驶链路判定部,其对由并行路检测部检测出的并行路的各链路分别判定是移动体正在行驶的行驶链路或与行驶链路并行的并行链路的哪一者;和链路位置补正部,其基于多个链路候补点中的与行驶链路对应的链路候补点、和由位置推定部推定出的移动体的位置之间的距离,来求取行驶链路以及并行链路的各节点的位置补正量。
Description
下面的优先权基础申请的公开内容作为引用文而被引入到本说明书。日本专利申请2012-112991号(2012年5月17日提出申请)
技术领域
本发明涉及算出移动体的位置并将其显示在地图上的导航装置。
背景技术
现有技术中,在基于道路数据来显示道路地图的导航装置中,已知考虑车辆的行驶轨迹来补正道路数据的技术。例如,在专利文献1(日本特开2000-230835号公报)中公开的现有技术中,每当车辆在相同的道路上行驶3次以上,就对车辆的行驶轨迹进行平均化处理,由此作成补正用道路数据。在该补正用道路数据与原始的道路数据之间有规定的容许值以上的误差的情况下,将道路数据置换为补正用道路数据。由此,即使在道路数据中存在位置误差也能将其补正,来消除实际行驶的道路与显示的道路间的偏离,从而能进行准确的路径引导。
另外,在专利文献2(日本特开平11-23300号公报)中公开的现有技术中,基于车辆的方位变化来检测弯道、岔路的入口位置、出口位置、中央位置等,以该检测结果为基础来修正道路数据的误差。由此来补正弯道、岔路的道路数据。
在专利文献1和专利文献2的现有技术中,在多条道路彼此相邻且并行的情况下,能对其中的车辆行驶的道路补正道路数据,但不能对此外的道路补正道路数据。由此,在补正了道路数据的道路的位置、和与该道路并行的道路之间,有时会有位置关系发生颠倒的情况。这种情况下,下一次车辆在这些道路行驶时会引起误匹配,发生不能识别正确的行驶道路的问题。
发明内容
本发明鉴于上述那样的问题而提出,目的在于提供一种导航装置,能正确地补正彼此并行的多条道路的道路数据,能在下一次车辆行驶于这些道路时识别正确的行驶道路。
本发明的第1形态的导航装置具备:地图信息存储部,其存储与道路相关的道路信息;位置推定部,其推定移动体的位置;地图匹配部,其使用道路信息来确定与位置推定部所推定出的移动体的位置对应的多个链路(link)候补点;并行路检测部,其基于多个链路候补点来检测彼此并行的并行路的各链路;行驶链路判定部,其对由并行路检测部检测出的并行路的各链路分别判定是移动体正行驶的行驶链路或与行驶链路并行的并行链路的哪一者;和链路位置补正部,其基于多个链路候补点中的与行驶链路对应的链路候补点、和由位置推定部推定出的移动体的位置之间的距离,来求取行驶链路以及并行链路的各节点的位置补正量。
根据本发明的第2形态,第1形态的导航装置也可以还具备:链路位置补正实施判定部,其基于多个链路候补点中的与行驶链路对应的链路候补点、和由位置推定部推定出的移动体的位置之间的距离,来判定是否实施链路位置的补正。在该导航装置中,优选在由链路位置补正实施判定部判定为不实施链路位置的补正的情况下,链路位置补正部不求取行驶链路以及并行链路的各节点的位置补正量。
根据本发明的第3形态,第1或第2形态的导航装置也可以还具备:链路位置补正范围决定部,其基于与行驶链路对应的链路候补点、和由位置推定部推定出的移动体的位置之间的距离,来决定第1补正范围。在该导航装置中,优选链路位置补正部求取包含在由多个行驶链路构成的行驶链路队列或由多个并行链路构成的并行链路队列中且处于第1范围内的各节点的位置补正量。
根据本发明的第4形态,在第3形态的导航装置中,优选链路位置补正范围决定部基于位于第1补正范围的边界的节点的位置补正量除以规定的方位误差容许量的正切而得到的值,来进一步决定第2补正范围。另外,优选链路位置补正部,进一步对于包含在行驶链路队列或并行链路队列中且处于第2补正范围内的各节点的位置补正量,基于位于第1补正范围的边界的节点的位置补正量、和从位于第1补正范围的边界的节点到该节点为止的距离来进行求取。
根据本发明的第5形态,第4形态的导航装置也可以还具备:地图补正量存储部,其对由链路位置补正部求取了位置补正量的各节点存储其位置补正量。在该导航装置中,优选地图匹配部基于存储在地图补正量存储部中的位置补正量来补正由链路位置补正部求取了位置补正量的各节点的位置,从而确定多个链路候补点。
根据本发明的第6形态,在第5形态的导航装置中,优选地图补正量存储部对由链路位置补正部求取了位置补正量的各节点除了存储其位置补正量以外,还存储表征该节点属于第1补正范围或第2补正范围的哪一者的补正范围的种类。另外,优选地图匹配部对多个链路候补点中的与补正了至少一方的节点的位置的链路对应的链路候补点,基于存储在地图补正量存储部中的补正范围的种类来判断该节点属于第1补正范围或第2补正范围的哪一者,在判断为与该链路候补点对应的链路的两端的节点都属于第1补正范围的情况下,使用与补正后的节点位置相应的链路方位来算出该链路候补点的评价量,在判断为与该链路候补点对应的链路的任意的至少一方的节点属于第2补正范围的情况下,使用与补正前的节点位置相应的链路方位来算出该链路候补点的评价量。
根据本发明的第7形态,在第1~6的任一形态的导航装置中,优选链路位置补正部对行驶链路以及并行链路的各节点中的连接有多个链路的节点,按照与该节点连接的各链路的方位变化量的平方和变得最小的方式来求取该节点的位置补正量。
根据本发明的第8形态,第1~7的任一形态的导航装置也可以还具备:行驶位置指示部,其基于来自用户的输入来指示移动体的行驶道路。在该导航装置中,优选行驶链路判定部基于来自行驶位置指示部的指示来判定行驶链路。
本发明的第9形态的导航装置具备:地图信息存储部,其存储与道路相关的道路信息;画面声音输出部,其使用道路信息来显示道路地图;行驶位置指示部,其基于来自用户的输入来指示移动体的行驶道路;行驶链路判定部,其基于来自行驶位置指示部的指示来判定移动体正行驶的行驶链路、和与行驶链路并行的并行链路;和链路位置补正部,其补正行驶链路以及并行链路的位置。在该导航装置中,优选画面声音输出部根据链路位置补正部补正后的位置来使行驶链路以及并行链路在道路地图上移动。
根据本发明,能正确地补正彼此并行的多条道路的道路数据,在下一次车辆行驶于这些道路时,能识别正确的行驶道路。
附图说明
图1是表示本发明的一个实施方式的汽车导航装置的构成的图。
图2是表示汽车导航装置的动作步骤的图。
图3是表示地图匹配处理的动作的图。
图4是表示推定位置与过去读入的地图数据的网格区域的边缘之间的距离为阈值以下的示例的图。
图5是表示链路位置的补正的动作的图。
图6是表示链路位置的补正的动作的图。
图7是表示并行路的判定的示例的图。
图8是表示链路方位的设定方法的一例的图。
图9是表示链路方位的设定方法的另一例的图。
图10是表示链路位置补正后的并行路中的误匹配示例的图。
图11是表示本发明的链路位置补正后的并行路中的匹配示例的图。
图12是表示第1补正范围以及第2补正范围的示例的图。
图13是表示补正与3个链路连接的节点的示例的图。
图14是表示链路位置的补正的动作的一个变形例的图。
图15是表示链路位置的补正的动作的另一变形例的图。
图16是表示车辆的推定位置与链路候补点的距离的图。
具体实施方式
在图1中示出本发明的一个实施方式的汽车导航装置的构成。图1所示的汽车导航装置具备:接收单元101、传感器单元102、地图信息存储单元103、地图补正量存储单元104、画面声音输出单元105、路径搜索指示单元106、行驶位置指示单元107、以及运算单元110。
接收单元101例如能通过GPS(GlobalPositioningSystem,全球定位系统)接收机等实现。接收单元101包含天线,用该天线接收从定位卫星发送来的信号(定位信号)。
接收单元101还具备下变频(downconvert)、模拟数字变换、正交检波、C/A(coarse/acquisition,粗/捕获)码生成、相关检测以及解码的各处理功能。下变频功能是用于将由天线接收到的高频的定位信号变换为低频的定位信号的功能。模拟数字变换功能是用于将下变频后的低频的定位信号从模拟信号变换为数字信号的功能。正交检波功能是用于对变换为数字信号后的定位信号进行检波的功能。C/A码生成功能是用于生成按每个定位卫星预先确定的被称作C/A码的代码串的功能。相关检测功能是用于检测被检波后的定位信号和生成的C/A码的相关值的功能。解码功能是用于基于通过相关检测功能检测出的相关值来解码定位信号的功能。
接收单元101基于解码后的定位信号来检测包含定位卫星的轨道信息、发报状态的信息、电离层延迟计算参数等在内的导航消息。另外,还测定定位信号的接收时刻、定位信号所表征的虚拟距离(距卫星的距离)、多普勒频率、信号强度等的观测数据。然后,基于测定出的接收时刻和导航消息中的航道信息来算出定位卫星的位置,基于该定位卫星的位置和测定出的虚拟距离来算出设置有天线的车辆、即搭载了图1的汽车导航装置的车辆(以下称作本车辆)的位置(接收位置)。另外,根据接收时刻附近的定位卫星的位置算出定位卫星的速度,基于该计算结果、和定位卫星的位置以及多普勒频率来算出本车辆的速度以及方位(速度向量、接收速度以及接收方位)。
另外,上述的说明以定位卫星为GPS卫星的情况为例,但也可以取代GPS卫星而利用GLONASS卫星或伪卫星等的定位卫星。这些定位卫星是从宇宙或地面发报用于定位的信号的装置。
传感器单元102由用于检测本车辆的速度的车速脉冲计数器等的车速传感器、用于检测本车辆的角速度的陀螺仪等的角速度传感器、以及用于检测本车辆的加速度的加速度计等的加速度传感器构成。从这些各传感器分别输出本车辆的速度(传感器速度)、角速度(传感器角速度)以及加速度(传感器加速度)。另外,速度是与本车辆的前后方向相关的值,角速度是与本车辆的滚转角(rollangle)、俯仰角(pitchangle)以及偏航角(yawangle)相关的值,加速度是与上下方向相关的值。
由硬盘或存储器等构成的地图信息存储单元103按每个规定的网格(mesh)区域来保存与道路相关的道路信息和指引显示等的信息。道路信息针对各网格区域包含用于表征该网格区域内的各道路的节点编号、节点位置、链路编号、起点节点编号、终点节点编号、道路的车道数等的各信息。另外,节点是在道路上对应于交叉路口、分岔等而设定的点,链路是连结沿着道路而排列的2个节点间的线。
由硬盘或存储器等构成的地图补正量存储单元104对存储于上述的地图信息存储单元103的道路信息所表征的各道路中的补正了节点位置的道路,保存其节点位置补正量。
各道路中的节点位置通过后述那样的地图补正单元113的动作被适当补正。在补正了节点位置的情况下,该节点的纬度方向以及经度方向的位置补正量与用于识别该节点的节点编号建立关联地保存在地图补正量存储单元104中。另外,保存于地图补正量存储单元104的节点位置补正量的数据,针对将网格分割为规定数后的各信息包(parcel),按预先设定的每个信息包编号来管理。
画面声音输出单元105由监视器和扬声器等构成。画面声音输出单元105分别从地图信息存储单元103读入道路信息,从地图补正量存储单元104读入节点位置补正量。然后,基于读入的节点位置补正量来补正道路信息中的各节点的位置,根据补正后的各节点的位置来描绘链路,由此显示道路地图。
另外,画面声音输出单元105从后述的地图匹配单元112接受推定位置、推定方位、第1链路候补点的位置、方位以及链路编号、道路脱离判定结果。另外,在后面说明这些各信息的详情。然后,在来自地图匹配单元112的道路脱离判定结果表征道路行驶的情况下,画面声音输出单元105将第1链路候补点的位置和方位作为汽车标志描绘在道路地图上。另一方面,在来自地图匹配单元112的道路脱离判定结果表征道路脱离的情况下,画面声音输出单元105将推定位置和推定方位作为汽车标志描绘在道路地图上。
进而,画面声音输出单元105从后述的路径引导单元114取得引导方向信号、指引显示、道路引导信号的各信息。另外,在后面说明这些各信息的详情。然后,在来自路径引导单元114的道路引导信号为“有效”(ON)的情况下,画面声音输出单元105输出规定的指引显示,并用声音输出引导方向。
路径搜索指示单元106用于由用户输入目的地来指示路径搜索,由遥控器、触控面板、麦克风等构成。由用户使用路径搜索指示单元106而输入的目的地的信息被发送给路径搜索单元115。
行驶位置指示单元107用于基于来自用户的输入来指示与车辆的行驶位置对应的道路,由遥控器、触控面板、麦克风等构成。由用户使用行驶位置指示单元107输入与车辆的行驶位置对应的道路时,将与该行驶道路对应的链路的链路编号发送给地图补正单元113。
运算单元110由CPU(centralprocessingunit,中央运算处理装置)、存储器等构成。运算单元110在功能上具备位置推定单元111、地图匹配单元112、地图补正单元113、路径引导单元114以及路径搜索单元115。
位置推定单元111从接收单元101输入接收位置、接收速度以及接收方位,并从传感器单元102输入传感器速度、传感器角速度以及传感器加速度。然后,使用这些输入信息来算出汽车导航装置的位置(推定位置)、方位(推定方位)以及速度(推定速度),进而算出推定位置以及推定方位的误差协方差。
地图匹配单元112按照距由位置推定单元111算出的推定位置从近到远的顺序确定规定数量(例如4个)的网格,分别从地图信息存储单元103和地图补正量存储单元104读入而取得该各网格的道路信息和节点位置补正量。然后,使用由位置推定单元111算出的推定位置、推定方位以及它们的误差协方差、和取得的道路信息以及节点位置补正量,来计算各链路候补点的评价量。另外,关于各链路候补点的评价量的计算方法,在后面详细说明。基于该评价量的计算结果来确定本车辆行驶的概率最高的链路候补点,作为第1链路候补点,设定该第1链路候补点的链路编号并算出位置以及方位。
然后,地图匹配单元112建立本车辆在链路上行驶这样的虚无假设及其对立假设。基于统计学上的假设检验,使用由位置推定单元111算出的推定位置、推定方位以及它们的误差协方差、和取得的道路信息以及节点位置补正量,通过判定是否以规定的显著性水平(levelofsignificance)采纳虚无假设,来判定本车辆是否脱离了道路。
地图补正单元113由并行路检测单元121、行驶链路判定单元122、链路位置补正实施判定单元123、链路位置补正范围决定单元124以及链路位置补正单元125构成。
并行路检测单元121从地图匹配单元112取得由位置推定单元111算出的车辆的推定位置以及推定方位、包含第1链路候补点的多个链路候补点的位置、方位以及链路编号、和道路脱离判定结果。基于这些信息来判定与第1链路候补点对应的链路、和与其它的链路候补点对应的链路是否是彼此并行的道路(并行路)。然后,存储车辆的推定位置以及推定方位、与判定为是并行路的各链路对应的链路候补点的位置、方位以及链路编号。
行驶链路判定单元122通过求取将由并行路检测单元121判定为是并行路的各链路以道路为单位汇总而得到的链路队列,来求取与各并行路的并行区间对应的链路队列。对于如此求得的各链路队列,对由地图匹配单元112算出的链路候补点的评价量彼此进行比较,基于该比较结果,将任意的链路队列判定为车辆行驶的行驶链路队列,将其它的链路队列判定为与行驶链路队列并行的并行链路队列。
链路位置补正实施判定单元123每隔规定的行驶距离,算出行驶链路队列相对于车辆的推定位置的位置误差。其结果,在行驶链路队列中哪怕有一处的位置误差为规定的阈值以上的情况下,都判定为要对行驶链路队列以及并行链路队列实施链路位置的补正。另外,在该判定中使用的阈值相当于地图匹配中的链路位置误差的容许量。
链路位置补正范围决定单元124以车辆的行驶轨迹为基础,将如下范围决定为补正链路位置的第1补正范围,所述范围包含:在行驶链路队列中由链路位置补正实施判定单元123算出的位置误差超过阈值的部分、和与行驶链路队列的该部分对应的并行链路队列的部分。另外,基于位于第1补正范围的边界的各节点的位置、和该节点的位置补正量,来决定第2补正范围。
链路位置补正单元125针对由链路位置补正范围决定单元124决定的第1补正范围以及第2补正范围,来算出各个链路位置的补正量。然后,基于算出的补正量来补正包含在行驶链路队列以及并行链路队列中的各节点的位置,由此来补正并行路的各节点的位置。
路径搜索单元115从路径搜索指示单元106接受目的地的信息,从地图匹配单元112接受第1链路候补点的链路编号。然后,基于保存在地图信息存储单元103中的道路信息来确定距目的地最近的链路编号,基于该链路编号以及第1链路候补点的链路编号,来搜索将这些链路连起来的多条路径。在如此搜索出的路径中选定满足规定的条件的路径,例如距离最短的路径作为引导路径。
路径引导单元114从地图匹配单元112取得第1链路候补点的链路编号以及位置,从路径搜索单元115取得引导路径的链路编号,从地图信息存储单元103取得指引显示等的信息。若从第1链路候补点的位置起到引导路径中应左右转弯的分岔点为止的距离成为规定距离以下,则路径引导单元114使道路引导信号“有效”,在表征引导方向的引导方向信号中设定左右转弯的信息。然后,将引导方向信号、指引显示、道路引导信号等引导信息发送给画面声音输出单元105。
接下来,使用图2所示的流程图来说明以上说明的图1的汽车导航装置的动作步骤。
在步骤201中,接收单元101用天线来接收从定位卫星发送来的信号(定位信号),使用前述的各功能来检测包含定位卫星的轨道信息、发报状态的信息、电离层延迟计算参数等在内的导航消息,并测定接收时刻、虚拟距离、多普勒频率、信号强度等的观测数据。然后,以接收时刻以及轨道信息为基础来算出定位卫星的位置,以定位卫星的位置以及虚拟距离为基础来算出接收位置。另外,以轨道信息为基础,根据接收时刻附近的定位卫星的位置来算出定位卫星的速度,并以定位卫星的位置以及速度、多普勒频率为基础来算出接收速度以及接收方位。将如此算出的接收位置、接收速度以及接收方位发送给位置推定单元111。
在步骤202中,传感器单元102计测伴随本车辆的车轴的旋转而输出的车速脉冲数,将该脉冲数与规定的速度传感器的系数相乘,算出速度(传感器速度)。另外,输出与本车辆的角速度对应的信号,从该输出值减去角速度传感器的零偏(bias)部分,并与规定的角速度传感器的系数相乘,来算出角速度(传感器角速度)。进而,输出与本车辆的加速度对应的信号,从该输出值减去加速度传感器的零偏,来算出加速度(传感器加速度)。将如此算出的传感器速度、传感器角速度以及传感器加速度发送给位置推定单元111。
在步骤203中,位置推定单元111从接收单元101接受接收位置、接收速度以及接收方位,从传感器单元102接受传感器速度、传感器角速度以及传感器加速度,基于这些值,通过以下的动作步骤来进行位置推定处理。
在位置推定处理的动作步骤中,位置推定单元111将本车辆的位置、行进方向的速度、行进方向的加速度、方位、方位的角速度以及俯仰角作为状态量,建立用下述的数式1表征的状态方程式(连续型)。另外,在数式1中,将加速度以及角速度设置为一阶马尔可夫过程。
在数式1中,x(t)、y(t)、z(t)分别表征经度、纬度、高度方向的本车辆的位置,v(t)表征行进方向的速度,a(t)表征行进方向的加速度,θ(t)表征方位,ω(t)表征方位的角速度,表征俯仰角。此外,θp表征方位的预测值,表征俯仰角的预测值,αa表征加速度的时间常数的倒数,αω表征角速度的时间常数的倒数,σa、σω、分别表征加速度、方位的角速度、俯仰角的标准偏差,W(t)表征平均为0、标准偏差为1的白噪声,η(t)表征状态量向量。
进一步地,在位置推定处理的动作步骤中,将传感器速度、传感器角速度、传感器加速度、接收位置、接收速度、以及接收方位作为观测量,建立以下述数式2来表征的观测方程式(连续型)。
在数式2中,vs(t)表征传感器速度,gs(t)表征传感器加速度,ωs(t)表征传感器角速度,xr(t)、yr(t)、zr(t)分别表征经度、纬度、高度方向的接收位置,vr(t)表征接收速度,θr(t)表征接收方位,g表征重力加速度,ε(t)表征观测噪声向量,y(t)表征观测量向量。另外,θp(t)以及是根据通过数式5算出的预测量向量而得到的值。
…(数式1)
y(t)=Hη(t)+ε(t)
(数式2)
在从接收单元101有接收位置、接收速度以及接收方位的输出的情况下,位置推定单元111使用下述的数式3~数式7来算出推定位置、推定速度、推定加速度、推定方位、推定角速度以及推定俯仰角。通过使用数式3~数式7,能实现通过卡尔曼滤波器(Kalmanfilter)进行的计算。
在数式3~数式7中,K(k)表征增益矩阵,R表征观测噪声矩阵。另外,η(k|k)表征推定量向量,η(k+1|k)表征预测量向量,P(k|k)、P(k|k-1)分别表征η(k|k)、η(k|k-1)的推定误差协方差矩阵。Φ(Δt、αa、αω)表征状态迁移矩阵,Δt表征采样间隔,Q(k)表征系统噪声矩阵,k表征离散时间。
K(k)=P(k|k-1)HT(k)[H(k)P(k|k-1)HT(k)+R]-1...(数式3)
η(k|k)=η(k|k-1)+K(k)[y(k)-Hη(k|k-1)]...(数式4)
η(k+1|k)=Φ(Δt,αa,αω)η(k|k)...(数式5)
P(k|k)=P(k|k-1)-K(k)H(k)P(k|k-1)...(数式6)
P(k|k-1)=Φ(Δt,αa,αω)P(k|k-1)ΦT(Δt,αa,αω)+Q(k)...(数式7)
另一方面,在从接收单元101没有接收位置、接收速度以及接收方位的输出的情况下,位置推定单元111在上述的数式3~数式7中分别从观测量向量y、矩阵H以及观测噪声矩阵R中删除与接收位置、接收速度以及接收方位关联的要素。
位置推定单元111通过以上说明那样的步骤来进行位置推定处理,将由此得到的推定位置、推定方位以及推定速度、和位置以及方位的推定误差协方差发送给地图匹配单元112。
在步骤204中,地图匹配单元112通过以下那样的步骤来进行地图匹配处理。
在地图匹配处理中,首先,从地图信息存储单元103读入节点编号、节点位置、链路编号、起点节点编号、终点节点编号、宽度等的道路信息。另外,从地图补正量存储单元104读入节点编号以及节点的位置补正量。然后,关于设定了位置补正量的节点,将该位置补正量与从地图信息存储单元103读入的节点位置相加,由此补正节点位置。
接下来,对推定位置周围的各链路分别用前述那样的方法来求取链路候补点,基于各链路候补点的链路方位和规定的链路的位置误差来计算各链路候补点的位置误差的协方差。然后,基于计算出的各链路候补点的位置误差的协方差以及规定的方位误差的方差、链路候补点的位置以及方位、推定位置以及推定方位、它们的误差的协方差,来计算各链路候补点的评价值。根据该计算结果,将具有在道路上行驶的概率最高的评价量的链路候补点决定为第1链路候补点。
另外,基于链路的位置、方位以及它们的误差方差、宽度信息、推定位置以及推定方位以及它们的误差协方差,来判定本车辆是否脱离了道路。
地图匹配单元112将推定位置、推定方位、第1链路候补点的位置、方位以及链路编号、道路脱离判定结果作为以上说明那样的地图匹配处理的结果发送给路径搜索单元115、路径引导单元114以及画面声音输出单元105。另外,将推定位置、推定方位、包含第1链路候补点在内的多个链路候补点的位置、方位、评价量以及链路编号、道路脱离判定结果发送给地图补正单元113。
另外,关于以上说明那样的步骤204的地图匹配处理,在后面使用图3来进行详细说明。
在步骤205中,地图补正单元113通过以下那样的步骤来进行链路位置的补正。
在链路位置的补正中,首先由并行路检测单元121从地图信息存储单元103读入节点编号、节点位置、链路编号、起点节点编号、终点节点编号、宽度等的道路信息。另外,从地图匹配单元112接受推定位置、推定方位、包含第1链路候补点在内的多个链路候补点的位置、方位、评价量以及链路编号、道路脱离判定结果。然后,从与各链路候补点对应的各链路中判定彼此并行的并行路的链路,检测并行区间。
接下来,由行驶链路判定单元122求取与各并行路的并行区间对应的链路队列,对这些各链路队列,基于每隔规定的行驶距离的车辆的推定位置以及推定方位(行驶轨迹),来分别判定是行驶链路队列和并行链路队列的哪一者。或者,基于从行驶位置指示单元107得到的行驶道路的链路来分别判定是行驶链路队列和并行链路队列的哪一者。
接下来,由链路位置补正实施判定单元123基于车辆的行驶轨迹算出行驶链路队列的位置误差。然后,在算出的位置误差为阈值以上的情况下,判定为实施链路位置的补正。
在上述判定的结果判定为实施链路位置的补正的情况下,由链路位置补正范围决定单元124以车辆的行驶轨迹为基础,决定第1补正范围以及第2补正范围。
接着,由链路位置补正单元125对行驶链路队列以及并行链路队列的各链路位置进行补正。此时,在第1补正范围中,算出从行驶链路队列到车辆的行驶轨迹为止的向量,通过将该向量作为行驶链路队列以及并行链路队列的各节点的位置补正量,来补正各链路位置。另外,在第2补正范围中,对行驶链路队列以及并行链路队列的各节点位置进行补正,以使得各链路的方位误差成为规定的容许值以下。
另外,关于以上说明那样的步骤205的链路位置的补正,在后面使用图5、6来详细说明。
在步骤206中,判定有无路径搜索的输入。在有由用户对路径搜索指示单元106的目的地的输入的情况下,判定为有路径搜索的输入,并前进到步骤209。此时,路径搜索指示单元106将其目的地的信息发送给路径搜索单元115。另一方面,在没有目的地的输入的情况下,前进到步骤207。
在步骤207中,判定有无引导路径。在有引导路径的情况下,前进到步骤208。在没有引导路径的情况下,前进到步骤211。
在步骤208中,判定本车辆是否处于引导路径上。在与第1链路候补点对应的链路被包含在引导路径的链路中的情况下,判定为本车辆处于引导路径上,并前进到步骤210。另一方面,在与第1链路候补点对应的链路未包含在引导路径的链路中的情况下,判定为本车辆未处于引导路径上,并前进到步骤209。
在步骤209中,路径搜索单元115中,从地图信息存储单元103读入目的地附近的道路信息,计算从目的地到周围的各链路为止的距离,将该距离最近的链路编号设为目的地的链路。然后,从地图匹配单元112接受第1链路候补点的链路编号、位置以及方位,从第1链路候补点的链路朝向该方位来搜索连接到目的地的链路为止的多条路径,将其中满足规定的条件的路径、例如最短距离的路径设为引导路径。如此决定了引导路径后,路径搜索单元115将该引导路径上的链路编号发送给路径引导单元114。
在步骤S210中,路径引导单元114从路径搜索单元115接受引导路径上的链路编号,从地图匹配单元112接受第1链路候补点的位置、方位、链路编号以及道路脱离判定结果。另外,从地图信息存储单元103读入与引导路径上的链路对应的指引显示等的信息。
在来自地图匹配单元112的道路脱离判定结果表示道路行驶的情况下,路径引导单元114在从第1链路候补点的位置到应左右转弯的分岔点为止的距离成为规定距离以下时,使道路引导信号“有效”,并决定表征引导方向的引导方向信号。在从第1链路候补点的位置到应左右转弯的分岔点为止的距离没有成为规定距离以下时,使道路引导信号为“无效”(OFF)。在使道路引导信号为“有效”时,路径引导单元114将引导方向信号、指引显示、引导车道等的信息发送给画面声音输出单元105。
在步骤211中,画面声音输出单元105从地图信息存储单元103读入节点编号、节点位置、链路编号、宽度等的道路信息。另外,从地图补正量存储单元104读入节点编号以及节点的位置补正量。然后,描绘并显示车辆周边的道路地图。此时,对于设定了位置补正量的节点,将其位置补正量与从地图信息存储单元103读入的节点位置相加,在补正节点位置后描绘链路,由此描绘道路地图。
另外,画面声音输出单元105从地图匹配单元112接受推定位置、推定方位、第1链路候补点的位置、方位、链路编号以及道路脱离判定结果。然后,在道路脱离结果是道路行驶的情况下,将第1链路候补点的位置以及方位作为汽车标志描绘在道路地图上。另一方面,在道路脱离结果是道路脱离的情况下,画面声音输出单元105将车辆的推定位置以及推定方位作为汽车标志来描绘。
进而,画面声音输出单元105从路径引导单元114取得引导方向信号、指引显示、道路引导信号。然后,在道路引导信号为“有效”的情况下,输出指引显示,输出用于告知引导方向的图像或声音。
接着,使用图3在下面详细说明图2的步骤204的地图匹配处理。开始步骤204的地图匹配处理后,最初执行图3的步骤301。
在步骤301中,地图匹配单元112判定是否在过去取得过道路信息。在过去从地图信息存储单元103读入而取得过道路信息的情况下,前进到步骤302。在过去未从地图信息存储单元103读入而取得过道路信息的情况下,前进到步骤303。
在步骤302中,地图匹配单元112判定在图2的步骤203从位置推定单元111发送来的推定位置与在过去读入的道路信息的网格区域的边缘之间的距离是否为规定的阈值以下。例如,如图4所示,在推定位置401与过去读入了道路信息的4个网格区域402的边缘的距离比规定距离短、推定位置401被包含在处于4个网格区域402的边缘附近的斜线区域403内的情况下,前进到步骤303。反之,前进到步骤304。
在步骤303中,地图匹配单元112针对包含推定位置的网格区域、离规定位置近的规定数量、例如3个网格区域,从地图信息存储单元103读入并取得道路信息。在此,从地图信息存储单元103取得节点编号、节点位置、链路编号、起点节点编号、终点节点编号、宽度等的道路信息。另外,从地图补正量存储单元104读入并取得节点编号以及节点的位置补正量。另外,对于已经取得道路信息、节点的位置补正量的网格区域,不需要再度取得。
在步骤304中,地图匹配单元112判定是否有前次的处理中求得的链路候补点。在有前次的处理中求得的链路候补点的情况下,前进到步骤306。在没有前次的处理中求得的链路候补点的情况下,前进到步骤305。
在步骤305中,地图匹配单元112从位置推定单元111接受图2的步骤203中求得的推定位置、推定方位、推定速度以及推定位置与推定方位的误差协方差。然后,算出包含推定位置在内的网格区域内的全部的链路与推定位置之间的距离,按照该距离从短到长的顺序选定规定数量的链路。此时,基于从地图补正量存储单元104取得的节点编号以及节点的位置补正量,来确定补正了位置的节点,在对该节点的位置进行补正后,算出包含该节点的链路与推定位置之间的距离。分别对如此选定的各链路生成链路候补点。在此,将从推定位置垂向选定的各链路的垂线的垂足分别设为链路候补点。
在如上述那样生成链路候补点后,地图匹配单元112设定各链路候补点的方位。在此,针对各链路候补点,将表征该链路候补点所存在的链路的两个行进方向的彼此反向的2个链路方位中的、与从位置推定单元111接受的推定方位之差成为90度以下的一方的链路方位设为该链路候补点的方位。另外,具有包含于道路信息中的单向通行的信息的链路的情况并不限于此,将该链路候补点的方位设定为单向通行的方向。在执行步骤305后,前进到步骤308。
在步骤306中,地图匹配单元112从位置推定单元111接受图2的步骤203中求得的推定位置、推定方位、推定速度以及推定位置与推定方位的误差协方差。然后,通过将推定速度与规定的处理周期相乘来算出行驶距离,使前次的处理中求得的各链路候补点的位置向前方移动所算出的行驶距离的量。此时,使该位置沿着各链路候补点所存在的各链路移动。
在步骤307中,地图匹配单元112将在步骤306中算出的行驶距离与前次的累积行驶距离相加来算出本次的累积行驶距离,并判定其是否为规定距离以上。在本次的累积行驶距离为规定距离以上的情况下,将累积行驶距离设定为零,前进到步骤308。在本次的累积行驶距离不是规定距离以上的情况下,前进到步骤310。
在步骤308中,地图匹配单元112进行向链路的地图匹配处理。在此,通过按照以下说明的步骤来求取第1链路候补点,来进行向链路的地图匹配处理。
对于步骤305中生成的各链路候补点、或步骤306中向前方移动了的各链路候补点,最初,地图匹配单元112对处于该各链路候补点的前方规定距离处的全部链路新追加链路候补点。在此,通过与步骤305相同的方法来分别设定对前方的各链路追加的链路候补点。
接下来,地图匹配单元112使用下述的数式8到数式11,对步骤305中生成的各链路候补点、或步骤306中向前方移动了的各链路候补点、和上述追加的各链路候补点,分别计算评价量T。在数式8~数式11中,(xe,ye)表征推定位置,θe表征推定方位,(x1,y1)表征各链路候补点的位置,θl表征各链路候补点的方位,∑e表征推定位置以及推定方位的误差协方差矩阵,∑1表征链路候补点的位置以及方位的误差协方差矩阵,σp1以及σθ1表征预先设定的链路的位置误差以及方位误差的方差,n表征距离序列数据的数量。另外,距离序列数据是本车辆行驶过的间隔一定距离的地点的推定量以及链路候补点的数据。
∑d(i)=∑e(i)+∑l(i)...(数式10)
在本车辆在道路上行驶的情况下,与本车辆对应的链路候补点的位置以及方位应当与推定位置以及推定方位大致一致。因此,越是评价量T小的链路候补点,本车辆在与该链路候补点对应的道路上行驶的概率就越高。由此,地图匹配单元112在如上述那样算出各链路候补点的评价量T后,按评价量T从小(在道路上行驶的概率高)到大的顺序选定规定数量的链路候补点,除去此外的链路候补点的信息。然后,将链路候补点中的评价量T最小(在道路上行驶的概率最高)的链路候补点设为第1链路候补点。若假定推定位置以及推定方位的误差、链路位置以及方位的误差遵循正态分布,则评价量T遵循自由度2×n的χ平方分布。由此,评价量T的值以上的自由度2×n的χ平方分布的概率密度函数的积分值相当于在该道路上行驶的概率。
在步骤309中,地图匹配单元112进行从道路的偏离的判定。在此,首先地图匹配单元112如下述那样,以与第1链路候补点对应的链路为对象,来建立推定位置与链路的距离中是否存在差的假设。
·虚无假设Hp0:在推定位置与链路的距离中没有差。
·对立假设Hp1:在推定位置与链路的距离中存在差。
接下来,地图匹配单元112使用下述的数式12~数式15来算出使推定位置与链路的距离无量纲化后的检验量Tp。在此,∑pe表征推定位置的误差协方差,Σp1表征链路位置的误差协方差。
∑p=∑pe+∑pl...(数式14)
若假定推定位置的误差以及链路位置的误差遵循正态分布,则如上述那样算出的检验量Tp遵循自由度1的χ平方分布。由此,若规定显著性水平α,并基于自由度1的χ平方分布来进行针对该假设的检验,则地图匹配单元112能够如下述那样采纳假设。即,在检验量Tp为自由度1以及显著性水平α的χ平方值以下的情况下,不能放弃虚无假设,判定为在推定位置与链路的距离中没有差。另一方面,在检验量Tp大于自由度1以及显著性水平α的χ平方值的情况下,放弃虚无假设,判定为在推定位置与链路的距离中存在差。
进而,地图匹配单元112如下述那样,以与第1链路候补点对应的链路为对象来建立在推定方位与链路方位中是否存在差的假设。
·虚无假设Hθ0:在推定方位与链路方位中没有差。
·对立假设Hθ0:在推定方位与链路方位中存在差。
接着,地图匹配单元112使用下述的数式16~数式18,算出使推定方位与链路方位之差无量纲化后的检验量Tp。
Δθ=θe-θl...(数式17)
若假定推定方位的误差以及链路方位的误差遵循正态分布,则检验量Tθ遵循正态分布。因此,若规定显著性水平α,基于正态分布来进行针对该假设的双侧检验,则地图匹配单元112能够如以下那样采纳假设。即,在检验量Tθ的绝对值为显著性水平α/2的正态分布的值以下的情况下,不能放弃虚无假设,判定为在推定方位与链路方位中没有差。另一方面,在检验量Tθ的绝对值大于显著性水平α/2的正态分布的值的情况下,放弃虚无假设,判定为在推定方位与链路方位中存在差。
通过以上说明的各判定,在判定为推定位置与链路的距离中没有差、且推定方位与链路方位中没有差的情况下,地图匹配单元112判定为道路行驶,即判定为本车辆正在道路上行驶。反之,地图匹配单元112判定为道路脱离,即本车辆正从道路脱离。
在步骤310中,地图匹配单元112将从位置推定单元111接受到的推定位置以及推定方位、步骤308中求得的第1链路候补点的位置、方位以及链路编号、步骤309中进行的道路脱离的判定结果发送给路径搜索单元115、路径引导单元114以及画面声音输出单元105。另外,将从位置推定单元111接受到的推定位置以及推定方位、包含步骤308中求得的第1链路候补点在内的各链路候补点的位置、方位、评价量以及链路编号、步骤309中进行的道路脱离判定结果发送给地图补正单元113。
在执行步骤310后,结束图2的步骤204的地图匹配处理,前进到步骤205。在步骤204的地图匹配处理中,通过地图匹配单元112来进行以上说明那样的处理。
接着,下面使用图5、6来详细说明图2的步骤205的链路位置的补正。开始步骤205的链路位置的补正后,最初执行图5的步骤501。
在步骤501中,并行路检测单元121在图3的步骤307中判定累积行驶距离为规定的距离以上、在步骤308中实施了向链路的地图匹配处理的情况下,前进到步骤502。在未实施向链路的地图匹配处理的情况下,结束图2的步骤205的链路位置的补正,并前进到步骤206。
在步骤502中,并行路检测单元121接受图3的步骤310中从地图匹配单元112发送来的推定位置、推定方位、包含第1链路候补点在内的各链路候补点的位置、方位、评价量及链路编号、以及道路脱离判定结果。然后,分别算出第1链路候补点与其它的各链路候补点之间的距离以及方位差,并分别算出从第1链路候补点向其它的各链路候补点的方向、与第1链路候补点的方位之间的角度。
判定在如上述那样算出了相对于第1链路候补点的距离、方位差以及角度的其它的链路候补点中,是否存在该距离以及方位差分别在规定的阈值以内,且该角度从90°起处于规定的范围内的链路候补点。在存在满足这样的条件的链路候补点的情况下,判定为与第1链路候补点对应的链路和与该链路候补点对应的链路是彼此并行的并行路。另外,在满足条件的链路候补点存在多个的情况下,判定为与这些链路候补点对应的各链路和与第1链路候补点对应的链路是彼此并行的并行路。另一方面,在满足条件的链路候补点1个都没有的情况下,判定为与各链路候补点对应的任意链路彼此都不是并行路。
例如,如图7所示,通过从车辆的推定位置701向链路704、705分别垂下垂线,而由地图匹配单元112检测到第1链路候补点702和链路候补点703。然后,设第1链路候补点702与链路候补点703之间的距离706为规定的阈值以内,且第1链路候补点702的方位707与链路候补点703的方位708之间的方位差为规定的阈值以内。进而,假设从第1链路候补点702向链路候补点703的方向、与第1候补点702的方位707之间的角度709为大致90度。在这样的情况下,通过步骤502的处理,能够判定为链路704和链路705是并行路。
在步骤503中,并行路检测单元121存储车辆的推定位置以及推定方位、与步骤502中判定为是并行路的各链路对应的链路候补点的位置、方位、评价量及链路编号、以及道路脱离判定结果。另外,每隔图3的步骤307所示的规定距离存储这些信息。
在步骤504中,行驶链路判定单元122判定是否有用户对行驶位置指示单元107进行的行驶链路信息的输入。在有行驶链路信息的输入的情况下,前进到步骤505,在没有行驶链路信息的输入的情况下,前进到步骤506。
在步骤505中,行驶链路判定单元122接受并存储从行驶位置指示单元107发送来的行驶道路的链路编号、即用户作为行驶链路而输入的道路的链路编号。
在步骤506中,行驶链路判定单元122基于存储于并行路检测单元121的信息来判定车辆的行驶链路是否是并行路。在此,根据是否在步骤503中检测到并行路来判定车辆的行驶链路是否是并行路。即,在步骤503中检测到并行路的情况下,该并行路中的任一条链路是与第1链路候补点对应的车辆的行驶链路。因此,在该情况下,判定为行驶链路是并行路,结束图2的步骤205的链路位置的补正并前进到步骤206。另一方面,在步骤503中未检测到并行路的情况下,判定为行驶链路不是并行路,前进到步骤507。
在步骤507中,行驶链路判定单元122判定是否存在未判定行驶链路队列的并行路并退出了该并行路。在此,在每隔图3的步骤307所示的规定的距离而反复执行图5、6的步骤502以后的处理时,根据是否在当前的规定处理次数前执行的步骤502中检测到并行路、且在前次的处理以前执行的步骤509中未判定行驶链路队列,来判定是否存在未判定行驶链路队列的并行路并退出了该并行路。即,在当前的规定处理次数前执行的步骤502中检测到并行路、且在前次的处理以前执行的步骤509中未判定行驶链路队列的情况下,前进到步骤508。另一方面,在没有未判定行驶链路队列的并行路的情况下,即,在当前的规定处理次数前执行的步骤502中未检测到并行路、或者在检测到并行路时在前次的处理以前执行的步骤509中已经判定了行驶链路队列的情况下,结束图2的步骤205的链路位置的补正,并前进到步骤206。
在步骤508中,行驶链路判定单元122基于存储于并行路检测单元121的信息,确定被判定为并行路的各链路的链路编号。然后,基于所确定的链路编号来确定与由被判定为并行路的各链路构成的链路队列的起点对应的起点节点、和与该链路队列的终点对应的终点节点,并从地图信息存储单元103读入各自的节点编号以及节点位置的信息。由此,检测并行路所存在的并行区间,求取与各并行路的并行区间对应的链路队列。
在步骤509中,行驶链路判定单元122进行行驶链路队列以及并行链路队列的判定。在此,首先比较图3的步骤308中求得的第1链路候补点的评价量、和评价第二高的链路候补点(第2链路候补点)的评价量。另外,如前述那样,越是评价量小的链路候补点,车辆行驶在与该链路候补点对应的道路上的概率越高。即,第2链路候补点是评价量仅次于第1链路候补点的链路候补点。
在比较第1链路候补点的评价量与第2链路候补点的评价量的结果是这些评价量之差为规定的阈值以上的情况下,将有第1链路候补点的链路判定为车辆的行驶链路。另一方面在评价量之差不足阈值、且从行驶位置指示单元107取得了行驶道路的链路编号的情况下,将与该链路编号对应的链路判定为车辆的行驶链路。另外,在评价量之差不足阈值、且未从行驶位置指示单元107取得行驶道路的链路编号的情况下,不进行行驶链路队列的判定。
然后,将步骤508中求得的并行区间的各链路队列中的、与前述判定出的行驶链路相连的链路队列设为行驶链路队列,将其它的链路队列设为并行链路队列。此时,基于各链路队列的链路的终点与行驶链路的起点的节点编号是否相同来判定行驶链路与各链路队列是否相连。行驶链路判定单元122如以上说明那样进行行驶链路队列以及并行链路队列的判定。
在步骤510中,行驶链路判定单元122判定是否在步骤509中判定出行驶链路队列以及并行链路队列。在判定出行驶链路队列以及并行链路队列的情况下前进到步骤511。另一方面,在未判定出行驶链路队列以及并行链路队列的情况下,结束图2的步骤205的链路位置的补正,并前进到步骤206。
在步骤511中,链路位置补正实施判定单元123算出行驶链路队列的位置误差。在此,针对行驶链路队列上的各链路候补点,算出和与该链路候补点对应的推定位置、即求取了该链路候补点时的推定位置之间的距离。另外,在此算出的距离相当于行驶链路队列相对于各推定位置的位置误差。
在步骤512中,链路位置补正实施判定单元123基于步骤511中算出的行驶链路队列的位置误差来进行链路位置的补正实施的判定。在此,将作为行驶链路队列相对于各推定位置的位置误差而算出的各距离分别与规定的阈值进行比较,在其中哪怕有1个为规定阈值以上的情况下,都判定为实施链路位置的补正。另一方面,在行驶链路队列的位置误差全都不足阈值的情况下,判定为不实施链路位置的补正。另外,在该判定中使用的阈值如前述那样,相当于地图匹配中的链路位置误差的容许量。
在步骤513中,链路位置补正实施判定单元123对步骤512中是否判定为实施链路位置的补正进行判断。在判定为实施链路位置的补正的情况下,前进到步骤514,在判定为不实施链路位置的补正的情况下,结束图2的步骤205的链路位置的补正并前进到步骤206。
在步骤514中,链路位置补正范围决定单元124基于车辆的行驶轨迹来决定补正链路位置的第1补正范围。在此,在行驶链路队列中将包含位置误差超过阈值的部分、和与此对应的并行链路队列的部分在内的范围决定为第1补正范围。更具体地,在行驶链路队列中包含的各链路中,确定分别与步骤512中判定为位置误差为阈值以上的链路候补点对应的1或2个以上的链路。然后,将包含全部这些链路、和与这些链路对应的并行链路队列的各链路在内的范围设定为第1补正范围。
在步骤515中,链路位置补正单元125对在步骤514中决定的第1补正范围内所包含的行驶链路队列和并行链路队列算出节点位置的补正量。在此,首先对包含在第1补正范围内的行驶链路队列的各链路分别算出该链路上的各链路候补点和与其对应的各推定位置之间的距离。然后,求取算出的各距离的平均,并将其作为该链路的位置误差el。
接下来,使用下述的数式19以及数式20,算出位于第1补正范围内的行驶链路队列中包含的各节点的位置补正量(Δxrn,Δyrn)。在数式19中,el1、el2分别表征与该节点连接的2个链路的位置误差,θl1、θl2分别表征与该节点连接的2个链路的方位。在此,θl1、θl2根据从该链路上的链路候补点向对应的推定位置的方向来设定。例如,在有链路候补点的链路801与包含推定位置的行驶轨迹802的位置关系如图8所示那样的情况下,链路801的方位根据从链路801向行驶轨迹802的方向804,设定为如箭头803那样。另外,在有链路候补点的链路901与包含推定位置的行驶轨迹902的位置关系如图9所示那样的情况下,链路901的方位根据从链路901向行驶轨迹902的方向904,设定为如箭头903那样。
接着,针对包含在第1补正范围内的并行链路队列的各节点,在该节点的双侧求取靠近该节点的行驶链路队列内的2个节点。即,针对与该节点连接的2个链路的各方向,在行驶链路队列内分别1个1个地求取分别位于距该节点最近的位置的节点。然后,使用下述的数式21,根据这2个节点的补正量来算出处于第1补正范围内的并行链路队列中包含的各节点的位置补正量(Δxpn,Δypn)。在数式21中,Lnp1、Lnp2分别表征从该节点到靠近该节点的行驶链路队列内的2个节点为止的距离。由此,对并行链路队列内的各节点也能求取与行驶链路队列内的各节点同等的位置补正量。
另外,对于并行链路队列内的节点中的、处于第1补正范围的边界的节点,不使用上述数式21,设定与在行驶链路队列内处于第1补正范围的边界的节点的位置补正量相同的位置补正量。
在步骤516中,链路位置补正范围决定单元124在第1补正范围的边界附近决定第2补正范围。在此,首先,分别算出从分别位于第1补正范围的边界的行驶链路队列以及并行链路队列的各节点沿着链路到位于边界外的各节点为止的距离。将该距离为下述的数式22所算出距离Lm以内的范围设为第2补正范围。在数式22中,ebn表征在行驶链路队列中处于第1补正范围的边界的节点的位置补正量的x分量Δxpnb与y分量Δypnb的合成值、即与该节点连接的第1补正范围内的链路的位置误差,0p表征地图匹配中的方位误差的容许量。
在步骤517中,链路位置补正单元125使用下述的数式23来算出处于第2补正范围内的各节点的位置补正量(Δxns,Δyns)。在数式23中,Lns表征从处于第1补正范围的边界的节点到该节点为止的沿着链路的距离,θlb表征处于第1补正范围的边界的链路的方位。
在步骤518中,链路位置补正单元125将分别在上述步骤515、517中算出的各节点的位置补正量和该节点编号保存在地图补正量存储单元104内。此时,如前述那样,将这些信息保存在与该节点对应的信息包编号的存储区域中。
接着说明本申请发明的作用效果。在使用车辆的行驶轨迹来补正链路的位置的现有的道路数据的补正方法中,在将多条道路彼此相邻而并行的并行路作为补正对象的情况下,仅补正车辆行驶的链路的位置。因此,在车辆下次行驶于该并行路时,存在会产生误匹配这样的问题。
使用图10的示例在下面说明该状态。在图10中,例示了在主道1001和侧道1002并行的并行路中,分别表征主道1001、侧道1002的链路1003、1004的位置被偏离地设定的情况。在这样的情况下,在现有的补正方法中,若车辆行驶于侧道1002,则将链路1004的位置补正为补正后的链路1005的位置。于是,表征侧道1002的补正后的链路1005、与表征主道1001的链路1003的位置关系发生了逆转。其结果,在下次车辆行驶于主道1001时,会出现不是匹配于链路1003,而是误匹配在表征侧道1002的补正后的链路1005的情况。
与此相对,根据以上说明那样的本发明的汽车导航装置的动作步骤,在将并行路作为补正对象的情况下,不仅补正车辆行驶的链路,与该链路并行的链路的位置也相应进行补正。由此,在下次车辆行驶于该并行路时,能防止发生误匹配。
使用图11的示例在下面说明该状态。在图11中,与图10相同,例示了在主道1001与侧道1002并行的并行路中,分别表征主道1001、侧道1002的链路1003、1004的位置被偏离地设定的情况。若车辆行驶于侧道1002,则在本发明中,如前述那样,以车辆的行驶轨迹为基础来算出链路1004的位置误差。然后,如图11所示,将链路1004的位置补正为补正后的链路1005的位置,并使用与此同等的位置补正量将链路1003的位置也补正为补正后的链路1006的位置。如此,以相同的补正量来补正车辆的行驶链路以及与其并行的链路的位置。其结果,在下一次车辆行驶于主道1001时,能正确地匹配到补正后的链路1006的位置,在下一次车辆行驶于侧道1002时能正确地匹配到补正后的链路1005的位置。
另外,根据本发明的汽车导航装置的动作步骤,在图6的步骤516、517中,在行驶链路阵列的位置误差为阈值以上的第1补正范围的外侧决定第2补正范围,补正处于该第2补正范围内的各节点的位置。由此,即使补正第1补正范围内的链路位置也能降低在与该链路连接的链路产生的方位误差。其结果,能降低对地图匹配处理中的评价量的不良影响,能防止向错误的链路的匹配。
使用图12的示例在下面说明该状态。在图12中,例示了对链路队列1203、1204设定第1补正范围1201以及第2补正范围1202,将这些链路队列分别补正为补正的链路队列1205、1206的位置的情况。此时,第2补正范围1202如前述的数式22所示那样,设定为沿着链路离开第1补正范围1201的边界上的节点位置补正量1207除以规定的方位误差容许量1208的正切而得到的距离1209的范围。另外,方位误差容许量1208是地图匹配中的方位误差的容许量。如此设定第2补正范围1202,对该范围内的各节点位置进行补正。因此,能将通过补正第1补正范围1201内的各链路位置而产生的第2补正范围1202内的各链路的方位误差抑制在方位误差容许量1208以下。
另外,在图12中,也可以不是基于地图匹配中的方位误差的容许量,而是基于存储于地图信息存储单元103中的道路信息中的链路的方位误差的偏差来设定方位误差容许量1208。如此也能得到与上述相同的效果。
根据本发明的汽车导航装置的动作步骤,在图6的步骤512中,通过将行驶链路队列的位置误差与规定的阈值进行比较来进行链路位置的补正实施的判定。然后,在步骤514中,基于该判定结果来决定第1补正范围。该阈值如前述那样,相当于地图匹配中的链路位置误差的容许量。由此,能使补正后链路的位置误差为地图匹配的容许量以下。由此,能降低对地图匹配处理中的评价量的不良影响,从而能防止向错误的链路的匹配。另外,也可以不是基于地图匹配中的链路位置误差的容许量,而是基于存储于地图信息存储单元103的道路信息中的链路的位置误差的偏差来设定该阈值。如此,也能得到与上述相同的效果。
另外,由于不将行驶链路队列、并行链路队列的全部设为第1补正范围,而是如上述那样决定第1补正范围,因此能适当地设定第1补正范围。因此,缩短了链路位置的补正所需要的处理时间,并能降低进行位置补正的节点数。其结果,能抑制地图补正量存储单元104的容量从而降低汽车导航装置的产品成本。
根据本发明的导航装置的动作步骤,在由用户通过行驶位置指示单元107输入了行驶链路信息的情况下,行驶链路判定单元122在图5的步骤504以及步骤505中接受与该链路对应的链路编号。然后,在步骤509中,将与该链路编号对应的链路判定为车辆的行驶链路。因此,能可靠地判定行驶链路来补正链路位置,并能在并行路上防止向错误的链路的匹配。
另外,本发明的汽车导航装置并不限定于上述说明那样的实施方式,能进行各种变形来应用。在下面,说明本发明的汽车导航装置的变形例。
(变形例1)
在上述实施方式中,在图5的步骤508中,求取由被判定为并行路的各链路构成的链路队列来决定并行区间的范围。但是,也可以根据并行路的汇流点或分岔点来决定并行区间。如此,也能分别适当地补正行驶链路队列以及并行链路队列的位置,能防止下一次车辆行驶于该并行路时发生误匹配。
(变形例2)
在上述实施方式中,在图3的步骤308中进行的向链路的地图匹配处理中,使用前述的数式8~数式11来计算评价量T。但是,对于位置补正后的链路,也可以在数式9中使用补正前的链路方位来代替各链路候补点的方位θl来计算评价量T。如此,能除去由于位置补正而产生的链路方位的误差,从而能降低评价量T的误差。其结果,能防止向错误的链路的匹配。
(变形例3)
在上述实施方式中,补正链路位置时,如前述的图12所示那样,在处于第2补正范围内的各链路中发生与方位误差容许量1208相应的方位误差。由此,也可以如下述那样除去这样的补正引起的链路的方位误差。
在图6的步骤518中,链路位置补正单元125对于补正对象的各节点,在地图补正量存储单元104中除了保存前述的节点编号以及节点的位置修正量以外,还进一步保存该节点所属的补正范围的种类(第1补正范围或第2补正范围)。地图匹配单元112在图3的步骤308中进行向链路的地图匹配处理时,基于该补正范围的种类来判断在步骤305中补正了其位置的节点属于第1补正范围或第2补正范围的哪一者。即,在与计算评价量T的链路候补点对应的链路的两端的节点中的至少一方的节点的位置在步骤305中被补正的情况下,判断该节点属于第1补正范围或第2补正范围的哪一者。
在其结果是判断为至少一方的节点属于第2补正范围的情况下,取代该链路候补点的方位θl,使用与补正前的节点位置相应的链路方位来计算评价量T。另一方面,在判断为两端的节点都属于第1补正范围的情况下,取代该链路候补点的方位θl,使用与补正后的节点位置相应的链路方位来计算评价量T。而且,在除此以外的情况下,取代该链路候补点的方位θl,根据存储于地图信息存储单元103的道路信息所表征的各节点的节点位置来算出链路方位,并使用该链路方位来计算评价量T。如此,能除去由于位置补正而产生的链路方位的误差,从而能降低评价量T的误差。其结果,能防止向错误的链路的匹配。
(变形例4)
在上述实施方式中,也可以删除图1的地图补正量存储单元104。这种情况下,在图6的步骤518中,链路位置补正单元125针对补正对象的各节点,将保存于地图信息存储单元103中的节点位置变更为补正后的节点位置。如此也能得到与上述实施方式相同的作用效果。另外,由于能删除地图补正量存储单元104,因此能降低汽车导航装置的产品成本。
(变形例5)
在上述实施方式中,在图6的步骤515、步骤517中算出节点的位置补正量时,在与该节点连接的链路数为3个的情况下,也可以如下那样构成。
例如如图13所示,考虑算出连接有链路1301、1302以及1303的节点1304的位置补正量的情况。另外,设链路1301以及1302包含在行驶链路队列或并行链路队列中。这种情况下,使节点1304沿着未包含在行驶链路队列或并行链路队列中的链路1303的方向移动到补正后的节点1305的位置。然后,根据该补正后的节点1305的位置,使链路1301、1302分别移动到分别补正后的链路1306、1307的位置,并使链路1303移动。如此,补正后的链路1303由于其方位不会发生变化,因此不会产生方位误差。其结果,能不给地图匹配带来不良影响,能防止误匹配。
(变形例6)
另外,在上述实施方式中,在图6的步骤515、步骤517中算出节点的位置补正量时,在与该节点连接的链路的数量为4个以上的情况下,也可以使用下述的数式24~数式26。具体地,反复计算数式24~数式26,算出与连接于该节点的各链路的方位变化量的平方和相当的数式24的Ej的值成为最小的位置补正量(xd,yd)。在数式24~数式26中,m表征与该节点连接的链路的数量,(xn0,yn0)表征该节点的位置,(xni,yni)分别表征在与该节点连接的各链路处于与该节点相反侧的各节点的位置,j表征反复计算的次数。
…(数式26)
另外,在上述的说明中,以与节点连接的链路的数量为4个以上的情况为例进行了说明,但在与节点连接的链路的数量不足4个、即为2个或3个的情况下也能应用本变形例。
(变形例7)
在上述实施方式中,也可以删除图1的传感器单元102,并删除图2的步骤202中的传感器单元102的处理。这种情况下,在步骤203的位置推定处理中,优选位置推定单元111在前述的数式1~数式7中将与传感器单元102的测定值相关的要素作为不需要要素而删除。即,在数式1~数式7中,从状态量向量η(t)、矩阵F、矩阵G、状态迁移矩阵Φ(Δt、αa、αω)以及Q(k)的各自中删除与俯仰角关联的要素。另外,从观测量向量y、矩阵H以及观测噪声矩阵R的各自中删除与传感器速度vs(t)、传感器角速度ωs(t)、传感器加速度gs(t)关联的要素。由此,由于能削减传感器单元102以及计算处理量,因此能降低汽车导航装置的产品成本。
(变形例8)
在上述实施方式中,也可以将图5的步骤504、步骤505以及步骤506的次序如图14所示那样变更为步骤506、步骤504、步骤505的顺序。这种情况下,在步骤505结束后前进到步骤508。如此,行驶链路判定单元122在步骤506中判定为车辆的行驶链路是并行路的情况下,能在步骤505中从行驶位置指示单元107取得行驶道路的链路编号,并在步骤509判定行驶链路队列以及并行链路队列。并且,链路位置补正单元125能针对还包含车辆前方在内的该行驶链路队列以及并行链路队列,在图6的步骤515以及步骤517中算出节点位置的补正量来补正链路的位置。其结果,即使在车辆初次行驶的并行路中链路的位置误差较大的情况下,也能匹配到正确的链路。
在本变形例中,在车辆行驶于存储在地图信息存储单元103的道路信息中有位置偏离的并行路上时,在用户使用行驶位置指示单元107指示了与车辆的行驶位置对应的道路时,能由行驶链路判定单元122即刻进行行驶链路队列和并行链路队列的判定。其结果,能由链路位置补正单元125即刻补正行驶链路队列以及并行链路队列的位置,能根据该补正后的位置来在显示于画面声音输出单元105的道路地图上分别移动行驶链路队列以及并行链路队列。
(变形例9)
在上述的实施方式中,在图5以及图14的步骤502中,即使考虑道路脱离判定结果,也能检测并行路。即,在图3的步骤309中判定为道路行驶,且在算出了相对于第1链路候补点的距离、方位差以及角度的其它的链路候补点中,存在满足该距离以及方位差分别为规定的阈值以内且该角度处于90°起的规定的范围内的条件的链路候补点的情况下,判定为与第1链路候补点对应的链路和与该链路候补点对应的链路是彼此并行的并行路。
(变形例10)
在上述实施方式中,在图5的步骤515中,求取从包含在第1补正范围内的并行链路队列的各节点向行驶链路队列垂下垂线的点,在该点的双侧求取靠近该点的行驶链路内的2个节点。即使Lnp1以及Lnp2分别是从该点到靠近该点的行驶链路队列内的2个节点为止的距离,也能算出包含在并行链路队列中的该节点的位置补正量。
(变形例11)
在上述实施方式中,在图5以及图6、图14以及图6的流程图中,在道路脱离结果是道路脱离的情况下,也可以不算出节点位置的补正量。具体地,在图5的步骤503和步骤504之间、步骤504和步骤506之间、或者图14的步骤503和步骤506之间,结束图2的步骤205的链路位置的补正,前进到步骤206。
(变形例12)
另外,在上述实施方式中,在图5或图14的步骤507中判定为没有未判定行驶链路队列的并行路的情况下,也可以进行图15的流程图所示的动作步骤。如此,能补正不是并行路的道路的链路的位置。在本实施方式中,在图15的步骤1512、1513中,在行驶链路队列的位置误差为阈值以上的第3补正范围的外侧决定第4补正范围,对处于该第4补正范围内的各节点的位置进行补正。由此,即使补正第3补正范围内的链路位置也能降低在与该链路连接的链路中产生的方位误差。其结果,能降低对地图匹配处理中的评价量的不良影响,能防止向错误的链路的匹配。
下面说明图15的流程图所示的动作步骤。
在步骤1501中,行驶链路判定单元122判定是否由用户对行驶位置指示单元107进行了行驶链路信息的输入。在有行驶链路信息的输入的情况下前进到步骤1502,在没有行驶链路信息的输入的情况下前进到步骤1503。
在步骤1502中,行驶链路判定单元122接受并存储从行驶位置指示单元107发送来的行驶道路的链路编号、即由用户作为行驶链路而输入的道路的链路编号。
在步骤1503中,行驶链路判定单元122在当前的道路脱离判定结果是道路行驶的情况下,前进到步骤1504。在当前的道路脱离判定结果是道路脱离的情况下,结束图2的步骤205的链路位置的补正并前进到步骤206。
在步骤1504中,行驶链路判定单元122在每隔图3的步骤307所示的规定的距离而反复执行图5、图6、图15的步骤502以后的处理时,判定从前一次的处理到当前之间是否通过了分岔。在通过了分岔的情况下,前进到步骤1505。在未通过分岔的情况下,结束图2的步骤205的链路位置的补正,并前进到步骤206。
在步骤1505中,行驶链路判定单元122进行行驶链路队列的判定。在此,判定从前次实施图15的步骤1505的第1链路候补点的链路到当前的第1链路候补点的链路是否相连。在各第1链路候补点的链路相连的情况下,将包含存在第1链路候补点的链路在内的链路队列判定为车辆的行驶链路队列。另一方面,在各第1链路候补点的链路未相连、且从行驶位置指示单元107取得了行驶道路的链路编号的情况下,将包含与该链路编号对应的链路在内的链路队列判定为车辆的行驶链路队列。另外,在各第1链路候补点的链路未相连、且未从行驶位置指示单元107取得行驶道路的链路编号的情况下,不进行行驶链路队列的判定。在此,基于某链路的起点是否与另外的链路的终点的链路编号相同来判定链路是否相连。
在步骤1506中,行驶链路判定单元122判定在步骤1505是否判定出行驶链路队列。在判定出行驶链路队列的情况下,前进到步骤1507。另一方面,在未判定出行驶链路队列的情况下,结束图2的步骤205的链路位置的补正并前进到步骤206。
在步骤1507中,链路位置补正实施判定单元123算出行驶链路队列的位置误差。在此,针对行驶链路队列上的各链路候补点算出和与该链路候补点对应的推定位置、即求取了该链路候补点时的推定位置之间的距离。另外,在此算出的距离相当于行驶链路队列相对于各推定位置的位置误差。
在步骤1508中,链路位置补正实施判定单元123基于在步骤1507算出的行驶链路队列的位置误差来进行链路位置的补正实施的判定。在此,将作为行驶链路队列相对于各推定位置的位置误差而算出的各距离分别与规定的阈值进行比较,在其中哪怕有1个为规定的阈值以上的情况下,判定为实施链路位置的补正。另一方面,在行驶链路队列的位置误差都不足阈值的情况下,判定为不实施链路位置的补正。另外,在该判定中使用的阈值如前述那样相当于地图匹配中的链路位置误差的容许量。
在步骤1509中,链路位置补正实施判定单元123对是否在步骤1508中判定为实施链路位置的补正进行判断。在判定为实施链路位置的补正的情况下前进到步骤1510,在判定为不实施链路位置的补正的情况下,结束图2的步骤205的链路位置的补正并前进到步骤206。
在步骤1510中,链路位置补正范围决定单元124基于车辆的行驶轨迹来决定补正链路位置的第3补正范围。在此,将行驶链路队列中位置误差超过阈值的范围决定为第3补正范围。更具体地,在行驶链路队列中包含的各链路中确定分别与步骤1508中判定为位置误差为阈值以上的链路候补点对应的1或2条以上的链路。然后,将包含所有这些链路的范围设定为第3补正范围。
在步骤1511中,链路位置补正单元125算出针对包含在第3补正范围内的行驶链路队列的节点位置的补正量。在此,对于行驶链路队列的各链路分别算出该链路上的各链路候补点和与其对应的各推定位置之间的距离,将它们的平均设为该链路的位置误差el。然后,使用前述的数式19以及数式20来算出包含在行驶链路队列中的各节点的位置补正量(Δxrn,Δyrn)。
在步骤1512中,链路位置补正范围决定单元124在第3补正范围的边界附近决定第4补正范围。在此,首先分别算出从分别位于第3补正范围的边界的行驶链路队列的各节点沿着链路直到位于边界外的各节点为止的距离。将该距离为数式22所算出的距离Lm以内的范围设为第4补正范围。在此,在数式22中,ebn表征在行驶链路队列中处于第3补正范围的边界的节点的位置补正量的x分量Δxpnb与y分量Δypnb的合成值、即与该节点连接的第3补正范围内的链路的位置误差,θp表征地图匹配中的方位误差的容许量。
在步骤1513中,链路位置补正单元125使用数式23来算出处于第4补正范围内的各节点的位置补正量(Δxns,Δyns)。在此,在数式23中,Lns表征从处于第3补正范围的边界的节点到该节点为止的沿着链路的距离,θlb表征处于第3补正范围的边界的链路的方位。
在步骤1514中,链路位置补正单元125将在步骤1511、1513中算出的各节点的位置补正量和其节点编号保存在地图补正量存储单元104内的与该节点对应的信息包编号的存储区域中。
(变形例13)
在变形例12的实施方式中,在补正链路位置时,在处于第4补正范围内的各链路,发生与方位误差容许量相应的方位误差。由此,也可以如下述那样除去这样的补正引起的链路的方位误差。
在图15的步骤1514中,链路位置补正单元125对于补正对象的各节点,在地图补正量存储单元104中除了保存前述的节点编号以及节点的位置修正量以外,还进一步保存该节点所属的补正范围的种类(第3补正范围或第4补正范围)。地图匹配单元112在图3的步骤308中进行向链路的地图匹配处理时,基于该补正范围的种类来判断在步骤305中补正了其位置的节点属于第3补正范围或第4补正范围的哪一者。即,在与计算评价量T的链路候补点对应的链路的两端的节点中的至少一方的节点的位置在步骤305中被补正的情况下,判断该节点属于第3补正范围或第4补正范围的哪一者。
在其结果是判断为至少一方的节点属于第4补正范围的情况下,取代该链路候补点的方位θl,使用与补正前的节点位置相应的链路方位来计算评价量T。另一方面,在判断为两端的节点都属于第3补正范围的情况下,取代该链路候补点的方位θl,使用与补正后的节点位置相应的链路方位来计算评价量T。而且,在除此之外的情况下,取代该链路候补点的方位θl,根据存储于地图信息存储单元103的道路信息所表征的各节点的节点位置来算出链路方位,并使用该链路方位来计算评价量T。如此,能除去由于位置补正而产生的链路方位的误差,从而能降低评价量T的误差。其结果,能防止向错误的链路的匹配。
(变形例14)
在上述实施方式中,地图补正量存储单元104除了存储节点的位置补正量和其节点编号以外,还进一步存储该节点的补正次数。在图6的步骤515、517、图15的步骤1511、1513中,在地图补正量存储单元104中搜索是否存储了算出位置补正量的节点的位置补正量,在未存储算出位置补正量的节点的位置补正量的情况下,使用数式19以及数式20、数式21或数式23来算出节点的位置补正量。在存储了算出位置补正量的节点的位置补正量的情况下,使用数式19以及数式20、数式21、或者数式23来算出节点的位置补正量,并读入该节点的位置补正量、节点编号以及补正次数,使用数式27来算出节点的位置补正量(Δxna,Δyna)。在此,(Δxnm,Δynm)以及nm表征存储在地图补正量存储单元104中的节点的位置补正量以及补正次数,(Δxnc,Δync)表征在图6的步骤515、517、图15的步骤1511、1513中使用数式19以及数式20、数式21、或数式23而算出的节点的位置补正量。
在图6的步骤518以及图15的步骤1514中,链路位置补正单元125除了在图6的步骤515、517、图15的步骤1511、1513中算出的各节点的位置补正量和其节点编号之外,还进一步将该节点的补正次数保存在地图补正量存储单元104内的与该节点对应的信息包编号的存储区域中。在此,在节点的位置补正量存储于地图补正量存储单元104中的情况下,保存在所存储的补正次数加上1的值,在节点的位置补正量未存储于地图补正量存储单元104中的情况下,将补正次数保存为1。在本实施方式中,由于能使用补正次数的量的节点的位置补正量来进行平均,因此,提高了节点的位置补正量的精度。
(变形例15)
在上述实施方式中,也可以取代在图3的步骤308中算出评价量T的数式9、以及在步骤309中算出检验量Tp的数式13中使用的链路候补点的位置(xl,yl),考虑链路1603的宽度以及车辆的行驶方向,如图16所示那样,使用配置于距推定位置1601最近的车道的中央的位置1602(xl1,yl1)。使用本实施方式时,由于能考虑道路的宽度来算出推定位置与链路候补点的距离1604,因此评价量T的精度变佳,能降低向错误的链路的误匹配。
另外,在以上说明的实施方式以及各变形例中,说明了搭载于车辆而使用的汽车导航装置的示例,但本发明并不限定于此,能应用于搭载于车辆以外的各种移动体而使用的导航装置中。另外,还能应用于搭载于移动体而使用的导航装置以外的各种的信息终端,例如便携式电话、智能手机、个人计算机等中。
以上说明的实施方式、变形例终归只是一例,只要不损害发明的特征,本发明就不受到这些内容的限定。
Claims (12)
1.一种导航装置,具备:
地图信息存储部,其存储与道路相关的道路信息;
位置推定部,其推定移动体的位置;
地图匹配部,其使用所述道路信息来确定与所述位置推定部所推定出的所述移动体的位置对应的多个链路候补点;
并行路检测部,其基于所述多个链路候补点来检测彼此并行的并行路的各链路;
行驶链路判定部,其对由所述并行路检测部检测出的并行路的各链路分别判定是所述移动体正行驶的行驶链路或与所述行驶链路并行的并行链路的哪一者;和
链路位置补正部,其基于所述多个链路候补点中的与所述行驶链路对应的链路候补点、和由所述位置推定部推定出的所述移动体的位置之间的距离,来求取所述行驶链路以及所述并行链路的各节点的位置补正量。
2.根据权利要求1所述的导航装置,其中,
所述导航装置还具备:
链路位置补正实施判定部,其基于所述多个链路候补点中的与所述行驶链路对应的链路候补点、和由所述位置推定部推定出的所述移动体的位置之间的距离,来判定是否实施链路位置的补正,
在由所述链路位置补正实施判定部判定为不实施链路位置的补正的情况下,所述链路位置补正部不求取所述行驶链路以及所述并行链路的各节点的位置补正量。
3.根据权利要求1或2所述的导航装置,其中,
所述导航装置还具备:
链路位置补正范围决定部,其基于与所述行驶链路对应的链路候补点、和由所述位置推定部推定出的所述移动体的位置之间的距离,来决定第1补正范围,
所述链路位置补正部求取包含在由多个所述行驶链路构成的行驶链路队列或由多个所述并行链路构成的并行链路队列中且处于所述第1范围内的各节点的位置补正量。
4.根据权利要求3所述的导航装置,其中,
所述链路位置补正范围决定部基于位于所述第1补正范围的边界的节点的位置补正量除以规定的方位误差容许量的正切而得到的值,来进一步决定第2补正范围,
所述链路位置补正部,进一步对于包含在所述行驶链路队列或所述并行链路队列中且处于所述第2补正范围内的各节点的位置补正量,基于位于所述第1补正范围的边界的节点的位置补正量、和从位于所述第1补正范围的边界的节点到该节点为止的距离来进行求取。
5.根据权利要求4所述的导航装置,其中,
所述导航装置还具备:
地图补正量存储部,其对由所述链路位置补正部求取了位置补正量的各节点存储其位置补正量,
所述地图匹配部基于存储在所述地图补正量存储部中的位置补正量来补正由所述链路位置补正部求取了位置补正量的各节点的位置,从而确定所述多个链路候补点。
6.根据权利要求5所述的导航装置,其中,
所述地图补正量存储部对由所述链路位置补正部求取了位置补正量的各节点除了存储其位置补正量以外,还存储表征该节点属于所述第1补正范围或所述第2补正范围的哪一者的补正范围的种类,
所述地图匹配部对所述多个链路候补点中的与补正了至少一方的节点的位置的链路对应的链路候补点,基于存储在所述地图补正量存储部中的补正范围的种类来判断该节点属于所述第1补正范围或所述第2补正范围的哪一者,
在判断为与该链路候补点对应的链路的两端的节点都属于所述第1补正范围的情况下,使用与补正后的节点位置相应的链路方位来算出该链路候补点的评价量,
在判断为与该链路候补点对应的链路的任意的至少一方的节点属于第2补正范围的情况下,使用与补正前的节点位置相应的链路方位来算出该链路候补点的评价量。
7.根据权利要求1~2、4~6中任一项所述的导航装置,其中,
所述链路位置补正部对所述行驶链路以及所述并行链路的各节点中的连接有多个链路的节点,按照与该节点连接的各链路的方位变化量的平方和变得最小的方式来求取该节点的位置补正量。
8.根据权利要求3所述的导航装置,其中,
所述链路位置补正部对所述行驶链路以及所述并行链路的各节点中的连接有多个链路的节点,按照与该节点连接的各链路的方位变化量的平方和变得最小的方式来求取该节点的位置补正量。
9.根据权利要求1~2、4~6、8中任一项所述的导航装置,其中,
所述导航装置还具备:
行驶位置指示部,其基于来自用户的输入来指示所述移动体的行驶道路,
所述行驶链路判定部基于来自所述行驶位置指示部的指示来判定所述行驶链路。
10.根据权利要求3所述的导航装置,其中,
所述导航装置还具备:
行驶位置指示部,其基于来自用户的输入来指示所述移动体的行驶道路,
所述行驶链路判定部基于来自所述行驶位置指示部的指示来判定所述行驶链路。
11.根据权利要求9所述的导航装置,其中,
所述导航装置还具备:
行驶位置指示部,其基于来自用户的输入来指示所述移动体的行驶道路,
所述行驶链路判定部基于来自所述行驶位置指示部的指示来判定所述行驶链路。
12.一种导航装置,具备:
地图信息存储部,其存储与道路相关的道路信息;
画面声音输出部,其使用所述道路信息来显示道路地图;
行驶位置指示部,其基于来自用户的输入来指示移动体的行驶道路;
行驶链路判定部,其基于来自所述行驶位置指示部的指示来判定所述移动体正行驶的行驶链路、和与所述行驶链路并行的并行链路;和
链路位置补正部,其补正所述行驶链路以及所述并行链路的位置,
所述画面声音输出部根据所述链路位置补正部补正后的位置来使所述行驶链路以及所述并行链路在所述道路地图上移动。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2012-112991 | 2012-05-17 | ||
JP2012112991A JP5852920B2 (ja) | 2012-05-17 | 2012-05-17 | ナビゲーション装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103424119A CN103424119A (zh) | 2013-12-04 |
CN103424119B true CN103424119B (zh) | 2016-05-04 |
Family
ID=48463797
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310182138.3A Active CN103424119B (zh) | 2012-05-17 | 2013-05-16 | 导航装置 |
Country Status (4)
Country | Link |
---|---|
US (1) | US9395191B2 (zh) |
EP (1) | EP2664894B1 (zh) |
JP (1) | JP5852920B2 (zh) |
CN (1) | CN103424119B (zh) |
Families Citing this family (30)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6229523B2 (ja) * | 2014-02-12 | 2017-11-15 | 株式会社デンソー | 自車走行位置特定装置及び自車走行位置特定プログラム |
GB2537329B (en) * | 2014-02-27 | 2021-04-07 | Mitsubishi Heavy Ind Mach Systems Ltd | Map creation system and map creating method |
JP6427908B2 (ja) | 2014-03-24 | 2018-11-28 | アイシン・エィ・ダブリュ株式会社 | 地図情報生成システム、方法およびプログラム |
CN105444772A (zh) * | 2014-08-22 | 2016-03-30 | 环达电脑(上海)有限公司 | 导航装置及其方法 |
CN105606087B (zh) * | 2015-12-23 | 2020-01-14 | 北京百度网讯科技有限公司 | 导航方法以及装置 |
US10145691B2 (en) * | 2016-05-18 | 2018-12-04 | Here Global B.V. | Ambiguity map match rating |
CN106097748B (zh) * | 2016-06-02 | 2018-04-20 | 腾讯科技(深圳)有限公司 | 路况信息的推送方法及推送系统 |
CN105910611A (zh) * | 2016-06-27 | 2016-08-31 | 江苏迪纳数字科技股份有限公司 | 基于匹配度反馈的道路匹配方法 |
JP6982954B2 (ja) * | 2016-09-30 | 2021-12-17 | コイト電工株式会社 | マップマッチング処理装置、マップマッチング処理プログラム及び交通関連システム |
JP6614124B2 (ja) * | 2016-12-21 | 2019-12-04 | 株式会社デンソー | 緊急通報装置 |
US10534092B2 (en) | 2017-06-01 | 2020-01-14 | Tesla, Inc. | Technologies for vehicle positioning |
US10921133B2 (en) * | 2017-12-07 | 2021-02-16 | International Business Machines Corporation | Location calibration based on movement path and map objects |
US10801844B2 (en) * | 2017-12-31 | 2020-10-13 | Uber Technologies, Inc. | Remediating dissimilarities between digital maps and ground truth data via dissimilarity threshold tuning |
JP6966632B2 (ja) | 2018-03-30 | 2021-11-17 | 日立Astemo株式会社 | 車両制御装置 |
WO2019189084A1 (ja) * | 2018-03-30 | 2019-10-03 | 日立オートモティブシステムズ株式会社 | 車両制御装置 |
CN109003442B (zh) * | 2018-06-22 | 2020-08-21 | 安徽科力信息产业有限责任公司 | 一种道路延误时间计算及交通拥堵情况确定方法、系统 |
CN109523781B (zh) * | 2018-10-10 | 2020-07-28 | 中国电子科技集团公司第二十八研究所 | 一种基于卫星定位的路口预测方法 |
CN111044056B (zh) * | 2018-10-15 | 2023-10-13 | 华为技术有限公司 | 基于道路匹配的定位方法、芯片子系统及电子设备 |
JP7143722B2 (ja) * | 2018-10-31 | 2022-09-29 | トヨタ自動車株式会社 | 自車位置推定装置 |
CN113056778B (zh) * | 2018-11-29 | 2023-01-06 | 日立安斯泰莫株式会社 | 车辆控制系统及服务器 |
GB2579414B (en) * | 2018-11-30 | 2021-11-17 | Thales Holdings Uk Plc | Method and apparatus for determining a position of a vehicle |
US11168989B2 (en) * | 2019-01-02 | 2021-11-09 | Here Global B.V. | Supervised point map matcher |
US10949886B2 (en) * | 2019-03-12 | 2021-03-16 | Xevo Inc. | System and method for providing content to a user based on a predicted route identified from audio or images |
CN113022573B (zh) * | 2019-12-06 | 2022-11-04 | 华为技术有限公司 | 道路结构检测方法及装置 |
CN112083454A (zh) * | 2020-09-18 | 2020-12-15 | 北京卡路里信息技术有限公司 | 轨迹纠偏方法、装置、设备及存储介质 |
CN112683292A (zh) * | 2021-01-07 | 2021-04-20 | 阿里巴巴集团控股有限公司 | 一种导航路线确定方法、装置和相关产品 |
EP4190659A1 (en) * | 2021-12-06 | 2023-06-07 | Walter Steven Rosenbaum | Method and system for determining a state change |
CN114088101B (zh) * | 2022-01-14 | 2022-06-10 | 华清科盛(北京)信息技术有限公司 | 基于隐马尔可夫模型的已匹配定位点的矫正方法 |
US20240003705A1 (en) * | 2022-07-01 | 2024-01-04 | Here Global B.V. | Method and apparatus for providing a path-based map matcher |
CN116310186B (zh) * | 2023-05-10 | 2023-08-04 | 深圳智筱视觉科技有限公司 | 一种基于地理位置的ar虚拟空间定位方法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11233000A (ja) * | 1998-02-16 | 1999-08-27 | Hamamatsu Photonics Kk | 光電陰極及び電子管 |
JP2000230835A (ja) * | 1999-02-10 | 2000-08-22 | Daihatsu Motor Co Ltd | ナビゲーション装置及びその制御方法 |
CN1677059A (zh) * | 2004-03-31 | 2005-10-05 | 株式会社电装 | 车辆导航系统 |
CN101101214A (zh) * | 2006-07-03 | 2008-01-09 | 日本电气株式会社 | 适于地图匹配的链路设置系统及其方法和程序 |
CN102016500A (zh) * | 2008-04-28 | 2011-04-13 | 株式会社纳维泰 | 路径向导系统、路径检索服务器、路径向导方法及终端装置 |
CN102057251A (zh) * | 2008-06-04 | 2011-05-11 | 株式会社日立制作所 | 导航装置、导航方法及导航系统 |
CN102192745A (zh) * | 2010-02-24 | 2011-09-21 | 歌乐株式会社 | 位置推测装置及位置推测方法 |
CN102209880A (zh) * | 2008-11-07 | 2011-10-05 | 株式会社纳维泰 | 路径向导中介系统、路径向导中介服务器及路径向导方法 |
CN102414538A (zh) * | 2009-04-23 | 2012-04-11 | 株式会社纳维泰 | 路径向导系统、路径检索服务器、路径向导中介服务器及路径向导方法 |
Family Cites Families (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH03108100A (ja) * | 1989-09-21 | 1991-05-08 | Matsushita Electric Ind Co Ltd | 車載用ナビゲーション装置 |
JP2897440B2 (ja) * | 1991-03-07 | 1999-05-31 | 株式会社デンソー | 車両走行位置表示装置 |
JP2902340B2 (ja) | 1995-12-28 | 1999-06-07 | アルパイン株式会社 | 車両位置修正方法 |
JP3451162B2 (ja) * | 1996-05-09 | 2003-09-29 | アルパイン株式会社 | ナビゲーション装置及び移動体の現在位置修正方式 |
JP3582560B2 (ja) * | 1997-07-08 | 2004-10-27 | アイシン・エィ・ダブリュ株式会社 | 車両用ナビゲーション装置及び記録媒体 |
JP3366225B2 (ja) * | 1997-07-09 | 2003-01-14 | 本田技研工業株式会社 | ナビゲーション装置及び車両制御装置 |
JP4064639B2 (ja) * | 2001-03-16 | 2008-03-19 | 松下電器産業株式会社 | 地図編集装置 |
JP2004198811A (ja) * | 2002-12-19 | 2004-07-15 | Denso Corp | 電子機器及びプログラム |
US20050102098A1 (en) * | 2003-11-07 | 2005-05-12 | Montealegre Steve E. | Adaptive navigation system with artificial intelligence |
TWI290214B (en) * | 2006-04-04 | 2007-11-21 | Mitac Int Corp | Method of modified navigation information map with discriminated function and the apparatus thereof |
JP2008026032A (ja) | 2006-07-18 | 2008-02-07 | Denso Corp | 車両用ナビゲーション装置 |
JP2008202941A (ja) * | 2007-02-16 | 2008-09-04 | Denso Corp | ナビゲーション装置 |
JP5063166B2 (ja) * | 2007-04-10 | 2012-10-31 | アルパイン株式会社 | ナビゲーション用地図データ作成装置 |
JP2008298573A (ja) | 2007-05-31 | 2008-12-11 | Aisin Aw Co Ltd | 経路設定システム、経路設定方法及びそのプログラム |
KR100944642B1 (ko) | 2007-07-23 | 2010-03-04 | 팅크웨어(주) | 네비게이션 시스템 및 맵 보정 안내방법 |
-
2012
- 2012-05-17 JP JP2012112991A patent/JP5852920B2/ja active Active
-
2013
- 2013-05-16 CN CN201310182138.3A patent/CN103424119B/zh active Active
- 2013-05-16 US US13/895,915 patent/US9395191B2/en active Active
- 2013-05-17 EP EP13168210.6A patent/EP2664894B1/en active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11233000A (ja) * | 1998-02-16 | 1999-08-27 | Hamamatsu Photonics Kk | 光電陰極及び電子管 |
JP2000230835A (ja) * | 1999-02-10 | 2000-08-22 | Daihatsu Motor Co Ltd | ナビゲーション装置及びその制御方法 |
CN1677059A (zh) * | 2004-03-31 | 2005-10-05 | 株式会社电装 | 车辆导航系统 |
CN101101214A (zh) * | 2006-07-03 | 2008-01-09 | 日本电气株式会社 | 适于地图匹配的链路设置系统及其方法和程序 |
CN102016500A (zh) * | 2008-04-28 | 2011-04-13 | 株式会社纳维泰 | 路径向导系统、路径检索服务器、路径向导方法及终端装置 |
CN102057251A (zh) * | 2008-06-04 | 2011-05-11 | 株式会社日立制作所 | 导航装置、导航方法及导航系统 |
CN102209880A (zh) * | 2008-11-07 | 2011-10-05 | 株式会社纳维泰 | 路径向导中介系统、路径向导中介服务器及路径向导方法 |
CN102414538A (zh) * | 2009-04-23 | 2012-04-11 | 株式会社纳维泰 | 路径向导系统、路径检索服务器、路径向导中介服务器及路径向导方法 |
CN102192745A (zh) * | 2010-02-24 | 2011-09-21 | 歌乐株式会社 | 位置推测装置及位置推测方法 |
Also Published As
Publication number | Publication date |
---|---|
EP2664894B1 (en) | 2017-04-12 |
CN103424119A (zh) | 2013-12-04 |
US20130311086A1 (en) | 2013-11-21 |
JP2013238544A (ja) | 2013-11-28 |
JP5852920B2 (ja) | 2016-02-03 |
EP2664894A2 (en) | 2013-11-20 |
US9395191B2 (en) | 2016-07-19 |
EP2664894A3 (en) | 2016-02-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103424119B (zh) | 导航装置 | |
US11639853B2 (en) | Self-localization estimation device | |
Bétaille et al. | Creating enhanced maps for lane-level vehicle navigation | |
Barrios et al. | Improving estimation of vehicle's trajectory using the latest global positioning system with Kalman filtering | |
Rahmani et al. | Path inference from sparse floating car data for urban networks | |
Goh et al. | Online map-matching based on hidden markov model for real-time traffic sensing applications | |
Li et al. | Lane-level map-matching with integrity on high-definition maps | |
Hasberg et al. | Simultaneous localization and mapping for path-constrained motion | |
Ren et al. | A fuzzy logic map matching for wheelchair navigation | |
CN108922173A (zh) | 一种车辆偏离检测方法及装置 | |
CN103492837A (zh) | 位置计算方法和位置计算装置 | |
CN102620741B (zh) | 路线引导系统、路线引导方法以及路线引导程序 | |
Jung et al. | Monocular visual-inertial-wheel odometry using low-grade IMU in urban areas | |
Blazquez et al. | Simple map-matching algorithm applied to intelligent winter maintenance vehicle data | |
EP2796337B1 (en) | Method for determining the track course of a track bound vehicle | |
Heirich et al. | Probabilistic localization method for trains | |
Winter et al. | Increasing accuracy in train localization exploiting track-geometry constraints | |
JP5732377B2 (ja) | ナビゲーション装置 | |
Roth et al. | Map-supported positioning enables in-service condition monitoring of railway tracks | |
Hsu et al. | Intelligent viaduct recognition and driving altitude determination using GPS data | |
Smaili et al. | Multi-sensor fusion method using dynamic Bayesian network for precise vehicle localization and road matching | |
Kwon et al. | Constrained stochastic hybrid system modeling to road map-GPS integration for vehicle positioning | |
Karimi et al. | A methodology for predicting performances of map-matching algorithms | |
Toro et al. | Particle Filter technique for position estimation in GNSS-based localisation systems | |
JP2009036651A (ja) | ナビゲーション装置、ナビゲーション方法及びナビゲーションプログラム |
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 |