CN101545784A - 道路形状推定装置、道路形状推定方法以及程序 - Google Patents

道路形状推定装置、道路形状推定方法以及程序 Download PDF

Info

Publication number
CN101545784A
CN101545784A CN200910118189A CN200910118189A CN101545784A CN 101545784 A CN101545784 A CN 101545784A CN 200910118189 A CN200910118189 A CN 200910118189A CN 200910118189 A CN200910118189 A CN 200910118189A CN 101545784 A CN101545784 A CN 101545784A
Authority
CN
China
Prior art keywords
bend
mentioned
interpolation points
road
radius
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN200910118189A
Other languages
English (en)
Other versions
CN101545784B (zh
Inventor
福元将高
杉浦博昭
东条健到
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Aisin AW Co Ltd
Original Assignee
Aisin AW Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Aisin AW Co Ltd filed Critical Aisin AW Co Ltd
Publication of CN101545784A publication Critical patent/CN101545784A/zh
Application granted granted Critical
Publication of CN101545784B publication Critical patent/CN101545784B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/02Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
    • B60W40/06Road conditions

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Mathematical Physics (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)
  • Traffic Control Systems (AREA)
  • Instructional Devices (AREA)

Abstract

本发明能够正确地推定道路形状的道路形状推定装置、道路形状推定方法以及程序。具有取得沿着道路设定的表示道路形状的多个形状插补点的插补点数据的数据取得处理装置、基于上述道路的规定的区间内的上述插补点数据计算各形状插补点的曲率半径的半径计算处理装置、基于各曲率半径检测上述区间内的弯道的弯道检测处理装置、在所检测出的弯道内,以具有上述阈值以上的曲率半径的形状插补点进行弯道的分割的弯道分割处理装置。与上述检测出的弯道内的各形状插补点的曲率半径的平均值对应地设定上述阈值。由于以具有阈值以上的曲率半径的形状插补点进行弯道的分割,所以可以正确地推定道路形状。

Description

道路形状推定装置、道路形状推定方法以及程序
技术领域
本发明涉及道路形状推定装置、道路形状推定方法以及程序。
背景技术
一直以来,在导航装置中,例如,通过GPS(全球定位系统)检测本车车辆的当前位置、即当前地,从数据记录部读出地图数据,在显示部上形成地图画面,在该地图画面上显示表示当前地的本车位置、该本车位置的周边地图等。因此,驾驶员可以依照在上述地图画面上显示的本车位置等使车辆行驶。
此外,驾驶员输入目的地,设定搜索条件后,基于该搜索条件,进行路线搜索处理,依照上述地图数据,搜索从以当前地的形式显示的出发地到目的地为止的路线。并且,在上述地图画面上与本车位置一起显示搜索到的路线、即搜索路线,并进行搜索路线的引导、即路线引导。因此,驾驶员可以沿所显示的搜索路线使车辆行驶。
于是,提供有一种车辆控制系统,其利用在上述导航装置中获得的信息变更自动变速机的变速级,或者变更发动机的输出,控制车辆的行驶。
在该车辆控制系统中,配有道路形状推定装置,通过该道路形状推定装置推定道路形状。并且,上述道路形状推定装置,从在上述导航装置的数据记录部配置的数据库读出道路数据,由此取得与为了在数据库上用多个点表示道路形状而设定的插补点、即形状插补点相关的插补点数据,通过3点计算法计算各形状插补点的道路的曲率半径(以下简称为“半径”),基于各半径,在数据库上检测弯道并进行设定,同时,设定表示该弯道的开始点的开始候补点、以及表示弯道的结束点的结束候补点。此外,上述道路形状推定装置,基于由弯道的近似式表示的回旋(clothoid)曲线,修正开始候补点以及结束候补点的位置,推定道路形状,将修正过的开始候补点以及结束候补点的位置作为表示道路形状的数据记录在记录部中(例如,参照专利文献1)。
专利文献1:JP特开2005-214839号公报
但是,在上述现有的道路形状推定装置中,在实际的道路上应作为多个弯道来看的弯道,会由于在数据库上的形状插补点的设定方法,而作为一个弯道被检测出来。
其结果,无法正确地推定道路形状。
发明内容
本发明,为了解决上述现有的道路形状推定装置的问题点,提供一种能够正确地推定道路形状的道路形状推定装置、道路形状推定方法以及程序。
为此,在本发明的道路形状推定装置中,具有:数据取得处理装置,其取得沿道路设定的表示道路的形状的多个形状插补点的插补点数据;半径计算处理装置,其基于上述道路的规定区间内的上述插补点数据,计算各形状插补点的曲率半径;弯道检测处理装置,其基于上述各形状插补点的曲率半径检测上述区间内的弯道;弯道分割处理装置,其与上述检测出的弯道内的各形状插补点的曲率半径的平均值对应地设定阈值,在上述所检测出的弯道内,以具有上述阈值以上的曲率半径的形状插补点进行弯道的分割。
根据本发明,在所检测出的弯道内以具有阈值以上的曲率半径的形状插补点进行弯道的分割,因此,即使假设在数据库上插补点数据的精度低,且在弯道的直线区间中从直线偏离地设定了规定的形状插补点的情况下,也能够适当地进行弯道的分割。因此,在实际的道路上作为多个弯道来看的弯道,不会在数据库上被设为一个弯道,因此能够正确地推定道路形状。
附图说明
图1是本发明的实施方式的车辆控制系统的框图。
图2是表示本发明的实施方式的道路形状推定处理装置的动作的主流程图。
图3是表示本发明的实施方式中的半径计算处理的子程序的图。
图4是说明本发明的实施方式中的计算半径的原理的图。
图5是本发明的实施方式中的弯道检测处理的第1说明图。
图6是本发明的实施方式中的弯道检测处理的第2说明图。
图7是本发明的实施方式中的弯道检测处理的第3说明图。
图8是本发明的实施方式中的弯道检测处理的第4说明图。
图9是本发明的实施方式中的弯道检测处理的第5说明图。
图10是本发明的实施方式中的弯道检测处理的第6说明图。
图11是本发明的实施方式中的弯道检测处理的第7说明图。
图12是本发明的实施方式中的弯道检测处理的第8说明图。
图13是本发明的实施方式中的弯道检测处理的第9说明图。
图14是表示本发明的实施方式中的第1弯道分割处理的子程序的图。
图15是本发明的实施方式中的第1弯道分割处理的第1说明图。
图16是本发明的实施方式中的第1弯道分割处理的第2说明图。
图17是本发明的实施方式中的第1弯道分割处理的第3说明图。
图18是本发明的实施方式中的第1弯道分割处理的第4说明图。
图19是本发明的实施方式中的弯道检测处理的第10说明图。
图20是表示本发明的实施方式中的第2弯道分割处理的子程序的图。
图21是本发明的实施方式中的第2弯道分割处理的第1说明图。
图22是本发明的实施方式中的第2弯道分割处理的第2说明图。
图23是本发明的实施方式中的第2弯道分割处理的第3说明图。
图24是本发明的实施方式中的回旋系数映射(MAP)的图。
图25是表示本发明的实施方式中的回旋曲线计算处理的子程序的图。
图26是本发明的实施方式中的拟合处理的说明图。
图中:16-数据记录部;31-CPU。
具体实施方式
以下,参照附图详细说明本发明的实施方式。
图1是本发明的实施方式的车辆控制系统的框图。图2是表示本发明的实施方式的道路形状推定处理装置的动作的主流程图。
在图中,14是信息终端,例如,是作为在车辆上安装的车载装置的导航装置,该导航装置14,具有:将车辆的当前地作为本车位置,将车辆的方位作为本车方位检测的作为当前地检测部的GPS传感器15;除了未图示的地图数据之外还记录了各种信息的作为信息记录部的数据记录部16;进行导航处理等各种运算处理的导航处理部17;通过操作者即驾驶员操作来进行规定的输入用的作为第1输入部的操作部34;通过未图示的画面上显示的画像进行各种显示,并通知驾驶员用的作为第1输出部的显示部35;驾驶员通过语音进行规定的输入用的作为第2输入部的语音输入部36;进行语音输出并将各种信息通知驾驶员用的作为第2输出部的语音输出部37;以及作为通信终端发挥功能的作为收发部的通信部38,GPS传感器15、数据记录部16、操作部34、显示部35、语音输入部36、语音输出部37以及通信部38与上述导航处理部17连接。此外,作为检测车速的车速检测部的车速传感器44等与上述导航处理部17连接。并且,上述GPS传感器15除了本车位置以及本车方位之外还检测时刻。另外,也可以与GPS传感器15独立地配有未图示的方位传感器,通过该方位传感器检测本车方位。
在上述数据记录部16中配有由地图数据文件构成的数据库,在该数据库中记录有地图数据。在该地图数据中包含:与连接各交叉点(也包含分叉点)间的道路相关的道路数据、与表示上述道路的端点(起点以及终点)的节点相关的节点数据、与上述交叉点相关的交叉点数据、为了搜索用而被加工过的搜索数据、与设施相关的设施数据等,此外还包括与道路上的地物相关的地物数据。另外,在上述道路数据中包括:表示在上述数据库上从道路的起点到终点的道路路段的数据、以及作为在道路路段上用于表示道路形状而沿道路设定的多个设定点的形状插补点的数据(以下称为“插补点数据”)。在插补点数据中包含各形状插补点的编号、坐标等。另外,各节点表示道路路段上的起点或者终点,因此也是形状插补点。
进而,在上述数据记录部16中配设有由统计数据文件构成的数据库,由行驶履历数据文件构成的数据库等,在上述统计数据文件中记录有统计数据,在上述行驶履历数据文件中记录有行驶履历数据,都作为实绩数据而被记录。
并且,在上述数据记录部16中,为了记录上述各种数据,除了具备硬盘、CD、DVD、光盘等未图示的盘之外,还具备用于读写各种数据的读写头等未图示的头。此外上述数据记录部16可以使用存储卡等。
上述导航处理部17,具备:作为控制导航装置14整体的控制装置的并且作为运算装置的CPU31;在该CPU31进行各种运算处理时作为工作存储器使用的RAM32;除了控制用的程序之外,还记录用于进行到目的地为止的路线的搜索、路线引导等的各种程序的ROM33;用于记录各种数据、程序等而使用的未图示的闪速存储器等。
作为上述操作部34,可以使用与显示部35独立地配设的未图示的键盘、鼠标等。此外,作为上述操作部34可以使用触摸面板,可以通过触摸或者点击在上述显示部35上形成的画面上用图像显示的各种键、开关、按钮等图像操作部,进行规定的输入操作。
作为上述显示部35使用显示器,可以在显示部35上形成的各种画面上显示本车位置、本车方位等,或者显示地图、搜索路线、沿该搜索路线的引导信息、交通信息等,或者显示搜索路线中的到下一个交叉点为止的距离,在下一个交叉点的行进方向。
此外,语音输入部36,可以由未图示的麦克风等构成,通过语音输入必要的信息。进而,语音输出部37,具备未图示的语音合成装置以及扬声器,通过语音输出进行上述搜索路线的路线引导。
上述通信部38具备,用于接收从道路交通信息中心发送的现状的交通信息、一般信息等的各种信息的未图示的无线电信标接收机、用于经由FM广播台将上述各种信息作为FM多路广播接收的未图示的FM接收机等。此外,通信部38,除了交通信息、一般信息等信息之外,可以从未图示的信息中心,经由未图示的网络接收地图数据、统计数据、行驶履历数据等数据。
另外,导航处理部17、CPU31等,通过单独或者组合两个以上而作为计算机发挥功能,基于各种程序、数据等进行运算处理。此外,通过上述数据记录部16、RAM32、ROM33、闪速存储器等构成存储装置以及记录介质。并且,作为运算装置,也可以替代CPU31而使用MPU等。
另外,10是自动变速机,11是自动变速机控制装置,51是发送机控制装置,52是发动机。
接着,说明上述构成的导航装置14的基本动作。
首先,通过驾驶员操作操作部34,启动导航装置14后,CPU31的未图示的当前地读入处理装置进行当前地读入处理,读入由GPS传感器15检测出的本车位置以及本车方位。接着,上述CPU31的未图示的匹配处理装置进行匹配处理,基于读入的本车位置的轨迹、以及构成本车位置的周边道路的各道路路段的形状、排列等,判定车辆位于哪个道路路段上,由此确定本车位置。
接着,CPU31的未图示的基本信息取得处理装置进行基本信息取得处理,从数据记录部16读出并取得上述地图数据。另外,还可以从上述信息中心等取得地图数据,此时,上述基本信息取得处理装置将接收到的地图数据下载到闪速存储器中。
并且,上述CPU31的未图示的显示处理装置进行显示处理,在上述显示部35中形成各种画面。例如,显示处理装置的地图显示处理装置进行地图显示处理,在显示部35上形成地图画面,并在该地图画面上显示周围的地图,同时显示本车位置以及本车方位。
因此,驾驶员能够依照上述周围的地图、本车位置以及本车方位使车辆行驶。
此外,当驾驶员操作操作部34输入目的地后,CPU31的未图示的目的地设定处理装置进行目的地设定处理,设定目的地。另外,也可以根据需要输入出发地来进行设定。此外,可以预先登记规定的地点,将所登记的地点作为目的地进行设定。接着,驾驶员操作操作部34输入搜索条件后,CPU31的未图示的搜索条件设定处理装置进行搜索条件设定处理,设定搜索条件。
这样设定目的地以及搜索条件后,CPU31的未图示的路线搜索处理装置进行路线搜索处理,读入上述本车位置、本车方位、目的地、搜索条件等,并从数据记录部16读出搜索数据等,基于本车位置、本车方位、目的地、搜索数据等,以上述搜索条件搜索从由本车位置表示的出发地到目的地为止的路线,并输出表示搜索路线的路线数据。此时,在路线搜索处理中,将赋予每个道路路段的路段成本的合计最小的路线作为搜索路线。此外,也可以替代本车位置,将出发地设为驾驶员设定的规定的地点,搜索从该规定的地点到目的地为止的路线。
接着,上述CPU31的未图示的引导处理装置进行引导处理并进行路线引导。为此,上述引导处理装置的引导显示处理装置进行引导显示处理并读入上述路线数据,基于路线数据在上述地图画面上显示搜索路线。
另外,例如,在需要使车辆在作为路线引导的对象的地点即交叉点左右转弯时,上述交叉点,被设定为对车辆的行进方向进行引导的对象的引导交叉点,上述引导处理装置的语音输出处理装置进行语音输出处理,在车辆到达上述引导交叉点之前通过语音输出进行路线引导。
此外,上述引导处理装置的引导点放大图形成处理装置进行引导点放大图形成处理,在车辆到达引导交叉点之前,在地图画面的规定区域形成作为引导交叉点的放大图、即引导点放大图的交叉点放大图,进行利用交叉点放大图的路线引导。为此,当车辆到达搜索路线上的上述引导交叉点之前(本车位置侧)的、相距所设定的距离的位置时,显示上述交叉点放大图。此时,在该交叉点放大图上显示引导交叉点的周边地图、搜索路线、在引导交叉点上标有记号的设施等陆上标志。
在本实施方式中,将上述导航装置14中获得的信息发送到自动变速机控制装置11,与从本车位置起的前方的道路形状对应地变更自动变速机10的变速级,或向发动机控制装置51发送,并与从本车位置起的前方的道路形状对应地变更发动机52的输出,进行车辆的行驶控制。
为此,上述CPU31作为道路形状推定装置发挥功能,CPU31的未图示的道路形状推定处理装置进行道路形状推定处理,以后述的方法推定道路形状。并且,CPU31的未图示的行驶控制处理装置进行行驶控制处理,依照所推定的道路形状,向上述自动变速机控制装置11、发动机控制装置51等发送用于变更自动变速机10的变速级,或者变更发动机52的输出的信号。
接着,依照图2说明上述道路形状推定处理装置的动作。
首先,上述道路形状推定处理装置的数据取得处理装置进行数据取得处理,将包含成为推定道路形状的对象的道路的、从本车位置起的前方的规定区域作为道路形状推定范围进行设定,从数据记录部16读出道路数据,取得上述道路形状推定范围内的节点数据。
此时,在道路形状推定范围内,对以节点数据表示的各节点中的最初的节点到最后的节点中的、相互相邻的各节点之间的道路路段,按顺序进行道路形状的推定。另外,此时,将在数据库上的道路上进行道路形状的推定的各道路路段设为形状推定道路。
因此,上述数据取得处理装置,为了对各形状推定道路进行道路形状的推定,取得从本车位置起前方的形状推定道路上的形状插补点的插补点数据。另外,在本实施方式中,上述数据取得处理装置,将节点数据以及插补点数据从数据记录部16读出,由此取得,但是也可以从上述信息中心等经由网络接收节点数据以及插补点数据而取得。
接着,上述道路形状推定处理装置的半径计算处理装置进行半径计算处理,基于从本车位置起前方的形状推定道路上的形状插补点的插补点数据,通过3点计算法计算形状推定道路的各形状插补点的半径(曲率半径)。接着,上述道路形状推定处理装置的弯道检测处理装置进行弯道检测处理,基于上述半径,在数据库上的形状推定道路内检测弯道,将弯道开始的形状插补点作为开始候补点,在数据库上将弯道结束的形状插补点作为结束候补点来设定。
然后,上述道路形状推定处理装置的弯道结合处理装置,在由于在数据库上的形状插补点的设定方法,而将在实际道路上应该视作一个弯道的弯道作为多个弯道检测出时,进行弯道结合处理,进行检测出的弯道的结合。
接着,上述道路形状推定处理装置的第1、第2弯道分割处理装置,当将在实际道路上应作为多个弯道看待的弯道,由于在弯道间的直线区间中不设定形状插补点,或者形状插补点具有后述的弯道检测用的阈值以下的半径,在数据库上作为一个弯道检测出时,进行第1、第2弯道分割处理,进行检测出的弯道的分割。此时,在第1弯道分割处理中,当弯道内的规定的形状插补点具有后述的第1分割条件判定用的阈值以上的半径时进行检测出的弯道的分割,在第2弯道分割处理中,当弯道内的规定的形状插补点间的片段具有后述的第2分割条件判定用的阈值以上的长度时进行检测出的弯道的分割。
这样,当进行弯道的结合或者进行弯道的分割,基于形状插补点设定了适当的弯道后,上述道路形状推定处理装置的最小半径计算处理装置进行最小半径计算处理,对各弯道,计算用于推定回旋系数的适当的最小半径。
接着,上述道路形状推定处理装置的回旋系数推定处理装置进行回旋系数推定处理,基于上述最小半径推定回旋系数,道路形状推定处理装置的回旋曲线计算处理装置进行回旋曲线计算处理,基于回旋系数形成弯道的近似式,计算回旋曲线。
这样,当计算出表示上述弯道的道路形状的回旋曲线后,道路形状推定处理装置的拟合(fitting)处理装置,进行拟合处理,通过使回旋曲线与弯道上的各形状插补点一致,修正开始候补点以及结束候补点,在与实际道路上弯道开始的点、以及弯道结束的点近似的位置设定弯道的开始点以及结束点。
并且,道路形状推定处理装置的开始点、结束点记录处理装置进行开始点、结束点记录处理,将上述开始点、结束点作为表示道路形状的数据记录在数据记录部16中。由此,推定道路形状。
接着说明流程图。
步骤S1进行半径计算处理。
步骤S2进行弯道检测处理。
步骤S3进行弯道结合处理。
步骤S4进行第1弯道分割处理。
步骤S5进行第2弯道分割处理。
步骤S6进行最小半径计算处理。
步骤S7进行回旋系数推定处理。
步骤S8进行回旋曲线计算处理。
步骤S9进行拟合处理。
步骤S10进行开始点、结束点记录处理,结束处理。
接着说明图2的步骤S1中的半径计算处理的子程序。
图3表示本发明的实施方式中的半径计算处理的子程序,图4是说明本发明的实施方式中的计算半径的原理的图。
如图4所示,将成为半径计算处理的对象的形状插补点作为对象点ma,将该对象点ma的前一个(本车位置侧)的形状插补点设为前邻接点mb,将该对象点ma的后一个(离开本车位置的一侧)的形状插补点设为后邻接点mc,并且连接对象点ma和前邻接点mb,将从对象点ma起之前的片段(以下称为“前侧片段”)的片段长设为L1,连接对象点ma和后邻接点mc,将从对象点ma起之后的片段(以下称为“后侧片段”)的片段长设为L2。此外,将通过上述对象点ma、前邻接点mb以及后邻接点mc的圆设为Cr,将圆Cr的中心设为Q,将圆Cr的半径设为R。进而,对于对象点ma,将后侧片段相对前侧片段所成的角度设为方位角θ。
并且,将连接对象点ma与后邻接点mc的方向设为x轴方向,将与该x轴方向成直角的方向设为y轴方向,并将x轴方向上的对象点ma与前邻接点mb之间的距离设为X,将x轴方向上的对象点ma与中心Q之间的距离设为A,将x轴方向上的前邻接点mb与中心Q之间的距离设为G,并且,将y轴方向上的对象点ma与前邻接点mb之间的距离设为Y,将y轴方向上的前邻接点mb与中心Q之间的距离设为H,将y轴方向上的对象点ma与中心Q之间的距离设为F,则,
X=L1cosθ
A=L2/2
G=X+A
Y=L1sinθ
F=√(R2-A2)
H=F-Y
此时,由于距离G的平方与距离H的平方之和等于半径R的平方,所以式(1)的关系成立。
R2=G2+H2...(1)
接着,将上述各值带入该式(1)的距离G、H可以得到式(2)。
R2=X2+2XA+A2+R2-A2-2Y√(R2-A2)+Y2...(2)
接着,对该式(2)变形可以得到式(3)~(6)。
2Y√(R2-A2)=X2+Y2+2XA...(3)
R2-A2={(X2+Y2+2XA)/2Y}2...(4)
R2={(X2+Y2+2XA)/2Y}2+A2...(5)
R2=(L12+2L1·L2·cosθ+L22)/(2sinθ)2...(6)
从该式(6)可知半径R是片段长L1、L2以及方位角θ的函数。
因此,上述半径计算处理装置读入上述插补点数据,基于对象点ma、前邻接点mb以及后邻接点mc各坐标计算片段长L1、L2,同时计算方位角θ。
接着,上述半径计算处理装置基于片段长L1、L2以及方位角θ通过上述式(6)计算圆Cr的半径R。这样,可以在形状推定道路上计算对象点ma的半径R。
接着说明流程图。
步骤S1-1计算前侧片段的片段长L1。
步骤S1-2计算后侧片段的片段长L2。
步骤S1-3计算方位角θ。
步骤S1-4计算半径R,返回。
另外,在本实施方式中,通过上述半径计算处理装置基于计算来算出方位角θ以及半径R,但是可以预先将计算出的方位角θ以及半径R作为道路数据的一部分记录在数据记录部16的数据库中,通过从数据记录部16读出来算出。
接着,说明图2的步骤S2中的弯道检测处理。
图5是本发明的实施方式中的弯道检测处理的第1说明图,图6是本发明的实施方式中的弯道检测处理的第2说明图,图7是本发明的实施方式中的弯道检测处理的第3说明图,图8是本发明的实施方式中的弯道检测处理的第4说明图,图9是本发明的实施方式中的弯道检测处理的第5说明图,图10是本发明的实施方式中的弯道检测处理的第6说明图,图11是本发明的实施方式中的弯道检测处理的第7说明图,图12是本发明的实施方式中的弯道检测处理的第8说明图,图13是本发明的实施方式中的弯道检测处理的第9说明图。
在图中,ri(i=1,2,...)是在未图示的两个节点之间设定的形状推定道路,mi(i=1,2,...)是沿着形状推定道路ri,在车辆行进方向(箭头G方向)从跟前侧起按顺序设定的多个形状插补点,θi(i=1,2,...)是各形状插补点mi的方位角。另外,该方位角θi是后侧片段相对前侧片段所成的角度,在后侧片段相对前侧片段位于车辆行进方向的右侧时取正值,在后侧片段相对前侧片段位于车辆行进方向的左侧时取负值。
首先,上述弯道检测处理装置的开始候补点、结束候补点设定处理装置进行开始候补点、结束候补点设定处理,读入上述各形状插补点mi的半径Ri(i=1,2,...),判断半径Ri是否在预先设定的弯道检测用的阈值Rth(本实施方式中1000[m])以下,并抽取半径为阈值Rth以下的形状插补点。在图5中,形状插补点m3~m9,接近直线,被判断为是阈值Rth以下并被抽取。
接着,开始候补点、结束候补点设定处理装置,判断在所抽取的各形状插补点中是否存在多个连续的形状插补点(以下称为“连续形状插补点群”),在存在连续形状插补点群时,将连续形状插补点群中最前(本车位置侧)的形状插补点设为开始候补点。在图5以及图6中,由形状插补点m3~m9构成连续形状插补点群,形状插补点m3被作为开始候补点s1。
此外,开始候补点、结束候补点设定处理装置,对所抽取的形状插补点,将由上述半径计算处理装置计算出的方位角θ从跟前侧开始按顺序读入,判断在规定的形状插补点方位角的正负是否反转(相对前一个形状插补点方位角的方向反过来了),当在规定的形状插补点方位角的正负反转时,判断在后一个的形状插补点正负反转与否。并且,在规定的形状插补点方位角的正负反转,并且在后一个的形状插补点正负没反转时,将上述规定的形状插补点设为开始候补点。在具有图7所示那样形状的形状推定道路r2上,在设定了形状插补点m11~m16时,在各形状插补点m12~m15上,各方位角θ12以及θ13取负值,方位角θ14以及θ15取正值。即,在形状插补点m14,方位角θ14的正负从负反转为正,在后一个的形状插补点m15,方位角θ15的正负保持正的不变而未反转,因此形状插补点m14被设为开始候补点s1。
接着,开始候补点、结束候补点设定处理装置,判断在所抽取的各形状插补点中是否存在连续形状插补点群,在存在连续形状插补点群时,将连续形状插补点群中的最后(从本车位置离开的一侧)的形状插补点作为结束候补点。在图5以及图8中,由形状插补点m3~m9构成连续形状插补点群,形状插补点m9被设为结束候补点e1。
此外,开始候补点、结束候补点设定处理装置,判断在规定的形状插补点方位角的正负反转与否,当在规定的形状插补点方位角的正负未反转时,判断在后一个的形状插补点正负反转与否。并且,当在规定的形状插补点方位角的正负未反转,在后一个的形状插补点正负反转时,将上述规定的形状插补点设为结束候补点。在具有如图9所示那种的形状的形状推定道路r3中,设定有形状插补点m21~m26时,在各形状插补点m22~m25中,各方位角θ22以及θ23取正值,方位角θ24以及θ25取负值。即,在形状插补点m23,方位角θ23的正负保持正的不变没有从负的反转,而在后一个的形状插补点m24,方位角θ24的正负从正反转为负,因此形状插补点m23被设为结束候补点e1。
这样,设定了开始候补点以及结束候补点之后,上述弯道检测处理装置的弯道设定处理装置进行弯道设定处理,在开始候补点和结束候补点之间设定弯道。在具有如图10所示那样的形状的形状推定道路r4上,将形状插补点m1~m10中的形状插补点m2设为开始候补点s1,将形状插补点m9设为结束候补点e1,设定开始候补点s1与结束候补点e1之间的弯道cn1。
另外,当规定的形状插补点的半径是阈值Rth以下并且前一个的形状插补点的半径以及后一个的形状插补点的半径都大于阈值Rth时,上述开始候补点、结束候补点设定处理装置,将上述规定的形状插补点设为兼作开始候补点和结束候补点的单个点来设定,上述弯道设定处理装置在上述规定的形状插补点设定弯道。在具有图11所示那样的形状的形状推定道路r5上,形状插补点m31~m35中的形状插补点m33被设定为单个点f1,在形状插补点m33设定弯道cn1。
进而,在规定的形状插补点方位角的正负反转,在后一个的形状插补点的方位角的正负反转时,上述开始候补点、结束候补点设定处理装置,将上述规定的形状插补点设定为单个点。
在具有图12所示那样的形状的形状推定道路r6上,形状插补点m41~m48中的形状插补点m42~m44、m46以及m47的方位角θ42~θ44、θ46以及θ47取正值,形状插补点m45的方位角θ45取负值。此时,在形状插补点m45方位角θ45的正负从正反转为负,在后一个的形状插补点m46方位角θ46的正负从负反转为正,因此形状插补点m45被设定为单个点f1,在形状插补点m45设定弯道cn1。
接着,上述弯道设定处理装置,在单个点f1的前后以及单个点f1设定3个弯道cn1~cn3。另外,此时,弯道的编号从跟前侧依次被顺序编号,并与弯道的编号对应地标记开始候补点的编号以及结束候补点的编号。
这样,在形状推定道路中设定弯道后,上述弯道检测处理装置的记录处理装置进行记录处理,将形状推定道路内的弯道的编号、开始候补点的编号、结束候补点的编号等记录在RAM32(图1)中。
但是,如前述那样,在数据库上的插补点数据的精度低,在弯道的直线区间中从直线偏离地设定规定的形状插补点时,存在在实际的道路上应看作多个弯道的弯道,通过上述弯道判定处理装置在数据库上作为一个弯道被检测出来,而被设定为一个弯道的开始候补点以及结束候补点的情况。例如,在具有接近图13所示的梯形形状的形状推定道路r7上,在直线区间即形状插补点m5、m7之间,本来应该设定在连接形状插补点m5、m7之间的直线上,但是却从连接形状插补点m5、m7之间的直线偏离地设定形状插补点m6。
此时,由于在上述半径计算处理中计算出来的形状插补点m2~m10的半径R2~R10在阈值Rth以下,并且在形状插补点m2~m10方位角的正负未反转,所以在弯道检测处理中,对于形状插补点m2~m10检测出一个弯道cn1。
在此,在本实施方式中,在实际道路上应看作多个弯道的弯道,在数据库上作为一个弯道被检测出来时,通过第1弯道分割处理装置进行弯道的分割。
接着,说明图2的步骤S4中的第1弯道分割处理的子程序。
图14是表示本发明的实施方式中的第1弯道分割处理的子程序的图。图15是本发明的实施方式中的第1弯道分割处理的第1说明图。图16是本发明的实施方式中的第1弯道分割处理的第2说明图。图17是本发明的实施方式中的第1弯道分割处理的第3说明图。图18是本发明的实施方式中的第1弯道分割处理的第4说明图。
首先,上述第1弯道分割处理装置的弯道信息取得处理装置(半径基准弯道信息取得处理装置)进行弯道信息取得处理,通过从RAM32读入形状推定道路内的规定的弯道的弯道信息而取得。此时,将在形状推定道路上存在的各弯道作为规定的弯道按顺序选择。
另外,上述弯道信息中除了上述插补点数据之外,还包括在RAM32中记录的各弯道的开始候补点以及结束候补点的编号。在本实施方式中,由于对图13的形状推定道路r7进行第1弯道分割处理,所以上述弯道信息取得处理装置取得弯道cn1的编号、弯道cn1的开始候补点s1的编号、弯道cn1的结束候补点e1的编号、形状插补点m2~m10的各编号、各形状插补点m2~m10的半径R2~R10等。
接着,上述第1弯道分割处理装置的分割条件判定处理装置(半径基准分割条件判定处理装置)进行分割条件判定处理,读入形状插补点的编号,计算弯道内的形状插补点的个数,并根据形状插补点的个数是否在阈值以上,在本实施方式中是否是3以上,判断用于进行第1弯道分割处理的第1分割条件成立与否。在图13的形状推定道路r7中,弯道cn1内的形状插补点m2~m10的个数是9,因此第1分割条件成立。
例如,在图15的形状推定道路r8中,形状插补点m51~m55中的形状插补点m53具有阈值以下的半径,检测出了弯道,但是该弯道内的形状插补点m53的个数是1,并且在弯道内不含3个以上的形状插补点,因此第1分割条件不成立。此外,在图16的形状推定道路r9中,形状插补点m61~m66中的形状插补点m63、m64具有阈值以下的半径,检测出了弯道,但是该弯道内的形状插补点m63、m64的个数是2,并且在弯道内不含3个以上的形状插补点,因此第1分割条件不成立。
接着,上述分割条件判定处理装置,对弯道内的规定的形状插补点的半径与弯道内的其他形状插补点的各半径相比较是否相对较大进行判断。为此,上述分割条件判定处理装置,读取弯道内的各形状插补点的半径,根据弯道内的规定的形状插补点是否具有基于弯道内的各形状插补点的各半径计算出来的第1分割条件判定用的阈值即第1分割阈值Rthcn以上的半径,判断第2分割条件成立与否。
为此,上述分割条件判定处理装置的平均半径计算处理装置进行平均半径计算处理,计算各形状插补点m2~m10的半径R2~R10的平均值Ra,接着,上述分割条件判定处理装置的阈值计算处理装置进行阈值计算处理,在将基于上述平均值Ra计算出来的标准偏差设为σ1时,将上述第1分割阈值Rthcn以如下方式设定:
Rthcn=Ra+3·σ1。
在图17的形状推定道路r7上,在形状插补点m6具有第1分割阈值Rthcn以上的半径R6时,第2分割条件成立。另外,上述标准偏差σ1是与平均值Ra对应地设定的加法计算值。
接着,在第1、第2分割条件成立时,上述分割条件判定处理装置的分割执行处理装置(半径基准分割执行处理装置)进行分割执行处理,以具有第1分割阈值Rthcn以上的形状插补点进行弯道的分割。具体来说,上述分割执行处理装置,将具有第1分割阈值Rthcn以上的半径的形状插补点的前一个的形状插补点作为结束候补点进行追加,将具有第1分割阈值Rthcn以上的半径的形状插补点的后一个的形状插补点作为开始候补点进行追加。在图17的形状推定道路r7上,以具有第1分割阈值Rthcn以上的半径的形状插补点m6进行弯道的分割,形状插补点m2被设为开始候补点s1,形状插补点m6前一个的形状插补点m5被设为结束候补点e1。并且,形状插补点m6后一个的形状插补点m7被设为开始候补点s2,形状插补点m10被设为结束候补点e2。
这样,在本实施方式中,如图18所示,通过形状插补点m2~m5设定弯道cn1,通过形状插补点m7~m10设定弯道cn2。
此外,上述各第1、第2分割条件中的任一分割条件不成立时,上述弯道分割执行处理装置不进行上述当前的弯道的分割。
这样,在本实施方式中,即使假设在数据库上插补点数据的精度低,且在弯道的直线区间中偏离直线地设定了规定的形状插补点,在第1、第2分割条件成立时,也进行弯道的分割。因此,由于在实际道路上应看作多个弯道的弯道在数据库上不会被设为一个弯道,所以可以正确地推定道路形状。
此外,上述第1分割阈值Rthcn是在平均值Ra上加上标准偏差σ1计算出来的,所以平均值Ra越大则设定得越大,平均值Ra越小则设定得越小,因此即使给各半径R2~R10的值等增加干扰也能正确地判断第2分割条件成立与否。
并且,标准偏差σ1表示弯道的各形状插补点m2~m10的半径R2~R10的偏差度,所以可以相应于半径R2~R10的偏差度变更弯道的分割的容易执行程度。即,在半径R2~R10的偏差度高时,第1分割阈值Rthcn变大,因此第2分割条件不易成立,弯道的分割不易进行。与此相对,在半径R2~R10的偏差度低时,第1分割阈值Rthcn变小,因此第2分割条件易于成立,弯道的分割也容易执行。
因此,可以适当地进行弯道的分割。
另外,在本实施方式中,虽然通过在平均值Ra上加上标准偏差σ1来计算上述第1分割阈值Rthcn,但是可以预先将与平均值Ra对应地预先设定的第1分割阈值Rthcn例如记录在数据记录部16中。
此时,将作为使平均值Ra与第1分割阈值Rthcn对应的第1阈值映射(MAP)图的半径阈值MAP图记录在ROM33中,上述分割执行处理装置,在分割执行处理中,参照半径阈值MAP图,读出与平均值Ra对应的第1分割阈值Rthcn,比较各半径R2~R10与第1分割阈值Rthcn,以具有第1分割阈值Rthcn以上的半径的形状插补点分割弯道。
接着,说明流程图。
步骤S4-1开始基于弯道数的循环。
步骤S4-2取得当前的弯道的弯道信息。
步骤S4-3判断弯道内的形状插补点的个数是否是3个以上。在弯道内的形状插补点的个数是3个以上时进入步骤S4-4,在弯道内的形状插补点的个数小于3个时进入步骤S4-7。
步骤S4-4计算弯道内的形状插补点的半径的平均值。
步骤S4-5根据平均值Ra计算第1分割阈值Rthcn。
步骤S4-6以具有第1分割阈值Rthcn以上的半径的形状插补点进行弯道的分割。
步骤S4-7使基于弯道数的循环结束,结束处理。
但是,如上所述,当数据库上的插补点数据的精度低,在弯道的直线区间中没设定形状插补点时,存在在实际道路上应看作多个弯道的弯道,通过上述弯道检测处理在数据库上作为一个弯道检测出来而决定了一个弯道的开始候补点以及结束候补点的情况。
图19是本发明的实施方式中的弯道检测处理的第10说明图。
此时,在具有图示那种梯形形状的形状推定道路r10中,在直线区间的形状插补点m5、m6之间没设定应该设定的形状插补点。
此时,在上述半径计算处理中计算出来的形状插补点m2~m9的半径R2~R9在阈值Rth以下,在形状插补点m2~m9方位角的正负不反转,因此在弯道检测处理中,在形状插补点m2~m9检测出一个弯道cn1。
因此,在本实施方式中,通过第2弯道分割处理装置进行弯道的分割。
接着,说明图2的步骤S5的第2弯道分割处理的子程序。
图20是表示本发明的实施方式中的第2弯道分割处理的子程序的图,图21是本发明的实施方式中的第2弯道分割处理的第1说明图,图22是本发明的实施方式中的第2弯道分割处理的第2说明图,图23是本发明的实施方式中的第2弯道分割处理的第3说明图。
首先,上述第2弯道分割处理装置的弯道信息取得处理装置(片段长基准弯道信息取得处理装置)进行弯道信息取得处理,通过从RAM32读入形状推定道路内的规定的弯道的弯道信息而取得。此时,将在形状推定道路上存在的各弯道作为规定的弯道按顺序选择。
另外,上述弯道信息,除了上述插补点数据之外,还包含在RAM32中记录的各弯道的开始候补点以及结束候补点的编号。在本实施方式中,在形状推定道路r10上进行第2弯道分割处理,因此上述弯道信息取得处理装置,取得弯道cn1的编号、该弯道cn1的开始候补点s1的编号、弯道cn1的结束候补点e1的编号、形状插补点m2~m9的各编号、各形状插补点m2~m9之间的各片段的片段长等。
接着,上述第2弯道分割处理装置的分割条件判定处理装置(片段长基准分割条件判定处理装置),进行分割条件判定处理,读入形状插补点的编号,计算弯道内的形状插补点的个数,根据形状插补点的个数是否在阈值以上,在本实施方式中是否是3以上,判断用于进行第2弯道分割处理的第1分割条件成立与否。在图21的形状推定道路r10上,弯道cn1内的形状插补点m2~m9的个数是8,所以第1分割条件成立。
例如,如上所述,在图15的形状推定道路r8以及图16的形状推定道路r9上,在弯道内不含有3个以上的形状插补点,所以第1分割条件不成立。
接着,上述分割条件判定处理装置判断,弯道内的规定的形状插补点间的片段长,与弯道内的其他形状插补点间的各片段长相比是否相对较长。为此,上述分割条件判定处理装置,读出弯道内的各形状插补点间的片段长,根据弯道内的规定的形状插补点间的片段是否具有基于弯道内的各形状插补点间的片段长计算出来的第2分割条件判定用的阈值、即第2分割阈值Lthcn以上的片段长,判断第2分割条件成立与否。
为此,上述分割条件判定处理装置的平均片段长计算处理装置进行平均片段长计算处理,计算各形状插补点m2~m9间的片段长的平均值La,接着,上述分割条件判定处理装置的阈值计算处理装置进行阈值计算处理,当将基于上述平均值La计算出来的标准偏差设为σ2时,将上述第2分割阈值Lthcn以如下方式设定。
Lthcn=La+3·σ2。
在图21中,在形状插补点m5、m6间的片段Lc11具有第2分割阈值Lthcn以上的片段长时,第2分割条件成立。另外,上述标准偏差σ2是与平均值La对应地设定的加法计算值。
接着,在第1、第2分割条件成立时,上述分割条件判定处理装置的分割执行处理装置(片段长基准分割执行处理装置)进行分割执行处理,以具有第2分割阈值Lthcn以上的片段长的片段进行弯道的分割。此外,分割执行处理装置,将构成具有第2分割阈值Lthcn以上的片段长的片段的形状插补点中的跟前的形状插补点作为结束候补点,将构成具有第2分割阈值Lthcn以上的片段长的片段的形状插补点中的后面的形状插补点作为开始候补点。在图22中,以具有第2分割阈值Lthcn以上的片段长Lc11的形状插补点m5、m6间的片段进行弯道cn1的分割,形状插补点m2被设为开始候补点s1,形状插补点m5、m6间的片段的跟前的形状插补点m5被设为结束候补点e1,形状插补点m5、m6间的片段的后面的形状插补点m6被设为开始候补点s2,形状插补点m9被设为结束候补点e2。
这样,在本实施方式中,如图23所示,通过形状插补点m2~m5设定弯道cn1,通过形状插补点m6~m9设定弯道cn2。
此外,上述各第1、第2分割条件中的任一分割条件不成立时,上述弯道分割执行处理装置不进行上述当前的弯道的分割。
这样,在本实施方式中,即使在数据库上插补点数据的精度低,且在弯道的直线区间中没设定形状插补点的情况下,当第1、第2分割条件成立时,也进行弯道的分割。因此,由于在实际道路上应看作多个弯道的弯道在数据库上不会被设为一个弯道,所以可以正确地推定道路形状。
此外,上述第2分割阈值Lthcn是在平均值La上加上标准偏差σ2计算出来的,所以平均值La越大则设定得越大,平均值La越小则设定得越小,因此即使给各片段长的值等增加干扰也能正确地判断第2分割条件成立与否。
并且,标准偏差σ2表示弯道的各形状插补点m2~m9间各片段长的偏差度,所以可以相应于片段长的偏差度变更弯道的分割的容易执行程度。即,在片段长的偏差度高时,第2分割阈值Lthcn变大,因此第2分割条件不易成立,弯道的分割不易进行。与此相对,在片段长的偏差度低时,第2分割阈值Lthcn变小,因此第2分割条件易于成立,弯道的分割也容易执行。
因此,可以适当地进行弯道的分割。
另外,在本实施方式中,虽然通过在平均值La上加上标准偏差σ2来计算上述第2分割阈值Lthcn,但是可以预先将与平均值La对应地预先设定的第2分割阈值Lthcn例如记录在数据记录部16中。
此时,将作为使平均值La与第2分割阈值Lthcn对应的第2阈值MAP图的片段长阈值MAP图记录在ROM33中,上述分割执行处理装置,在分割执行处理中,参照半径阈值MAP图,读出与平均值La对应的第2分割阈值Lthcn,比较各形状插补点m2~m9间的各片段长与第2分割阈值Lthcn,以具有第2分割阈值Lthcn以上的片段长的片段分割弯道。
接着,说明流程图。
步骤S5-1开始基于弯道数的循环。
步骤S5-2取得当前的弯道的弯道信息。
步骤S5-3判断弯道内的形状插补点的个数是否是3个以上。在弯道内的形状插补点的个数是3个以上时进入步骤S5-4,在弯道内的形状插补点的个数小于3个时进入步骤S5-7。
步骤S5-4计算弯道内的片段长的平均值La。
步骤S5-5根据平均值La计算第2分割阈值Lthcn。
步骤S5-6以具有第2分割阈值Lthcn以上的片段长的片段进行弯道的分割。
步骤S5-7使基于弯道数的循环结束,结束处理。
接着,说明图2的步骤S7的回旋系数推定处理。
图24是表示本发明的实施方式中的回旋系数MAP的图。
此时,将最小半径Rmin与回旋曲线的回旋系数A的平方的值A2,相互对应地在ROM33(图1)中作为回旋系数MAP图记录,上述回旋系数推定处理装置,读入在上述步骤S6计算出的最小半径Rmin,参照回旋系数MAP图读出与最小半径Rmin对应的值A2。接着,上述回旋系数推定处理装置计算、推定回旋系数A。另外,上述回旋系数MAP图是基于实际道路上的半径与在设计上述道路时使用的回旋曲线的回旋系数的关系而做成的。
接着,说明图2的步骤S8中的回旋曲线计算处理的子程序。
图25是表示本发明的实施方式中的回旋曲线计算处理的子程序的图。
但是,回旋曲线是从起点开始的长度越大曲率半径越小的曲线,一般,在设计道路时,回旋曲线的一部分与弯道的开始点以及结束点重合。如果将上述回旋曲线以x-y坐标表示,将从回旋曲线的开始点(原点)到规定的点S为止的距离、即曲线长设为L,将上述点S的曲线半径设为Rc,则
L·Rc=A2...(7)
此外,通常,回旋曲线的X坐标以及Y坐标分别可以通过式(8)以及(9)所示的多项式计算出来。
X=L×(1-L2/(40Rc2)+L4/(3456Rc4)
-L6/(599040Rc6)+L8/(175472640Rc8)...)...(8)
X=L2/(6Rc)×(1-L2/(56Rc2)+L4/(7040Rc4)-L6/(1612800Rc6)
+L8/(588349440Rc8)...)...(9)
此时,考虑用上述式(8)以及(9)计算回旋曲线,但是式(8)以及(9)是高次多项式,当设多个点来计算回旋曲线时,由于回旋曲线计算处理,给CPU31带来的负荷会变大。
因此,在本实施方式中,通过上述回旋曲线计算处理装置,基于在回旋系数推定处理中计算出的回旋系数A计算回旋曲线。因此,上述回旋曲线计算处理装置,利用基于仿真获得的式(10)以及(11)近似计算回旋曲线(曲线成L(k)的点S)的X坐标以及Y坐标。
[计算式1]
X = X 0 + Σ r cos φ · · · · · · ( 10 )
Y = Y 0 + Σ L sin φ · · · · · · ( 11 )
其中,Xo以及Yo是回旋曲线的开始点的X坐标以及Y坐标。此外,角度φ由式(12)表示。
φ=α+2k·L...(12)
并且,α是回旋曲线的开始点的方位,值k由式(13)表示。
k=28/A2...(13)
接着,说明流程图。
步骤S8-1以回旋曲线的曲线长L(k)开始循环。
步骤S8-2计算曲线长L(k)的点S的X坐标。
步骤S8-3计算曲线长L(k)的点S的Y坐标。
步骤S8-4以回旋曲线的曲线长L(k)使循环结束,返回。
接着,说明图2的步骤S9中的拟合处理。
图26是本发明的实施方式中的拟合处理的说明图。
在图中,r7是形状推定道路,cn1是通过上述弯道结合处理以及第1、第2弯道分割处理设定的弯道,m1~m5是构成弯道cn1的形状插补点、s1是弯道cn1的开始候补点。
此时,上述拟合处理装置的回旋曲线移动处理装置进行回旋曲线移动处理,在连接上述形状插补点m1、m2之间的片段Sg1的延长线上设置回旋曲线Q的起点Qs,使回旋曲线Q在箭头E方向上移动,以使该起点Qs上的切线与片段Sg1的延长线一致。
此时,上述拟合处理装置的误差计算处理装置进行误差计算处理,计算回旋曲线Q的位置相对于形状插补点m2以后的各形状插补点m2~m5的误差的合计。此时,基于各形状插补点m2~m5与描画回旋曲线Q时设定的各点在上述X轴上的距离以及Y轴上的距离计算回旋曲线Q的位置相对于各形状插补点m2~m5的误差。
并且,上述回旋曲线移动处理装置以将误差的合计变得最小的方式使上述回旋曲线Q与各形状插补点m2~m5一致,设定回旋曲线Q的位置。
接着,上述拟合处理装置的开始点、结束点抽取处理装置进行开始点、结束点抽取处理,设定了回旋曲线Q的位置后,将回旋曲线Q的起点Qs作为实际的弯道的开始点Sa1进行设定。
并且,回旋曲线移动处理装置、误差计算处理装置以及开始点、结束点抽取处理装置,在弯道cn1的终点侧进行同样的处理,设定回旋曲线Q的位置,将回旋曲线Q的起点作为实际的弯道的结束点来设定。
这样,利用回旋曲线Q来修正开始候补点以及结束候补点,可以将修正过的开始候补点以及结束候补点分别作为实际的弯道的开始点以及结束点来设定,因此可以使弯道cn1的开始候补点以及结束候补点接近实际道路上的弯道的开始点以及结束点。
接着,说明图2的步骤S10中的开始点、结束点记录处理。
上述开始点、结束点记录处理装置,将抽取出的开始候补点以及结束候补点的位置作为表示道路形状的数据记录在数据记录部16中。
这样,在本实施方式中,可以正确地推定道路形状,基于正确推定的道路形状设定实际的弯道的开始点和结束点,因此能够与道路形状对应地变更自动变速机10的变速级,或与道路形状对应地变更发动机52的输出,高精度地进行车辆的行驶控制。
在本实施方式中,通过使导航装置14的CPU31动作来进行道路形状的推定,但是可以通过使自动变速机控制装置11的未图示的CPU动作或者使作为上述信息中心的控制装置的CPU动作来进行道路形状的推定。另外,为了进行车辆整体的控制,作为自动变速机控制装置11以及发动机控制装置51的上位的控制装置而配置有车辆控制装置,但是也可以通过使该车辆控制装置的CPU动作进行道路形状的推定。
此外,在本实施方式中,对相邻的各节点之间的形状推定道路进行道路形状的推定,但是当在实际的道路上,在弯道内存在节点时,若按各节点之间的形状推定道路来推定道路形状,则会在弯道内的节点的前后进行不同的处理。因此,在其他的实施方式中,对道路数据,在各道路路段之间赋予道路所成数据,在预测为在通过节点后要进入的道路路段明显时、或者通过路线搜索处理设定了搜索路线时等,能够针对两个以上连续的形状推定道路进行道路形状的推定。
另外,本发明不限定于上述实施方式,可以基于本发明的主旨进行各种变形,不可以将他们从本发明的范围中除去。

Claims (4)

1.一种道路形状推定装置,其特征在于,具有:
数据取得处理装置,其取得沿道路设定的表示道路的形状的多个形状插补点的插补点数据;
半径计算处理装置,其基于上述道路的规定区间内的上述插补点数据,计算各形状插补点的曲率半径;
弯道检测处理装置,其基于上述各形状插补点的曲率半径检测上述区间内的弯道;
弯道分割处理装置,其与上述检测出的弯道内的各形状插补点的曲率半径的平均值对应地设定阈值,在上述所检测出的弯道内,以具有上述阈值以上的曲率半径的形状插补点进行弯道的分割。
2.根据权利要求1所述的道路形状推定装置,其特征在于,
与上述弯道内的各形状插补点的曲率半径的偏差度对应地设定上述阈值。
3.一种道路形状推定方法,其特征在于,
取得沿道路设定的表示道路的形状的多个形状插补点的插补点数据,基于上述道路的规定区间内的上述插补点数据,计算各形状插补点的曲率半径,基于上述各形状插补点的曲率半径检测上述区间内的弯道,与上述检测出的弯道内的各形状插补点的曲率半径的平均值对应地设定阈值,在上述所检测出的弯道内,以具有上述阈值以上的曲率半径的形状插补点进行弯道的分割。
4.一种程序,其特征在于,其使计算机作为如下装置发挥功能:
数据取得处理装置,其取得沿道路设定的表示道路的形状的多个形状插补点的插补点数据;
半径计算处理装置,其基于上述道路的规定区间内的上述插补点数据,计算各形状插补点的曲率半径;
弯道检测处理装置,其基于上述各形状插补点的曲率半径检测上述区间内的弯道;
弯道分割处理装置,其与上述检测出的弯道内的各形状插补点的曲率半径的平均值对应地设定阈值,在上述所检测出的弯道内,以具有上述阈值以上的曲率半径的形状插补点进行弯道的分割。
CN2009101181893A 2008-03-28 2009-03-11 道路形状推定装置、道路形状推定方法 Expired - Fee Related CN101545784B (zh)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2008087892 2008-03-28
JP2008087892A JP4479816B2 (ja) 2008-03-28 2008-03-28 道路形状推定装置、道路形状推定方法及びプログラム
JP2008-087892 2008-03-28

Publications (2)

Publication Number Publication Date
CN101545784A true CN101545784A (zh) 2009-09-30
CN101545784B CN101545784B (zh) 2013-01-23

Family

ID=41118404

Family Applications (1)

Application Number Title Priority Date Filing Date
CN2009101181893A Expired - Fee Related CN101545784B (zh) 2008-03-28 2009-03-11 道路形状推定装置、道路形状推定方法

Country Status (3)

Country Link
US (1) US8583355B2 (zh)
JP (1) JP4479816B2 (zh)
CN (1) CN101545784B (zh)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103154669A (zh) * 2010-08-13 2013-06-12 法国大陆汽车公司 用于在驾驶和预测道路轮廓方面进行辅助的方法和设备
CN103459227A (zh) * 2011-04-08 2013-12-18 丰田自动车株式会社 道路形状推定系统
CN102713987B (zh) * 2010-01-29 2014-10-01 丰田自动车株式会社 道路信息检测装置以及车辆行驶控制装置
CN106494406A (zh) * 2015-09-08 2017-03-15 星克跃尔株式会社 弯道导向方法、弯道导向装置、电子装置及程序
CN111824163A (zh) * 2019-04-16 2020-10-27 标致雪铁龙汽车股份有限公司 用于确定道路的曲线的方法和设备
CN111862604A (zh) * 2020-07-20 2020-10-30 北京京东乾石科技有限公司 无人车的控制方法及装置、计算机存储介质、电子设备
CN112686904A (zh) * 2020-12-14 2021-04-20 深兰人工智能(深圳)有限公司 车道划分方法、装置、电子设备和存储介质

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2347940A1 (en) * 2010-01-25 2011-07-27 Autoliv Development AB An object collision warning system and method for a motor vehicle
JP6054638B2 (ja) * 2012-05-30 2016-12-27 クラリオン株式会社 車両位置検出装置およびプログラム
JP6278381B2 (ja) * 2013-08-26 2018-02-14 アルパイン株式会社 コーナー情報提供装置及びコーナー情報提供方法
RU2608885C2 (ru) * 2014-06-30 2017-01-25 Общество С Ограниченной Ответственностью "Яндекс" Способ определения точки кривой, ближайшей к позиции на карте
US9746331B1 (en) * 2014-12-15 2017-08-29 Marvell International Ltd. Method and apparatus for map matching
FR3071064A1 (fr) * 2017-09-14 2019-03-15 Compagnie Generale Des Etablissements Michelin Methode d'evaluation de la fermete d'un sol
US11781875B2 (en) * 2019-08-21 2023-10-10 Toyota Motor Engineering & Manufacturing North America, Inc. Apparatus and method for forming and analyzing connected roads
CN110617817B (zh) * 2019-09-29 2022-04-08 阿波罗智联(北京)科技有限公司 一种导航路线确定方法、装置、设备及存储介质
CN111496798B (zh) * 2020-05-18 2022-06-14 北京配天技术有限公司 机器人传送带跟踪方法、设备及存储装置

Family Cites Families (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE19604364A1 (de) 1996-02-07 1997-08-14 Fraunhofer Ges Forschung Verfahren zur Ermittlung einer Straßenkrümmung aus digital abgelegten Karteninformationen
JP3366220B2 (ja) * 1997-05-26 2003-01-14 本田技研工業株式会社 道路形状判定装置及び車両制御装置
JP3508619B2 (ja) * 1999-05-13 2004-03-22 株式会社デンソー 車両用ナビゲーション装置
JP3092803B1 (ja) * 1999-09-21 2000-09-25 富士重工業株式会社 カーブ進入速度制御装置
JP3167993B2 (ja) 1999-09-21 2001-05-21 富士重工業株式会社 道路形状推定装置及びそれを用いたカーブ進入制御装置
JP2001101597A (ja) 1999-09-30 2001-04-13 Toyota Motor Corp 道路形状認識方法、装置および記録媒体
US7391653B2 (en) * 2002-10-15 2008-06-24 Halo Lsi, Inc. Twin insulator charge storage device operation and its fabrication method
JP4576844B2 (ja) 2004-01-30 2010-11-10 アイシン・エィ・ダブリュ株式会社 道路形状推測装置
DE102004006687A1 (de) 2004-02-11 2005-09-01 Daimlerchrysler Ag Verfahren zur Beschreibung eines Weges in einer digitalisierten Karte
JP4506261B2 (ja) 2004-04-28 2010-07-21 日産自動車株式会社 カーブ曲率推定装置及びカーブ曲率推定方法
US20050246091A1 (en) * 2004-04-28 2005-11-03 Nissan Motor Co., Ltd. Curvature radius estimating apparatus and method
JP4363640B2 (ja) * 2004-04-30 2009-11-11 株式会社小糸製作所 車両用照明装置
EP1593936B1 (en) 2004-04-30 2013-02-27 Koito Manufacturing Co., Ltd Lighting system for vehicle
EP1821259A3 (de) * 2006-02-10 2007-12-26 Siemens Aktiengesellschaft Verfahren zur Ermittlung mautbehafteter Wegstreckenlängen
JP4446978B2 (ja) * 2006-04-28 2010-04-07 トヨタ自動車株式会社 車両用駆動力制御装置

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102713987B (zh) * 2010-01-29 2014-10-01 丰田自动车株式会社 道路信息检测装置以及车辆行驶控制装置
CN103154669A (zh) * 2010-08-13 2013-06-12 法国大陆汽车公司 用于在驾驶和预测道路轮廓方面进行辅助的方法和设备
CN103459227A (zh) * 2011-04-08 2013-12-18 丰田自动车株式会社 道路形状推定系统
CN106494406A (zh) * 2015-09-08 2017-03-15 星克跃尔株式会社 弯道导向方法、弯道导向装置、电子装置及程序
CN106494406B (zh) * 2015-09-08 2019-05-10 星克跃尔株式会社 弯道导向方法、弯道导向装置、弯道导向电子装置及计算机可读记录介质
CN111824163A (zh) * 2019-04-16 2020-10-27 标致雪铁龙汽车股份有限公司 用于确定道路的曲线的方法和设备
CN111862604A (zh) * 2020-07-20 2020-10-30 北京京东乾石科技有限公司 无人车的控制方法及装置、计算机存储介质、电子设备
CN111862604B (zh) * 2020-07-20 2022-03-04 北京京东乾石科技有限公司 无人车的控制方法及装置、计算机存储介质、电子设备
CN112686904A (zh) * 2020-12-14 2021-04-20 深兰人工智能(深圳)有限公司 车道划分方法、装置、电子设备和存储介质

Also Published As

Publication number Publication date
US20090248290A1 (en) 2009-10-01
US8583355B2 (en) 2013-11-12
JP2009243932A (ja) 2009-10-22
JP4479816B2 (ja) 2010-06-09
CN101545784B (zh) 2013-01-23

Similar Documents

Publication Publication Date Title
CN101545784B (zh) 道路形状推定装置、道路形状推定方法
CN101545783B (zh) 道路形状推定装置、道路形状推定方法
JP3928537B2 (ja) カーナビゲーション装置
JP4576844B2 (ja) 道路形状推測装置
US7353111B2 (en) Navigation system performing route guidance for vehicle
KR100493092B1 (ko) 네비게이션장치 및 네비게이션장치의 최적경로 계산방법
CN1331102C (zh) 导航装置及其方法
CN101545785A (zh) 道路形状推定装置、道路形状推定方法以及程序
JP4010380B2 (ja) 車両制御装置及びプログラムを記録した記録媒体
JP2005172578A (ja) ナビゲーション装置
JP2006349580A (ja) 走行状況判定装置及び車載ナビゲーション装置
CN101545786A (zh) 道路形状推定装置、道路形状推定方法以及程序
CN108351220A (zh) 用于数字地图服务的车道信息的聚合方法
CN101118161B (zh) 分支导向装置及向导地图生成装置
JP5203747B2 (ja) ナビゲーション装置
EP2105708B1 (en) Road shape estimating device, road shape estimating method and program
JP3926472B2 (ja) 車両制御装置及びそのプログラムを記録した記録媒体
JP4487331B2 (ja) 車両制御装置
JPH02137097A (ja) 高架高速道路走行認識装置
JP4400173B2 (ja) 車両用ナビゲーション装置
CN112765191B (zh) Adas数据增量发送方法、系统、电子设备及存储介质
JP3706245B2 (ja) 車両制御装置及びそのプログラムを記録した記録媒体
JP3550732B2 (ja) 車両走行位置推定装置
JP3494125B2 (ja) 曲路検出装置
JP2005038238A (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
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20130123

Termination date: 20210311

CF01 Termination of patent right due to non-payment of annual fee