CN113508064B - 车辆的行驶控制方法及行驶控制装置 - Google Patents
车辆的行驶控制方法及行驶控制装置 Download PDFInfo
- Publication number
- CN113508064B CN113508064B CN201980089561.4A CN201980089561A CN113508064B CN 113508064 B CN113508064 B CN 113508064B CN 201980089561 A CN201980089561 A CN 201980089561A CN 113508064 B CN113508064 B CN 113508064B
- Authority
- CN
- China
- Prior art keywords
- boundary
- information
- travel
- road
- travel path
- 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
- 238000000034 method Methods 0.000 title claims abstract description 64
- 230000002093 peripheral effect Effects 0.000 claims description 4
- 238000004364 calculation method Methods 0.000 description 64
- 238000010586 diagram Methods 0.000 description 27
- 239000000243 solution Substances 0.000 description 20
- 238000012545 processing Methods 0.000 description 13
- 230000010354 integration Effects 0.000 description 12
- 238000012937 correction Methods 0.000 description 10
- 230000005684 electric field Effects 0.000 description 7
- 230000001133 acceleration Effects 0.000 description 5
- 238000012706 support-vector machine Methods 0.000 description 3
- 238000004422 calculation algorithm Methods 0.000 description 2
- 238000009792 diffusion process Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000012887 quadratic function Methods 0.000 description 2
- 230000001105 regulatory effect Effects 0.000 description 2
- 239000007787 solid Substances 0.000 description 2
- 238000002940 Newton-Raphson method Methods 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 238000005094 computer simulation Methods 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 238000005421 electrostatic potential Methods 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 239000000446 fuel Substances 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 238000002347 injection Methods 0.000 description 1
- 239000007924 injection Substances 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 239000000523 sample Substances 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Estimation 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/02—Estimation 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/04—Traffic conditions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/10—Path keeping
- B60W30/12—Lane keeping
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60R—VEHICLES, VEHICLE FITTINGS, OR VEHICLE PARTS, NOT OTHERWISE PROVIDED FOR
- B60R21/00—Arrangements or fittings on vehicles for protecting or preventing injuries to occupants or pedestrians in case of accidents or other traffic risks
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W10/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/18—Conjoint control of vehicle sub-units of different type or different function including control of braking systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W10/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/20—Conjoint control of vehicle sub-units of different type or different function including control of steering systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/095—Predicting travel path or likelihood of collision
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/10—Path keeping
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/14—Adaptive cruise control
- B60W30/16—Control of distance between vehicles, e.g. keeping a distance to preceding vehicle
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Estimation 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/02—Estimation 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Estimation 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/02—Estimation 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/06—Road conditions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2552/00—Input parameters relating to infrastructure
- B60W2552/05—Type of road, e.g. motorways, local streets, paved or unpaved roads
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2552/00—Input parameters relating to infrastructure
- B60W2552/53—Road markings, e.g. lane marker or crosswalk
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/20—Static objects
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/40—Dynamic objects, e.g. animals, windblown objects
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2555/00—Input parameters relating to exterior conditions, not covered by groups B60W2552/00, B60W2554/00
- B60W2555/60—Traffic rules, e.g. speed limits or right of way
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2555/00—Input parameters relating to exterior conditions, not covered by groups B60W2552/00, B60W2554/00
- B60W2555/60—Traffic rules, e.g. speed limits or right of way
- B60W2555/80—Country specific, e.g. driver age limits or right hand drive
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Transportation (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Human Computer Interaction (AREA)
- General Physics & Mathematics (AREA)
- Traffic Control Systems (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
检测本车辆(V)可行驶的道路区域的行驶路(TA),相对于该行驶路空间,生成将左侧边界线的势值(+P)和右侧边界线的势值(﹣P)设定成相互不同的值的势场,应用势法运算行驶路宽度(W)。在根据该运算的行驶路宽度确定的行驶路径的横向位置相对于以左侧边界线或右侧边界线为基准在行驶路内预先设定的行驶路径的横向位置存在差异的情况下,修正该部分的势值,再次生成设定为修正后的势值的势场,对其应用势法生成行驶路径(TR),并按照生成的行驶路径执行车辆的自动行驶控制。
Description
技术领域
本发明涉及车辆的行驶控制方法及行驶控制装置。
背景技术
作为车辆的自动驾驶等所利用的行驶路径生成装置,已知有如下行驶路径生成装置,即,获取本车辆的周围信息和本车辆的行驶状态,根据基于周围信息获取的道路宽度、道路形状及障碍物等,识别本车辆的可行驶区域和不可行驶区域,在识别的可行驶区域中,基于本车辆的车速和目标横向加速度设定行驶路径的曲率,根据该曲率将支持向量机中用作核函数的矢径基底函数的系数设定为曲率参数(专利文献1)。而且,利用该行驶路径生成装置的支持向量机,基于设定的曲率参数生成车辆的行驶路径。
现有技术文献
专利文献
专利文献1:日本特开2015-16799号公报
发明所要解决的问题
在上述现有技术中,将分别属于道路的左右类别的特征点中最接近识别面的特征点设为支持向量,以支持向量与识别面的距离成为最大的方式生成识别面,并将其设为行驶路径。即,将识别为可行驶的道路的区域的左右宽度方向的大致中央设为行驶路径。因此,在例如仅在宽度较宽的道路左侧的路边分散有障碍物、例如停车车辆的情况下等,生成仅在不存在障碍物的范围返回到道路的中央这样的波动的行驶路径,有时给乘客造成不适感。
发明内容
本发明所要解决的问题在于,提供消除乘客的不适感而能够实现顺畅的自动行驶控制的车辆的行驶控制方法及行驶控制装置。
用于解决问题的技术方案
本发明中,检测本车辆可行驶的道路区域的行驶路,相对于该行驶路空间,生成将左侧边界线的第一势值和右侧边界线的第二势值设定成相互不同的值的势场。在根据势场的势值确定的行驶路径的横向位置相对于以左侧边界线或右侧边界线为基准在行驶路内预先设定的行驶路径的横向位置存在差异的情况下,修正第一势值和/或所述第二势值,以使运算后的差的绝对值成为规定值以下,利用修正后的第一势值和/或所述第二势值,生成行驶路径,并按照生成的行驶路径执行车辆的自动行驶控制。由此,解决上述课题。
发明效果
根据本发明,按照预先设定的行驶路径的横向位置生成行驶路径,因此,能够消除乘客的不适感而实现顺畅的自动行驶控制。
附图说明
图1是表示本发明的车辆的行驶控制装置的一实施方式的块图。
图2是表示图1的行驶路宽度运算部的结构的块图。
图3是表示图1的行驶路径运算部的结构的块图。
图4是表示图1的车辆的行驶控制装置中执行的处理顺序的流程图。
图5是用于说明图4的步骤S1~S4的处理的行驶路的俯视图。
图6是表示用于说明图4的步骤S5~S6的处理的势场及等势线的图。
图7是表示用于说明图4的步骤S7的处理的、沿着图6的VII-VII线的截面的势值的图表。
图8是表示用于说明图4的步骤S8~S10的处理的一例的、沿着图6的VII-VII线的截面的势值的图表。
图9是表示用于说明图4的步骤S8~S10的处理的另一例的、沿着图6的VII-VII线的截面的势值的图表。
图10是表示存储于图1的横向位置指令部的控制映像的一例的图。
图11是表示用于说明图4的步骤S12的处理的势场及等势线的图。
图12是表示用于说明图4的步骤S13的处理的势场及等势线的图。
图13是表示成为使用本发明的车辆的行驶控制装置生成的行驶路径的前提的场景的一例的俯视图。
图14是用于说明使用本发明的车辆的行驶控制装置相对于图13的场景执行的处理的俯视图(其一)。
图15是用于说明使用本发明的车辆的行驶控制装置相对于图13的场景执行的处理的俯视图(其二)。
图16是用于说明使用本发明的车辆的行驶控制装置相对于图13的场景执行的处理的俯视图(其三)。
具体实施方式
图1是表示本实施方式的车辆的行驶控制装置VTC的结构的块图。本实施方式的车辆的行驶控制装置VTC也是实施本发明的车辆的行驶控制方法的一实施方式。如图1所示,本实施方式的车辆的行驶控制装置VTC具备:行驶路边界获取部1~5、行驶路边界整合部6、道路环境识别部7、横向位置指令部8、边界条件设定部9、行驶路宽度运算部10、行驶路径运算部11、行驶路径追随控制部12。
这些单元中,行驶路边界获取部1~5如后述由各种传感器类构成。另外,行驶路边界整合部6、道路环境识别部7、横向位置指令部8、边界条件设定部9、行驶路宽度运算部10、行驶路径运算部11、行驶路径追随控制部12利用一个或多个计算机及安装于该计算机的软件构成。计算机由储存有程序的ROM、执行该ROM所储存的程序的CPU、作为可访问的存储装置发挥作用的RAM构成,该程序用于使行驶路边界整合部6、道路环境识别部7、横向位置指令部8、边界条件设定部9、行驶路宽度运算部10、行驶路径运算部11、及行驶路径追随控制部12之类的各单元发挥作用。此外,作为动作电路,能够代替CPU或与CPU一起使用MPU、DSP、ASIC、FPGA等。
行驶路边界获取部1~5检测用于获取成为自动行驶控制的控制对象的本车辆V的行驶路TA的与左侧边界线相关的左侧行驶路边界信息和与右侧边界线相关的右侧行驶路边界信息的各种信息。
行驶路边界获取部1获取搭载于本车辆的本车辆位置检测器的本车辆位置信息和储存于地图数据库的三维高精度地图信息,并将这些信息输出至行驶路边界整合部6和道路环境识别部7。该本车辆位置检测器由GPS单元、陀螺仪传感器、及车速传感器等构成,通过GPS单元检测从多个卫星通信发送的电磁波,周期性地获取本车辆的位置信息,并且基于获取的本车辆的位置信息、从陀螺仪传感器获取的角度变化信息、从车速传感器获取的车速,检测本车辆的当前的位置信息。另外,储存于地图数据库的三维高精度地图信息是基于使用数据获取用车辆在实际的道路上行驶时检测的道路形状的三维地图信息,是道路的汇合地点、分支地点、收费站、车道数的减少位置、服务区/停车区域等详细且高精度的位置信息与地图信息一起作为三维信息相关联的地图信息。
行驶路边界获取部2利用设置于车辆前部的激光测距仪(LRF)获取障碍物信息(LRF信息),并将该信息输出至行驶路边界整合部6和道路环境识别部7。激光测距仪向车辆的前方区域照射作为距离测定用的输出波的激光,并检测其反射波(探测波),由此,生成表示车辆周围的物体目标(物体目标是例如在车辆行驶的行驶路的其它车辆、两轮车、自行车、行人、行驶路面上的车道区分线、路边的缘石、护栏、墙壁面、路堤等)与车辆之间的相对位置的测距信号。
行驶路边界获取部3利用使用了毫米波或超声波的雷达装置获取障碍物信息(雷达信息),并将该信息输出至行驶路边界整合部6。雷达装置向车辆前方照射毫米波或超声波,扫描本车辆周围的规定范围,而检测存在于本车辆周围的其它车辆、两轮车、自行车、行人、路边的缘石、护栏、墙壁面、路堤等等障碍物。例如,雷达装置将障碍物与本车辆的相对位置(方位)、障碍物的相对速度、从本车辆到障碍物的距离等作为本车辆的周围状况进行检测。
行驶路边界获取部4利用设置于车辆前方等的摄像机获取障碍物信息(摄像机信息),并将该信息输出至行驶路边界整合部6。摄像机是拍摄本车辆前方的规定范围而获取图像数据的图像传感器,例如由设置于车厢内的前窗户上部的CCD广角摄像机构成。摄像机可以是立体摄像机或全方位摄像机,也可以包含多个图像传感器。摄像机根据获取的图像数据,将存在于本车辆前方的道路及道路周边的结构物、道路标示、标识、其它车辆、两轮车、自行车、行人等作为本车辆的周围状况进行检测。
行驶路边界获取部5利用设置于车辆的前方、后方及侧方的整个周围的摄像机获取障碍物信息(全景式监控(注册商标)AVM信息),并将该信息输出至行驶路边界整合部6。摄像机是拍摄本车辆的整个周围的范围而获取图像数据的图像传感器,例如由设置于车厢内的前窗户上部、左右的后视镜、后车箱盖等的CCD广角摄像机构成。摄像机根据获取的图像数据,将存在于本车辆的周围的道路及道路周边的结构物、道路标示、标识、其它车辆、两轮车、自行车、行人等作为本车辆的周围状况进行检测。
以上的行驶路边界获取部1~5不需要全部设置,只要至少设置行驶路边界获取部1、行驶路边界获取部2或行驶路边界获取部3的任一方、行驶路边界获取部4或行驶路边界获取部5的任一方即可。行驶路边界获取部1获取本车辆的当前位置信息和其附近的三维高精度地图信息,因此,能够识别本车辆附近的障碍物以外的道路形状。另外,行驶路边界获取部2或行驶路边界获取部3使用雷达光等进行扫描,因此,能够识别较远的障碍物的有无。与之相对,行驶路边界获取部4或行驶路边界获取部5使用图像传感器等进行拍摄,因此,能够不仅识别障碍物的有无,还识别至其种类。
行驶路边界整合部6基于由这些行驶路边界获取部1~5获取的信息,生成本车辆可行驶的道路区域即行驶路的、与左侧边界线相关的左侧行驶路边界信息和与右侧边界线相关的右侧行驶路边界信息。即,根据由行驶路边界获取部1获取的本车辆的当前位置信息和定义了道路边界信息的地图信息,检测本车辆可行驶的道路区域的水平面内的第一行驶路边界信息。另外,与此同时,获取由行驶路边界获取部2~5获取的本车辆的周围的物体及道路状况作为周围信息,根据该周围信息检测本车辆可行驶的道路区域的水平面内的第二行驶路边界信息。
另外,本说明书中,“道路”是指无论障碍物的有无,现实中均存在且包含于地图信息的、为了车辆及人类通行而配备的道路本身。与之相对,本说明书中,“行驶路”是指道路中本车辆可行驶的区域即除了障碍物之外的本车辆可行驶的道路的区域。因此,行驶路边界整合部6检测由行驶路边界获取部1获取的与“道路”相关的第一行驶路边界信息,另一方面,检测由行驶路边界获取部2~5获取的与“行驶路”相关的第二行驶路边界信息。而且,行驶路边界整合部6对第一行驶路边界信息和第二行驶路边界信息进行整合,生成整合行驶路边界信息,进一步将该整合行驶路边界信息分离成左侧行驶路边界信息和右侧行驶路边界信息。此外,本说明书中“左侧”、“右侧”及“横向”是指将本车辆行进方向设为前方的情况的左侧、右侧及横向。
图13是表示本车辆V行驶的道路的一例的俯视图,在日本及英国那样的左侧通行的法律规定的国家中,表示左侧的一车道。在该场景的情况下,行驶路边界整合部6利用行驶路边界获取部1获取本车辆V的当前位置,具体而言利用GPS单元获取维度、经度信息,并且根据三维高精度地图信息获取本车辆V存在的周围的道路信息、具体而言道路R的环境或属性(国家信息、道路左端RL的位置信息、道路右端RR的位置信息、道路R的宽度、高速公路/普通道路/其它的道路种类等)。与此同时,行驶路边界整合部6利用行驶路边界获取部2~5获取存在于本车辆V的周围的其它车辆、两轮车、自行车、行人、路边的缘石、护栏、墙壁面、路堤等等障碍物的位置信息。
而且,行驶路边界整合部6从根据由行驶路边界获取部1获取的本车辆V的当前位置信息及其周边的三维高精度地图信息而识别的道路R的区域,减去根据由行驶路边界获取部2~5获取的障碍物的位置信息而识别的障碍物的存在区域,运算本车辆V可行驶的行驶路TA。然后,行驶路边界整合部6根据这样运算的行驶路TA的区域信息,运算表示左侧边界线EL的左侧行驶路边界信息和表示右侧边界线ER的右侧行驶路边界信息。对图13所示的场景换句话说,利用行驶路边界获取部2~5获取到在道路R的左侧部存在3台静止障碍物(停车车辆)V1、V2、V3的情况,因此,左侧边界线EL成为以虚线表示的线,另一方面,在道路R的右侧部不存在障碍物,因此,右侧边界线ER成为与道路右端RR相同的线。此外,行驶路边界整合部6无论是图13所示的较简单的道路形状,还是图5所示的复杂的道路形状,均将左侧边界线EL的左侧行驶路边界信息和右侧边界线ER的右侧行驶路边界信息各自如图5所示转换成直线的折线信息的集合体而进行保有。
返回图1,道路环境识别部7根据由行驶路边界获取部1获取的本车辆V的当前位置信息及其周边的三维高精度地图信息及由行驶路边界获取部2获取的障碍物的位置信息,识别本车辆V当前行驶中的道路环境等。具体而言,如图10所示,识别作为道路环境是否为在道路R的左右任一方的侧部停车的停车车辆多的车道、汽车的行驶法规是左行驶还是右行驶的国家信息、及左侧边界线EL的左侧行驶路边界信息的频率和右侧边界线ER的右侧行驶路边界信息的频率。图10是表示图1的横向位置指令部8中所存储的控制映像的一例的图。
横向位置指令部8是根据道路环境,预先设定适于本车辆V行驶的行驶路TA的横向位置的单元。例如,在日本国中,乘用车的车宽为1.4~2.5m,与之相对,一个车道的道路R的宽度(幅宽)规定为3.5m左右。但是,包含日本国在内,根据国家不同,也存在5~6m水平的宽阔的道路,在这样的道路上,允许路边停车的情况也不少。因此,在本实施方式的横向位置指令部8中,对于作为道路环境是否为在路边停车的停车车辆多的车道,根据行驶路边界获取部1的三维高精度地图信息获取不是停车禁止,并且根据行驶路边界获取部2的LRF信息获取实际上是否存在停车车辆。另外,根据行驶路边界获取部1的三维高精度地图信息获取本车辆V的行驶中的国家信息,并识别是左侧行驶还是右侧行驶。进而,作为其它的条件,获取行驶路边界整合部6中获取的左侧边界线EL的左侧行驶路边界信息的频率和右侧边界线ER的右侧行驶路边界信息的频率,识别障碍物在左侧边界线EL和右侧边界线ER的哪一方多。此外,左侧行驶路边界信息的频率及右侧行驶路边界信息的频率,如果以图13所示的左侧边界线EL而言,是指相对于道路R的延伸方向(图13的上下方向)的横向的锯齿线的频率。即是指将横向的变化设为振幅,且将沿着道路R的方向设为时间的情况的左侧边界线EL及右侧边界线ER的频率,是沿着道路R的方向上的每单位距离的横向变化的频率。在频率大的情况下,是指障碍物多,在频率小的情况下,是指障碍物少。
而且,横向位置指令部8根据由道路环境识别部7识别的道路环境、国家信息及其它的条件和横向位置指令部8中所存储的图10所示的控制映像,在作为道路环境为停车车辆在路边多的车道的情况下,根据国家信息识别为左侧行驶的国家时,以将从行驶路TA的右端起向左1.5m的位置设为本车辆V的车宽中心并自动行驶控制的方式输出指令,根据国家信息识别为右侧行驶的国家时,以将从行驶路TA的左端起向右1.5m的位置设为本车辆V的车宽中心并自动行驶控制的方式输出指令。同样地,横向位置指令部8在作为道路环境为停车车辆在路边多的车道的情况下,得不到国家信息时,获取行驶路边界整合部6中获取的左侧边界线EL的左侧行驶路边界信息的频率和右侧边界线ER的右侧行驶路边界信息的频率,在左侧行驶路边界信息的频率一方小时,以将从行驶路TA的左端起向右1.5m的位置设为本车辆V的车宽中心并自动行驶控制的方式输出指令,在右侧行驶路边界信息的频率一方小时,以将从行驶路TA的右端起向左1.5m的位置设为本车辆V的车宽中心并自动行驶控制的方式输出指令。此外,在作为道路环境不是停车车辆在路边多的车道的情况下,以自动行驶控制的方式输出指令,以使行驶路TA的中心位置与本车辆V的车宽中心一致。
再次返回图1,行驶路宽度运算部10获取由行驶路边界整合部6运算的整合行驶路边界信息(包含左侧行驶路边界信息及右侧行驶路边界信息),运算本车辆V的前方的行驶路TA的行驶路宽度W。图2是表示图1的行驶路宽度运算部10的具体的结构的块图,图5是表示由行驶路边界整合部6运算的整合行驶路边界信息(包含左侧行驶路边界信息及右侧行驶路边界信息)的俯视图。
如图2所示,行驶路宽度运算部10具备势值运算部101、等势线运算部102、梯度运算部103,读入左侧边界线EL的左侧行驶路边界信息和右侧边界线ER的右侧行驶路边界信息各自,相对于本车辆V的行驶方向以规定间隔运算行驶路宽度W,并将其输出至边界条件设定部9。
图6是表示使用替代电荷法(也称为电荷重叠法),在行驶路TA的二维空间(x-y平面)内生成左侧行驶路边界信息的左侧边界线EL成为第一势值(同图所示的例子中,+3V),且右侧行驶路边界信息的右侧边界线ER成为与第一势值(+3V)不同的第二势值(同图所示的例子中,-3V)的势场,且运算势场的势值的结果的图。表示在以多个折线的集合体表示的左侧边界线EL和以相同的多个折线的集合体表示的右侧边界线ER之间存在行驶路TA的二维空间内,使用计算机模拟应用替代电荷法,对左侧边界线EL施加+3V的电压,且对右侧边界线ER施加-3V的电压的情况的电场的等电荷线(等势线)。即,图6表示形成于左侧边界线EL与右侧边界线ER之间的行驶路TA的二维空间内的、使用替代电荷法运算拉普拉斯方程式的解即势值的结果。
图7是表示图6的行驶路TA的一截面即沿着VII-VII线的截面的势值(电荷)的图表。图7的纵轴的势值“+P”相当于图6的+3V,图7的纵轴的势值“-P”相当于图6的-3V。而且,在图7中,通过本发明人等确认到从左侧边界线EL到右侧边界线ER的势值的梯度k大致一定,因此,当设为势值P、行驶路宽度W、梯度k时,根据图7的图表,kW=2P成立,能够根据行驶路宽度W=2P/k,运算行驶路宽度W。
在此,拉普拉斯方程式是求解自然界的稳定状态(不根据时间而变化的状态,即没有时间的变量的状态)的势场的微分方程式,例如除了图6所示那样的没有电荷分布的一样的介质中的静电势之外,还包含与接触于热源的固体内的温度分布相关的热传导的扩散方程式、求解重力场的重力势的方程式。具体而言,相对于本实施方式那样的行驶路TA的二维空间(x,y)的二次函数E,是指的方程式。
另外,在运算该拉普拉斯方程式的解时,能够使用可进行满足拉普拉斯方程式的二阶连续微分的函数(以下,调和函数)进行运算。即,相对于本实施方式那样的行驶路TA的二维空间(x,y)的二次函数E,E=ax+by+c,E=aIn(√(x2+y2))成为调和函数(其中,a、b、c表示定数,In表示自然对数)。此外,调和函数假定可进行二阶连续微分的函数,但也可进行无限次微分。在此,在本实施方式那样的行驶路TA的二维空间(x,y)的情况下,存在满足的方程式的、成对的次调和函数E、F。使用该成对的函数E、F得到的复函数G(x,y)=E(x,y)+iF(x,y)为满足拉普拉斯方程式的调和函数的一种,称为正则函数,具有便于运算的特征。
图2所示的势值运算部101对行驶路TA的二维空间(x-y平面)应用替代电荷法,求得与该电场相关的拉普拉斯方程式的解。具体而言,将由左侧行驶路边界信息及右侧行驶路边界信息各自的折线信息的线段的位置、方向及长度规定的调和函数设为基底函数,并使用它们的线性结合的近似解。在此,将折线信息各自的线段的中点选为狄利克雷边界条件的应用场所,应用替代电荷法而得到线性结合的系数。然后,更具体而言,将行驶路TA的二维空间(x-y平面)设为复平面,将行驶路边界信息转换成复数信息,将基底函数设为复正则函数,使用作为这些线性结合的近似解的复势,由此,能够得到二维空间(x-y平面)的全部或一部分位置的电荷(势值)。此外,作为基底函数的复正则函数中,将z设为复数变量,并以f(z)=In(z1-z)+In{(z1-z)/(z0-z)}(z0-z)/(z1-z0)定义。这样,如果将成为势场的对象的行驶路TA设为复平面,并将左侧边界线EL的左侧边界信息和右侧边界线ER的右侧边界信息转换成复数信息,则容易求得梯度k,因此,梯度运算部103根据图7所示的行驶路宽度W=2P/k,运算行驶路宽度W,并输出至边界条件设定部9。
但是,当利用势值运算部101求得行驶路TA的x-y平面的所有的电荷(势值)时,运算负荷大,运算时间也长。因此,等势线运算部102通过探索成为电荷(势值)相等的基准的位置,得到等电荷线(等势线)。例如,图6所示的行驶路TA的例子中,将对左侧边界线EL施加了+3V,且对右侧边界线ER施加了-3V的电压的电场作为势场生成,因此,沿着本车辆V的行驶方向探索成为其中间值的0V的位置即行驶路TA的中心点。图11是用于说明这样的等势线的探索方法的俯视图。
等势线运算部102对于图11的左图中、位于本车辆V的行驶前方的行驶路TA,预设定要设为行驶路TA的中心线的起点的位置,使用牛顿法求得真正的行驶路TA的中心点。此外,牛顿法(均称为牛顿-拉夫逊法)是用于通过数值计算求解方程式系的反复法的求根算法,即如下算法,求得预设定的初始值xn的函数的切线与势P=0的截距,将其设定为xn+1,接着求得该值xn+1的函数的切线与势P=0的截距,将其设定为xn+2,重复进行该处理,由此,求得真正的行驶路TA的中心点的起点位置TR0。
等势线运算部102如果通过上述的牛顿法求得行驶路TA的中心线的真正的起点位置TR0,则如图11的右图所示,使用四次龙格-库塔法(RK4)求得相对于本车辆V的行驶方向向前方规定距离的位置TR1的行驶路TA的中心点。在此,四次龙格-库塔法(RK4)是初始值使用对已知的微分方程式进行了泰勒展开的4次项求解的数值解析法。例如,函数f(x,y)=dy/dx、初始值x0、y0时,向前方规定距离h的位置x0+h的y(x0+h)的四次泰勒展开式成为y(x0+h)=y0+hf(x0,y0)+hf(x0+h/2,y0+k1/2)+hf(x0+h/2,y0+k2/2)+hf(x0+h,y0+k3)。其中,k1=hf(x0,y0),k2=hf(x0+h/2,y0+k1/2),k3=hf(x0+h/2,y0+k2/2),k4=hf(x0+h,y0+k3),k=(k1+2k2+2k3+k4)/6。等势线运算部102以下重复进行该处理,如图11的右图所示,求得行驶路TA的前方的位置TRn的行驶路TA的中心点。然后,等势线运算部102将这些中心点结合而制成行驶路TA的中心线CL,并输出至梯度运算部103。梯度运算部103保有上述运算的行驶路宽度W和行驶路TA的中心线CL的信息,并输出至边界条件设定部9。
返回图1,边界条件设定部9根据从行驶路宽度运算部10获取的行驶路宽度W及行驶路TA的中心线CL和从横向位置指令部8获取的横向位置,设定边界条件。图8及图9是表示沿着图6的VII-VII线的截面的势值的图表,是将包含从行驶路宽度运算部10获取的行驶路宽度W及行驶路TA的中心线CL的势值以实线表示,将相对于从横向位置指令部8获取的横向位置的势值以虚线表示的图表。
即,图8所示的场景例表示以实线表示的左侧边界线EL的势值为+P,右侧边界线ER的势值为-P,行驶路TA的中心线为CL,与之相对,来自横向位置指令部8的指令在从行驶路TA的中心线CL向左偏置X1(m)的位置的情况。在该情况下,如虚线所示,边界条件设定部9运算作为边界条件的左侧边界线EL的势值P1L和右侧边界线ER的势值-P1R,以使势值P成为0的位置成为从行驶路TA的中心线CL向左偏置X1的位置CLa。具体而言,从以实线表示的行驶路宽度运算部10的梯度运算部103获取梯度k,使用P1L=+P-kX1、P1R=-P-kX1的关系式,运算P1L及P1R。这些势值P1L及P1R作为边界条件,输出至后述的行驶路径运算部11的边界条件修正部111。
图9所示的场景例表示以实线表示的左侧边界线EL的势值为+P,右侧边界线ER的势值为-P,行驶路TA的中心线为CL,与之相对,来自横向位置指令部8的指令在从行驶路TA的右侧边界线ER向左偏置X2(m)的位置的情况。在该情况下,如虚线所示,边界条件设定部9运算作为边界条件的左侧边界线EL的势值P1L和右侧边界线ER的势值-P1R,以使势值P成为0的位置成为从行驶路TA的右侧边界线向左偏置X2的位置CLa。具体而言,从以实线表示的行驶路宽度运算部10的梯度运算部103获取梯度k,使用P1L=+P-(2P2/kX2)、P1R=-P的关系式,运算P1L及P1R。这些势值P1L及P1R作为边界条件,输出至后述的行驶路径运算部11的边界条件修正部111。
返回图1,行驶路径运算部11根据从行驶路边界整合部6获取的整合行驶路边界信息和从边界条件设定部9获取的边界条件,运算本车辆V的行驶路径TR,并将其输出至行驶路径追随控制部12。图3是表示图1的行驶路径运算部11的具体的结构的块图,图12是表示由行驶路径运算部11运算的行驶路径TR的俯视图。如图3所示,行驶路径运算部11具备边界条件修正部111、势值运算部112、等势线运算部113、梯度运算部114。
边界条件修正部111根据从行驶路边界整合部6获取的整合行驶路边界信息和从边界条件设定部9获取的边界条件,修正整合行驶路边界信息所含的左侧边界信息的左侧边界线EL的势值和右侧边界信息的右侧边界线ER的势值。如图8及图9所示,对在修正前的行驶路的中心线CL和从横向位置指令部8获取的横向位置(图8及图9中以虚线表示的修正后的行驶路的中心线CLa)存在差的区间执行该势值的修正。即,对于由行驶路宽度运算部10和横向位置指令部8求得的、边界条件设定部9中设定的边界条件与行驶路宽度运算部10的势值运算部101中最初设定的势值不同的区间,修正该势值,对于其它的区间直接使用势值运算部101中最初设定的势值。
即,在本车辆V的前方的行驶路TA的某个区间中为图8所示那样的状况的情况下,对于该区间,将左侧边界线EL的势值+P修正成P1L,将右侧边界线ER的势值-P修正成-P1R。同样地,在本车辆V的前方的行驶路TA的某个区间中为图9所示那样的状况的情况下,对于该区间,将左侧边界线EL的势值+P修正成P1L,右侧边界线ER的势值-P不进行修正而直接设为-P。
势值运算部112除了修正左侧边界线EL的势值和右侧边界信息的右侧边界线ER的势值以外,执行与图2所示的行驶路宽度运算部10的势值运算部101相同的处理。即,势值运算部112相对于图5所示的行驶路TA的二维空间(x-y平面),将对于由边界条件修正部111修正的区间修正后的势值+P1L、-P1R、对于未修正的区间的最初的势值+P、-P分别设为左侧边界线EL的势值及右侧边界线ER的势值,使用替代电荷法(均称为电荷重叠法),在该行驶路TA的二维空间(x-y平面)内生成势场,并求得与该电场相关的拉普拉斯方程式的解。具体而言,将由左侧行驶路边界信息及右侧行驶路边界信息各自的折线信息的线段的位置、方向及长度规定的调和函数设为基底函数,使用它们的线性结合的近似解。在此,将折线信息各自的线段的中点选为狄利克雷边界条件的应用场所,应用替代电荷法得到线性结合的系数。而且,更具体而言,将行驶路TA的二维空间(x-y平面)设为复平面,将行驶路边界信息转换成复数信息,将基底函数设为复正则函数,并使用作为它们的线性结合的近似解的复势,由此,能够得到二维空间(x-y平面)的全部或一部分位置的电荷(势值)。此外,作为基底函数的复正则函数将z设为复数变量,并以f(z)=In(z1-z)+In{(z1-z)/(z0-z)}(z0-z)/(z1-z0)定义。
等势线运算部113与图2所示的行驶路宽度运算部10的等势线运算部102一样,通过探索成为电荷(势值)相等的基准的位置,得到等电荷线(等势线)。例如,图6所示的行驶路TA的例子中,将对左侧边界线EL施加了+3V或修正后的势值,对右侧边界线ER施加了-3V或修正后的势值的电压的电场作为势场进行生成,因此,沿着本车辆V的行驶方向探索成为其中间值的0V的位置即行驶路TA的中心点。
即,等势线运算部113对于图11的左图中、处于本车辆V的行驶前方的行驶路TA,预设定要成为行驶路TA的中心线的起点的位置,使用牛顿法求得真正的行驶路TA的中心点。等势线运算部113如果通过上述的牛顿法,求得行驶路TA的中心线的真正的起点位置TR0,则如图11的右图所示,使用四次龙格-库塔法(RK4)求得相对于本车辆V的行驶方向向前方规定距离的位置TR1的行驶路TA的中心点。然后,等势线运算部113以下重复进行该处理,如图11的右图所示求得行驶路TA的前方的位置TRn的行驶路TA的中心点。然后,如图12所示,等势线运算部113将这些中心点结合,将行驶路TA的中心线CL设为行驶路径TR,并输出至梯度运算部114。梯度运算部114保有上述运算的行驶路宽度W和行驶路径TR的信息,并输出至行驶路径追随控制部12。
此外,等势线运算部113对于由边界条件修正部111修正了左侧边界线EL和/或右侧边界线ER的势值的区间,求得行驶路TA的前方的位置TRn的行驶路TA的中心点。这是由于,如图8及图9所示,使用修正后的左侧边界线EL和/或右侧边界线ER的势值得到的拉普拉斯方程式的解与修正后的行驶路的中心线CLa对应。
行驶路径追随控制部12将从行驶路径运算部11获取的本车辆V的行驶路径TR设为目标路径,控制包含执行本车辆V的转向控制的转向促动器的转向装置、包含执行本车辆V的加速或减速控制的加速促动器(或燃料喷射或驱动源电机的电流)的加减速驱动装置、及包含执行本车辆V的制动控制的制动促动器的制动装置。
接着,参照图4的流程图说明本实施方式的车辆的行驶控制装置VTC的控制顺序。图4是表示图1的车辆的行驶控制装置VTC中执行的处理顺序的流程图。如图5、图6、图11及图12所示,上述的本实施方式的车辆的行驶控制装置VTC的结构基于普通的道路进行了说明,但在以下的控制顺序中,为了容易理解本实施方式的作用效果,对本车辆V在图13所示的简单的道路R行驶的场景进行说明。就图13所示的道路R而言,在日本及英国那样的左侧通行的法律规定的国家中,表示左侧的一个车道。另外,该道路R是比作为普通的道路宽度的3.5m宽,例如为5~6m水平的宽阔的道路R,允许路边停车。
首先,在图4的步骤S1中,根据由行驶路边界获取部1获取的本车辆V的当前位置信息和定义道路边界信息的地图信息,检测本车辆V可行驶的道路区域的水平面内的第一行驶路边界信息。另外,与此同时,在步骤S2中,获取由行驶路边界获取部2~5获取的本车辆V的周围的物体及道路状况作为周围信息,根据该周围信息检测本车辆V可行驶的道路区域的水平面内的第二行驶路边界信息。根据第一行驶路边界信息,能够识别本车辆V附近的障碍物以外的道路形状,根据第二行驶路边界信息,能够识别本车辆V的周围的远近双方的障碍物的有无及种类。
在步骤S3中,行驶路边界整合部6对由行驶路边界获取部1~5获取的第一行驶路边界信息及第二行驶路边界信息进行整合,生成整合行驶路边界信息。即,相对于图13所示的场景,行驶路边界整合部6从根据由行驶路边界获取部1获取的本车辆V的当前位置信息及其周边的三维高精度地图信息而识别的道路R的区域,减去根据由行驶路边界获取部2~5获取的障碍物V1、V2、V3的位置信息识别的障碍物V1、V2、V3的存在区域,运算本车辆V可行驶的行驶路TA。
进而,在步骤S4中,行驶路边界整合部6将整合行驶路边界信息分离成本车辆V可行驶的道路区域即行驶路的、与左侧边界线EL相关的左侧行驶路边界信息和与右侧边界线ER相关的右侧行驶路边界信息。如果对图13所示的场景进行说明,则利用行驶路边界获取部2~5获取到在道路R的左侧部存在3台静止障碍物(停车车辆)V1、V2、V3的情况,因此,左侧边界线EL成为以虚线表示的线,另一方面,在道路R的右侧部不存在障碍物,因此,右侧边界线ER成为与道路右端RR相同的线。在图14的左图表示分离的与左侧边界线EL相关的左侧行驶路边界信息和与右侧边界线ER相关的右侧行驶路边界信息。
如背景技术的栏中进行的叙述,当根据图14的左图所示的左侧边界线EL、右侧边界线ER及由它们界定的行驶路TA,利用支持向量机基于设定的曲率参数生成车辆的行驶路径时,如图14的右图所示,在不存在作为障碍物的停车车辆的区间较长的情况下,行驶路径TR成为在该部分波动的路径,会给乘客造成不适感。特别是图13所示那样的5~6m水平的宽阔的道路R,在允许路边停车的道路R中,与沿着行驶路TA的中心行驶相比,倒是以道路右端RR为基准进行行驶的一方不管路边停车的有无,均能够生成顺畅的行驶路径。
于是,本实施方式的车辆的行驶控制装置VTC在步骤S5~S13中,对于图14的左图所示的当前的行驶路TA,不管在左侧的路边是否存在停车车辆V1、V2、V3,均使用拉普拉斯方程式的解运算从右侧边界线ER向左偏置X2(m)的位置,以成为本车辆V的行驶路径TR。
即,在步骤S5中,行驶路宽度运算部10的势值运算部101对于图15的左图所示的、步骤S4中求得的左侧边界线EL、右侧边界线ER及由它们界定的行驶路TA,使用替代电荷法,在行驶路TA的二维空间(x-y平面)内生成左侧边界线EL成为第一势值(例如+3V)、右侧边界线ER成为第二势值(例如-3V)的势场。接着,在步骤S6中,等势线运算部102通过探索成为电荷(势值)相等的基准的位置,得到等电荷线(等势线)。而且,在步骤S7中,梯度运算部103根据势场的解求得梯度k后,根据图7所示的行驶路宽度W=2P/k运算行驶路宽度W,并输出至边界条件设定部9。此外,如图15的右图所示,对于本车辆V的前方的行驶路TA以规定距离间隔运算该行驶路宽度W。另外,梯度运算部103保有运算的行驶路宽度W和行驶路TA的中心线CL的信息,并输出至边界条件设定部9。
在步骤S8中,道路环境识别部7、横向位置指令部8、及边界条件设定部9比较横向位置。即,横向位置指令部8根据从道路环境识别部7获取的道路环境和国家信息,如图10所示,检测本车辆V的行驶中的道路R为停车车辆多的车道且为左侧行驶的国家,因此,作为横向位置的指令内容,提取将“距行驶路右端为X2(例如1.5m)”的位置设为行驶路径TR的中心线的指令。然后,在步骤S9中,如图9所示,边界条件设定部9将从行驶路宽度运算部10获取的行驶路宽度W的行驶路TA的中心线CL的位置与横向位置指令部8中提取的“距行驶路右端为X2(例如1.5m)”的位置比较并判断是否具有差。此外,在该判断时,未必需要差为0,也可以允许不会对乘客造成不适感程度的差的存在。另外,该差的有无的判断按照获取到图15的右图所示的行驶路宽度W的每个规定距离间隔执行。
在步骤S9中,在判断为具有差的情况下进入步骤S10,在判断为没有差的情况下进入步骤S11。在判断为具有差的步骤S10中,如图9所示,从行驶路宽度运算部10获取的行驶路宽度W的行驶路TA的中心线CL的位置与横向位置指令部8中提取的“距行驶路右端为X2(例如1.5m)”的位置相比具有差,因此,如图9中由虚线所示,边界条件设定部9运算作为边界条件的左侧边界线EL的势值P1L和右侧边界线ER的势值-P1R,以使势值P成为0的位置成为从行驶路TA的右侧边界线向左偏置X2的位置CLa。具体而言,从以实线表示的行驶路宽度运算部10的梯度运算部103获取梯度k,使用P1L=+P-(2P2/kX2)、P1R=-P的关系式,运算P1L及P1R。这些势值P1L及P1R作为边界条件,输出至行驶路径运算部11的边界条件修正部111。边界条件修正部111修正从边界条件设定部9获取的左侧边界信息的左侧边界线EL的势值和右侧边界信息的右侧边界线ER的势值。在图16的左图中表示在本车辆V的前方的行驶路TA中修正势值的范围。在本例的情况下,如图9所示,将最初的势值+P修正成比其大的势值+P1L。
在步骤S11中,行驶路径运算部11将图16所示的修正后的势值(对于未修正的区间为最初的势值)设定成左侧边界线EL和右侧边界线ER,使用替代电荷法,在行驶路TA的二维空间(x-y平面)内生成势场。接着,在步骤S12中,等势线运算部113通过使用上述的牛顿法及四次龙格-库塔法探索成为电荷(势值)相等的基准的位置(本例中,势值成为0V的位置),而得到等电荷线(等势线)。该等势线成为图16的右图所示的本车辆V的行驶路径TA,因此,在步骤S13中将该等势线作为行驶路径TA输出至行驶路径追随控制部12。在步骤S12中,行驶路径追随控制部12沿着获取的行驶路径TA的位置信息,自动控制本车辆的转向装置、加减速驱动装置及制动装置,由此,执行自动行驶控制。
在上述的实施方式中,将左侧边界线EL的势值设定成+P(例如+3V的电压),右侧边界线ER的势值设定成-P(例如-3V的电压),通过替代电荷法求得与行驶路TA的势值相关的拉普拉斯方程式的解,并将势值成为0的位置设为行驶路径TR,但这些+P、-P、0仅为示例,不限定本发明。在本发明的车辆的行驶控制方法及控制装置中,至少将左侧边界线EL的势值和右侧边界线ER的势值设定成不同的值,生成势场,求得作为拉普拉斯方程式的解的势值。因此,例如将左侧边界线EL的势值设定成+2P(例如+6V的电压),将右侧边界线ER的势值设定成-P(例如-3V的电压),通过替代电荷法求得与行驶路TA的势值相关的拉普拉斯方程式的解,即使将势值成为+3的位置设为行驶路径TR,也得到同样的结果。另外,势场的解法不是仅限定于相对于电场的替代电荷法的宗旨,也可以是上述那样与接触于热源的固体内的温度分布相关的热传导的扩散方程式或求解重力场的重力势的方程式。
如上所述,根据本实施方式的车辆的行驶控制装置VTC及车辆的行驶控制方法,比较预先设定的行驶路径的横向位置和由运算的行驶路宽度确定的行驶路径的横向位置,并运算其差,以运算的差的绝对值成为规定值以下的方式修正上述第一势值和/或上述第二势值,根据修正后的势值产生的势场的等势线,生成本车辆行驶的行驶路径,因此,不管障碍物的有无,均能够通过低负荷运算生成沿着预先设定的行驶路径的横向位置的行驶路径。由此,能够消除乘客的不适感而实现顺畅的自动行驶控制。
另外,根据本实施方式的车辆的行驶控制装置VTC及车辆的行驶控制方法,在获取左侧行驶路边界信息和右侧行驶路边界信息时,根据本车辆的当前位置信息和定义了道路边界信息的地图信息,检测本车辆可行驶的道路区域的水平面内的第一行驶路边界信息,获取本车辆的周围的物体及道路状况作为周围信息,根据该周围信息检测本车辆可行驶的道路区域的水平面内的第二行驶路边界信息,对上述第一行驶路边界信息和上述第二行驶路边界信息进行整合,生成整合行驶路边界信息,并将上述整合行驶路边界信息分离成左侧行驶路边界信息和右侧行驶路边界信息。因此,根据第一行驶路边界信息,能够识别本车辆V附近的障碍物以外的道路形状,根据第二行驶路边界信息,能够识别本车辆V的周围的远近双方的障碍物的有无及种类。其结果,能够获取以较高的精度包含静态的信息和动态的信息双方的左侧行驶路边界信息和右侧行驶路边界信息。
另外,根据本实施方式的车辆的行驶控制装置VTC及车辆的行驶控制方法,预先设定的行驶路径的横向位置为上述行驶路的横向的中心位置、从上述行驶路的右端向左方向的第一规定距离的位置、或从上述行驶路的左端向右方向的第二规定距离的位置的任一位置。因此,在为行驶路的横向的中心位置的情况下,能够生成乘客的安心感更高的行驶路径。另一方面,在为从行驶路的右端向左方向的第一规定距离的位置或从行驶路的左端向右方向的第二规定距离的位置的情况下,能够生成与道路环境对应的行驶路径。
另外,根据本实施方式的车辆的行驶控制装置VTC及车辆的行驶控制方法,预先存储与本车辆行驶的道路环境信息相关联的行驶路径的横向位置,获取本车辆行驶的道路环境信息,从存储的横向位置提取与该道路环境信息相关联的行驶路径的横向位置。因此,不会增加运算负荷,能够生成与道路环境对应的行驶路径。
另外,根据本实施方式的车辆的行驶控制装置VTC及车辆的行驶控制方法,分别运算上述左侧行驶路边界信息及上述右侧行驶路边界信息的行驶方向的频率,以上述左侧行驶路边界信息及上述右侧行驶路边界信息中频率小的一方的行驶路边界信息为基准,提取上述行驶路径的横向位置。因此,能够更进一步消除乘客的不适感而实现顺畅的自动行驶控制。
另外,根据本实施方式的车辆的行驶控制装置VTC及车辆的行驶控制方法,势场的势值使用拉普拉斯方程式的近似解,因此,能够抑制波动的行驶路径的生成,更进一步消除乘客的不适感而实现顺畅的自动行驶控制。
另外,根据本实施方式的车辆的行驶控制装置VTC及车辆的行驶控制方法,就势场的势值而言,将上述左侧行驶路边界信息及上述右侧行驶路边界信息分别转换成折线信息,将由上述折线信息各自的线段的位置、方向及长度规定的调和函数设为基底函数,并使用它们的线性结合的近似解。因此,能够以低运算负荷得到近似解。
另外,根据本实施方式的车辆的行驶控制装置VTC及车辆的行驶控制方法,就势场的势值而言,将成为对象的水平面设为复平面并将行驶路边界信息转换成复数信息,将基底函数设为复正则函数,使用作为它们的线性结合的近似解的复势。因此,能够以低运算负荷求得势值的梯度。
另外,根据本实施方式的车辆的行驶控制装置VTC及车辆的行驶控制方法,在将z设为复数变量时,将上述基底函数设为f(z)=In(z1-z)+In{(z1-z)/(z0-z)}(z0-z)/(z1-z0)。因此,仅采用实部,可得到连续的势值,因此,计算能够高速化,且在左右的行驶路边界线平行的情况下,能够将计算误差设为0。
另外,根据本实施方式的车辆的行驶控制装置VTC及车辆的行驶控制方法,将折线信息各自的线段的中点选为狄利克雷边界条件的应用场所,应用替代电荷法得到上述线性结合的系数,因此,能够以低运算负荷且得到误差小的运算结果。
符号说明
VTC:车辆的行驶控制装置
1:行驶路边界获取部(高精度地图信息)
2:行驶路边界获取部(LRF信息)
3:行驶路边界获取部(雷达信息)
4:行驶路边界获取部(摄像机信息)
5:行驶路边界获取部(AVM信息)
6:行驶路边界整合部
7:道路环境识别部
8:横向位置指令部
9:边界条件设定部
10:行驶路宽度运算部
101:势值运算部
102:等势线运算部
103:梯度运算部
11:行驶路径运算部
111:边界条件修正部
112:势值运算部
113:等势线运算部
114:梯度运算部
12:行驶路径追随控制部
V:本车辆
R:道路
TA:行驶路
TR:行驶路径
EL:左侧边界线
ER:右侧边界线
P:势值
PF:势场
W:行驶路宽度
Claims (11)
1.一种车辆的行驶控制方法,其特征在于,
获取作为本车辆可行驶的道路区域的行驶路的、与左侧边界线相关的左侧行驶路边界信息和与右侧边界线相关的右侧行驶路边界信息,
在行驶路的空间内生成所述左侧行驶路边界信息的左侧边界线成为第一势值,且所述右侧行驶路边界信息的右侧边界线成为与所述第一势值不同的第二势值的势场,
修正所述第一势值和/或所述第二势值,以使以所述左侧边界线或右侧边界线为基准在所述行驶路内预先设定的行驶路径的横向位置与根据所述势场的势值确定的行驶路径的横向位置的差的绝对值成为规定值以下,
在行驶路的空间内生成所述左侧行驶路边界信息的左侧边界线成为修正后的第一势值,所述右侧行驶路边界信息的右侧边界线成为修正后的第二势值的、修正后的势场,
根据生成的修正后的势场的等势线生成本车辆行驶的行驶路径,
根据生成的行驶路径,执行所述本车辆的自动行驶控制。
2.如权利要求1所述的车辆的行驶控制方法,其特征在于,
就所述左侧行驶路边界信息和所述右侧行驶路边界信息而言,
根据本车辆的当前位置信息和定义了道路边界信息的地图信息,检测本车辆可行驶的道路区域的水平面内的第一行驶路边界信息,
获取本车辆的周围的物体及道路状况作为周围信息,根据该周围信息,检测本车辆可行驶的道路区域的水平面内的第二行驶路边界信息,
对所述第一行驶路边界信息和所述第二行驶路边界信息进行整合,生成整合行驶路边界信息,
将所述整合行驶路边界信息分离成左侧行驶路边界信息和右侧行驶路边界信息而获取。
3.如权利要求1所述的车辆的行驶控制方法,其特征在于,
预先设定的所述行驶路径的横向位置为所述行驶路的横向的中心位置、从所述行驶路的右侧边界线向左方向的第一规定距离的位置、或从所述行驶路的左侧边界线向右方向的第二规定距离的位置的任一位置。
4.如权利要求3所述的车辆的行驶控制方法,其特征在于,
预先存储与本车辆行驶的道路环境信息相关联的行驶路径的横向位置,
获取本车辆行驶的道路环境信息,从存储的横向位置提取与该道路环境信息相关联的行驶路径的横向位置。
5.如权利要求3所述的车辆的行驶控制方法,其特征在于,
分别运算所述左侧行驶路边界信息及所述右侧行驶路边界信息的行驶方向的频率,
将所述左侧行驶路边界信息及所述右侧行驶路边界信息中频率小的一方的行驶路边界信息设为基准,提取所述行驶路径的横向位置。
6.如权利要求1~5中任一项所述的车辆的行驶控制方法,其特征在于,所述势场的势值使用拉普拉斯方程式的近似解。
7.如权利要求6所述的车辆的行驶控制方法,其特征在于,
所述势场的势值将所述左侧行驶路边界信息及所述右侧行驶路边界信息分别转换成折线信息,
将由所述折线信息各自的线段的位置、方向及长度规定的调和函数设为基底函数,并使用它们的线性结合的近似解。
8.如权利要求7所述的车辆的行驶控制方法,其特征在于,
所述势场的势值将成为对象的水平面设为复平面并将行驶路边界信息转换成复数信息,
将基底函数设为复正则函数,使用作为它们的线性结合的近似解的复势。
9.如权利要求8所述的车辆的行驶控制方法,其特征在于,
在将z设为复数变量时,将所述基底函数设为f(z)=In(z1-z)+In{(z1-z)/(z0-z)}(z0-z)/(z1-z0),
其中,z0表示构成行驶路边界的线段的起点的复数,z1表示构成行驶路边界的线段的终点的复数,z表示求出位置所示的复数。
10.如权利要求7所述的车辆的行驶控制方法,其特征在于,
将所述折线信息各自的线段的中点选为狄利克雷边界条件的应用场所,应用替代电荷法得到所述线性结合的系数。
11.一种车辆的行驶控制装置,生成本车辆的行驶路径,根据所述行驶路径,控制转向装置、动力装置及制动装置的至少任一个,执行自动行驶控制,其特征在于,
所述行驶控制装置获取作为本车辆可行驶的道路区域的行驶路的、与左侧边界线相关的左侧行驶路边界信息和与右侧边界线相关的右侧行驶路边界信息,
在行驶路的空间内生成所述左侧行驶路边界信息的左侧边界线成为第一势值,且所述右侧行驶路边界信息的右侧边界线成为与所述第一势值不同的第二势值的势场,
修正所述第一势值和/或所述第二势值,以使以所述左侧边界线或右侧边界线为基准在所述行驶路内预先设定的行驶路径的横向位置与根据所述势场的势值确定的行驶路径的横向位置的差的绝对值成为规定值以下,
在行驶路的空间内生成所述左侧行驶路边界信息的左侧边界线成为修正后的第一势值,所述右侧行驶路边界信息的右侧边界线成为修正后的第二势值的、修正后的势场,
根据生成的修正后的势场的等势线生成本车辆行驶的行驶路径,
根据生成的行驶路径,执行所述本车辆的自动行驶控制。
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/IB2019/000064 WO2020152490A1 (ja) | 2019-01-22 | 2019-01-22 | 車両の走行制御方法及び走行制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113508064A CN113508064A (zh) | 2021-10-15 |
CN113508064B true CN113508064B (zh) | 2022-09-16 |
Family
ID=71735700
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201980089561.4A Active CN113508064B (zh) | 2019-01-22 | 2019-01-22 | 车辆的行驶控制方法及行驶控制装置 |
Country Status (6)
Country | Link |
---|---|
US (1) | US11370426B2 (zh) |
EP (1) | EP3915849B1 (zh) |
JP (1) | JPWO2020152490A1 (zh) |
CN (1) | CN113508064B (zh) |
RU (1) | RU2768692C1 (zh) |
WO (1) | WO2020152490A1 (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20220114750A (ko) * | 2021-02-09 | 2022-08-17 | 현대모비스 주식회사 | 차선 인식 시스템 및 제어 방법 |
JP7400912B1 (ja) | 2022-09-26 | 2023-12-19 | いすゞ自動車株式会社 | 自動運転装置 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102591332A (zh) * | 2011-01-13 | 2012-07-18 | 同济大学 | 用于无人驾驶汽车局部路径规划的装置及方法 |
JP2015016799A (ja) * | 2013-07-11 | 2015-01-29 | 株式会社日本自動車部品総合研究所 | 走行経路生成装置 |
JP2015232866A (ja) * | 2014-05-13 | 2015-12-24 | 株式会社日本自動車部品総合研究所 | 経路生成装置 |
CN105974917A (zh) * | 2016-05-11 | 2016-09-28 | 江苏大学 | 一种基于新型人工势场法的车辆避障路径规划研究方法 |
CN107161143A (zh) * | 2017-05-18 | 2017-09-15 | 江苏大学 | 一种采用人工势场法的车辆主动避撞方法 |
CN107933560A (zh) * | 2016-10-12 | 2018-04-20 | 本田技研工业株式会社 | 车辆控制装置 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5463971B2 (ja) | 2010-03-10 | 2014-04-09 | 日産自動車株式会社 | 移動体走行経路生成装置 |
US9542846B2 (en) * | 2011-02-28 | 2017-01-10 | GM Global Technology Operations LLC | Redundant lane sensing systems for fault-tolerant vehicular lateral controller |
US8996197B2 (en) * | 2013-06-20 | 2015-03-31 | Ford Global Technologies, Llc | Lane monitoring with electronic horizon |
DE102013013747A1 (de) * | 2013-08-21 | 2015-02-26 | GM Global Technology Operations, LLC (n.d. Ges. d. Staates Delaware) | Fahrassistenzsystem, Fahrzeug mit einem Fahrassistenzsystem und Verfahren zum Betrieb eines Fahrerassistenzsystems |
RU2660977C2 (ru) * | 2016-11-30 | 2018-07-11 | Общество С Ограниченной Ответственностью "Инновационный Центр Самоцвет" (Ооо "Иц Самоцвет") | Способ обеспечения курсовой устойчивости и безопасности автомобиля и устройство для его осуществления |
WO2018131090A1 (ja) * | 2017-01-11 | 2018-07-19 | 本田技研工業株式会社 | 車両制御装置、車両制御方法、および車両制御プログラム |
-
2019
- 2019-01-22 RU RU2021121578A patent/RU2768692C1/ru active
- 2019-01-22 CN CN201980089561.4A patent/CN113508064B/zh active Active
- 2019-01-22 US US17/424,309 patent/US11370426B2/en active Active
- 2019-01-22 WO PCT/IB2019/000064 patent/WO2020152490A1/ja active Application Filing
- 2019-01-22 JP JP2020567649A patent/JPWO2020152490A1/ja active Pending
- 2019-01-22 EP EP19910921.6A patent/EP3915849B1/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102591332A (zh) * | 2011-01-13 | 2012-07-18 | 同济大学 | 用于无人驾驶汽车局部路径规划的装置及方法 |
JP2015016799A (ja) * | 2013-07-11 | 2015-01-29 | 株式会社日本自動車部品総合研究所 | 走行経路生成装置 |
JP2015232866A (ja) * | 2014-05-13 | 2015-12-24 | 株式会社日本自動車部品総合研究所 | 経路生成装置 |
CN105974917A (zh) * | 2016-05-11 | 2016-09-28 | 江苏大学 | 一种基于新型人工势场法的车辆避障路径规划研究方法 |
CN107933560A (zh) * | 2016-10-12 | 2018-04-20 | 本田技研工业株式会社 | 车辆控制装置 |
CN107161143A (zh) * | 2017-05-18 | 2017-09-15 | 江苏大学 | 一种采用人工势场法的车辆主动避撞方法 |
Also Published As
Publication number | Publication date |
---|---|
EP3915849A1 (en) | 2021-12-01 |
JPWO2020152490A1 (zh) | 2020-07-30 |
US11370426B2 (en) | 2022-06-28 |
EP3915849A4 (en) | 2022-02-09 |
CN113508064A (zh) | 2021-10-15 |
US20220080964A1 (en) | 2022-03-17 |
RU2768692C1 (ru) | 2022-03-24 |
EP3915849B1 (en) | 2024-03-13 |
WO2020152490A1 (ja) | 2020-07-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3358302B1 (en) | Travel control method and travel control device | |
US9074906B2 (en) | Road shape recognition device | |
CN103718225B (zh) | 行驶辅助装置以及行驶辅助方法 | |
CN109070887B (zh) | 车辆控制***、车辆控制方法及存储介质 | |
JP6601696B2 (ja) | 予測装置、予測方法、およびプログラム | |
CN110121450B (zh) | 车辆控制***、车辆控制方法及存储介质 | |
CN111442776A (zh) | 顺序地面场景图像投影合成与复杂场景重构的方法及设备 | |
RU2735720C1 (ru) | Способ оценки транспортного средства, способ корректировки маршрута движения, устройство оценки транспортного средства и устройство корректировки маршрута движения | |
US20140330485A1 (en) | Method for detecting an imminent rollover of a vehicle | |
CN102398598A (zh) | 使用前视和后视摄像机的车道融合*** | |
WO2018142560A1 (ja) | 車両制御システム、車両制御方法、および車両制御プログラム | |
JP2019034627A (ja) | 車両制御装置、車両制御方法、およびプログラム。 | |
CN113508064B (zh) | 车辆的行驶控制方法及行驶控制装置 | |
WO2018230530A1 (ja) | 車両制御システム、車両制御方法、およびプログラム | |
WO2018142562A1 (ja) | 車両制御システム、車両制御方法、および車両制御プログラム | |
Moras et al. | Drivable space characterization using automotive lidar and georeferenced map information | |
JP7034726B2 (ja) | 車両制御装置 | |
Nie et al. | Camera and lidar fusion for road intersection detection | |
CN113178091B (zh) | 安全行驶区域方法、装置和网络设备 | |
CN110770065B (zh) | 驾驶辅助车辆的目标车速生成方法以及目标车速生成装置 | |
JP2015036842A (ja) | 走行可否判定装置 | |
CN110194153B (zh) | 车辆控制装置、车辆控制方法及存储介质 | |
JP2009217491A (ja) | 移動支援装置、移動体、領域設定方法 | |
CN114599567A (zh) | 车载集群跟踪*** | |
EP3330893A1 (en) | Information processing device, information processing method, and carrier means |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |