CN103781685A - 车辆用自主行驶控制系统 - Google Patents

车辆用自主行驶控制系统 Download PDF

Info

Publication number
CN103781685A
CN103781685A CN201280041406.3A CN201280041406A CN103781685A CN 103781685 A CN103781685 A CN 103781685A CN 201280041406 A CN201280041406 A CN 201280041406A CN 103781685 A CN103781685 A CN 103781685A
Authority
CN
China
Prior art keywords
mentioned
vehicle
target object
travelling
hiding
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
CN201280041406.3A
Other languages
English (en)
Other versions
CN103781685B (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.)
Nissan Motor Co Ltd
Original Assignee
Nissan Motor 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 Nissan Motor Co Ltd filed Critical Nissan Motor Co Ltd
Publication of CN103781685A publication Critical patent/CN103781685A/zh
Application granted granted Critical
Publication of CN103781685B publication Critical patent/CN103781685B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • 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
    • B60W30/00Purposes 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/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/09Taking automatic action to avoid collision, e.g. braking and steering
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0223Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
    • 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
    • B60W2554/00Input parameters relating to objects
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404Characteristics
    • B60W2554/4041Position
    • 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
    • B60W2554/00Input parameters relating to objects
    • B60W2554/80Spatial relation or speed relative to objects
    • B60W2554/801Lateral distance
    • 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
    • B60W2554/00Input parameters relating to objects
    • B60W2554/80Spatial relation or speed relative to objects
    • B60W2554/804Relative longitudinal speed
    • 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
    • B60W2556/00Input parameters relating to data
    • B60W2556/20Data confidence level
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • G08G1/165Anti-collision systems for passive traffic, e.g. including static obstacles, trees
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • G08G1/166Anti-collision systems for active traffic, e.g. moving vehicles, pedestrians, bikes

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Mechanical Engineering (AREA)
  • Transportation (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Navigation (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

基于由车辆信息获取部(11)获取到的本车辆的信息和由躲避对象物体检测部(12)检测出的躲避对象物体的距离以及角度,用周围信息识别部(13)计算出躲避对象物体的位置以及移动量,用行驶方案决定部(14)判断躲避对象物体的位置及移动量的计算精度,基于躲避对象物体的位置及移动量的计算精度来决定对躲避对象物体进行躲避的行驶方案,按照所决定的行驶方案来实施自主行驶控制。

Description

车辆用自主行驶控制系统
技术领域
本发明涉及决定本车辆应该行驶的路径并进行自主行驶控制的车辆用自主行驶控制系统。
背景技术
作为相关技术,例如已知一种日本专利公开公报日本特开平8-287395号所记载的技术(专利文献1)。在该文献中记载了如下一种技术:当一边感测本车的行进方向的实际的道路状况一边进行自动行驶的控制时,使当前位置的精度和行驶控制的精度相关地提高,从而高精度地进行自动行驶的控制。
发明内容
发明要解决的问题
在上述相关的行驶引导装置中,当通过决定躲避障碍物的躲避路径来决定行驶路径时,没有反映考虑障碍物的检测精度。因此,所决定的行驶路径不适于行驶中的本车辆,可能导致难以进行行驶引导的机会增加之类的问题。
本发明是鉴于上述问题而完成的,根据本发明,能够提供如下一种车辆用自主行驶控制系统:能够增加可进行自主行驶控制的机会,并且能够进行适于行驶环境的自主行驶控制。
用于解决问题的方案
根据本发明的技术的侧面,车辆用自主行驶控制系统的特征在于,
对本车辆以及存在于上述本车辆的周围的躲避对象物体的位置进行检测,来决定向目的地进行移动时应该行驶的路径并进行自主行驶控制,基于上述本车辆与上述躲避对象物体的距离以及上述躲避对象物体的位置和移动量的计算精度的高低,来决定躲避上述躲避对象物体时的行驶方案。
附图说明
图1是表示本发明的第一实施方式所涉及的车辆用自主行驶控制系统的结构的图。
图2是表示本发明的第一实施方式所涉及的行驶控制的处理的过程的流程图。
图3是表示本发明的第一实施方式所涉及的行驶方案的图。
图4是表示本发明的第一实施方式所涉及的实施行驶方案4时的本车辆周边环境的一例的图。
图5是表示本发明的第一实施方式所涉及的实施行驶方案3时的本车辆周边环境的一例的图。
图6是表示本发明的第一实施方式所涉及的实施行驶方案2时的本车辆周边环境的一例的图。
图7是表示本发明的第一实施方式所涉及的实施行驶方案1时的本车辆周边环境的一例的图。
图8是表示实施行驶方案3的系统结构的图。
图9是表示实施行驶方案1的系统结构的图。
图10是表示由实施行驶方案的硬件构成的系统结构的图。
图11是表示对实施行驶方案的系统结构进行变更时的躲避路径的匹配性的图。
图12是表示本发明的第二实施方式所涉及的车辆用自主行驶控制系统的结构的图。
图13是表示本发明的第二实施方式所涉及的行驶控制的处理的过程的流程图。
图14是表示本车辆的位置检测精度的估计方法的图。
图15是表示本发明的第二实施方式所涉及的行驶方案的图。
图16是表示基于本车辆位置的检测精度的直到目的地为止的路径的差异的图。
具体实施方式
下面,使用附图来说明用于实施本发明的实施方式。
(第一实施方式)
图1是表示本发明的第一实施方式所涉及的车辆用自主行驶控制系统的结构的图。图1所示的第一实施方式的系统对存在于本车辆的周围的躲避对象物体(包括行驶车辆)进行检测,并且识别其相对位置和相对移动量。在识别后,系统选择能够执行与该识别水平相应的行驶方案的系统,来进行对躲避对象物体的躲避。作为用于实现这种功能的结构,系统如图1所示那样具备车辆信息获取部11、躲避对象物体检测部12、周围信息识别部13、行驶方案决定部14以及控制指令值决定部15。行驶方案决定部14具备系统动作水平判断部16和系统结构数据库17。系统动作水平判断部16具备识别状态判断部18,系统结构数据库17具备行驶方案存储部19。
利用具备基于程序来控制各种动作处理的计算机所需的CPU、存储装置、输入输出装置等资源的例如微型计算机等来实现系统。系统读入上述车辆信息、来自检测躲避对象物体的传感器类的信号,基于所读入的各种信号和预先保持在内部的控制逻辑(程序)来决定行驶方案并进行自主行驶控制。
系统在上述结构中对存在于本车辆的周围的躲避对象物体的相对位置和相对移动量进行识别,由此获知对本车辆的行驶上的危险程度,在进行适于实际的行驶场景的躲避控制的情况下,进行如下的行驶控制。在系统中存储安装有获取车辆信息的程序、检测存在于本车辆的周围的躲避对象物体的程序以及识别本车辆的路线和躲避对象物体的移动量的程序。另外,在系统中存储安装有决定行驶方案的程序和决定进行车辆的躲避控制的控制指令值的程序。利用以计算机的CPU为中心的硬件来执行处理这种程序,由此实现上述各部的功能。即,计算机的软件和硬件资源相协作来实现由本系统实施的自主行驶控制。
车辆信息获取部11至少获取本车辆的位置、速度、转向角。躲避对象物体检测部12根据存在于本车辆的周围的物体来检测躲避对象物体,对所检测出的躲避对象物体与本车辆的距离以及角度进行检测。
周围信息识别部13识别本车辆能够行使的路线。周围信息识别部13基于由车辆信息获取部11获取到的上述本车辆的位置以及由躲避对象物体检测部12检测出的躲避对象物体与本车辆的距离和角度,来计算躲避对象物体相对于本车辆的位置。周围信息识别部13基于计算出的躲避对象物体的位置以及由车辆信息获取部11获取到的本车辆的速度和转向角来计算本车辆的移动量。周围信息识别部13基于计算出的躲避对象物体的位置和计算出的本车辆的移动量来计算躲避对象物体的移动量。
行驶方案决定部14基于本车辆和躲避对象物体的距离与距离阈值的比较结果以及是否直接获取躲避对象物体的位置,来判断躲避对象物体的位置的计算精度。上述距离阈值被预先设定为判断躲避对象物体的位置的计算精度的高低时的判断值。行驶方案决定部14基于躲避对象物体的位置及本车辆的移动量的计算精度来判断躲避对象物体的移动量的计算精度。行驶方案决定部14基于躲避对象物体的位置及移动量的计算精度来决定表示对躲避对象物体进行躲避时的行驶控制的行驶方案。
行驶方案决定部14具备系统动作水平判断部16和系统结构数据库17。系统动作水平判断部16基于躲避对象物体的位置的计算精度及移动量的计算精度来判断并决定实施自主行驶控制的系统结构。
系统动作水平判断部16具备判断躲避对象物体的识别状态的识别状态判断部18。在直接获取到躲避对象物体的位置的情况下以及检测出躲避对象物体与本车辆的距离为上述距离阈值以下的情况下,识别状态判断部18判断为以高精度计算出躲避对象物体的位置。在没有直接获取到躲避对象物体的位置且检测出躲避对象物体与本车辆的距离为距离阈值以上的情况下,识别状态判断部18判断为以低精度计算出躲避对象物体的位置。
识别状态判断部18在判断为以高精度计算出躲避对象物体的位置及本车辆的移动量的情况下,判断为以高精度计算出躲避对象物体的移动量。识别状态判断部18在判断为躲避对象物体的位置和本车辆的移动量的计算精度中的至少一方的精度为低精度的情况下,判断为以低精度计算出躲避对象物体的移动量。在本车辆不是在易滑的路面上行驶的情况下,识别状态判断部18判断为以高精度检测出本车辆的移动量,在本车辆在易滑的路面上行驶的情况下,识别状态判断部18判断为以低精度检测出本车辆的移动量。
系统结构数据库17具备行驶方案存储部19,该行驶方案存储部19至少存储安装有与躲避对象物体的位置及移动量的计算精度相应的行驶方案。
行驶方案存储部19至少存储安装有与躲避对象物体的位置及移动量的计算精度相应的行驶方案。行驶方案存储部19存储安装有如下的行驶方案:基于躲避对象物体的移动量的识别状态,在作为规定的碰撞时间(TTC)和车间时距(THW)的定时对躲避对象物体进行躲避。
控制指令值决定部15决定控制本车辆的控制指令值并进行输出,使得在本车辆中实施与由行驶方案决定部14决定的行驶方案相应的自主行驶控制。关于控制指令值决定部15,在对由行驶方案决定部14决定的行驶方案进行变更时,在与变更后的作为候选的多个行驶方案分别对应的控制指令值中存在如下包含与变更前实施的行驶方案所对应的控制指令值中包含的本车辆的移动矢量相同的移动矢量的控制指令值的情况下,变更后的控制指令值选择包含与变更前相同的本车辆的移动矢量的控制指令值。
接着,参照图2的流程图来说明该第一实施方式所涉及的自主行驶控制的过程。在图2中,步骤S101~步骤S102所示的处理对应于获取本车辆的车辆信息的动作和检测存在于本车辆的周围的物体的动作。步骤S103~步骤S104所示的处理对应于识别本车辆的周围信息的动作。步骤S105~步骤S108所示的处理对应于以下动作:判断本车辆的周围信息的识别水平,选择并决定要实施的行驶方案,构成能够实现该行驶方案的系统。步骤S109所示的处理对应于以下动作:基于由所构成的系统计算出的控制指令值来决定用于最终控制本车辆的控制指令值。
在此,作为具体的例子,说明为了采用基于躲避对象物体的识别水平的躲避控制来实现其躲避控制而构成系统的动作。在图2中,首先获取本车辆的车辆信息(步骤S101)。作为所获取的本车辆的信息,设为本车辆的位置、速度、转向角。利用设置于本车辆的GPS(Global Positioning System:全球定位系统)和陀螺仪传感器来获取本车辆的位置。利用设置于本车辆的车速传感器来获取本车辆的速度。从设置于本车辆的转向编码器获取本车辆的转向角。
接着,检测存在于本车辆的周围的物体(步骤S102)。为了进行物体的检测,使用了已知的雷达的测距、用车载摄像头拍摄到的车辆周边的图像的分析处理是有效的。这两者都是对存在于周围的物体进行扫描并检测的机械装置。另外,在本车辆以及其它车辆中装载有高速、低延迟的无线通信设备的情况下,能够通过互相通信大致以高精度识别彼此的位置。因此,能够对存在于周围的物体进行检测,并且还能够检测比较远距离的物体。此外,作为在此获得的信息,至少是到物体为止的距离信息和角度信息。另外,例如在利用摄像头进行检测的情况下,能够从由摄像头拍摄到的图像上获得物体的特征点、浓淡信息、纹理信息等,因此能够有效用于后述的躲避对象物体的识别。
接着,对存在于本车辆周围的躲避对象物体进行识别(步骤S103)。例如,能够考虑如下的例子。在使用了扫描型的雷达的情况下,能够获得存在于本车辆的周围的躲避对象物体的相对距离信息和相对角度信息。通过使用这些信息来计算躲避对象物体相对于本车辆的相对坐标(相对位置)。并且,根据本车辆的速度和转向角来计算本车辆的移动量。通过从躲避对象物体的相对坐标减去本车辆的移动量来计算出躲避对象物体的相对移动量,从而识别躲避对象物体的相对移动量。
另一方面,在有效地利用摄像头的情况下,对图像的特征点的移动(光流:optic flow)的尺寸进行计算,通过考虑本车辆的移动量来计算躲避对象物体的相对移动量,从而识别躲避对象物体的相对移动量。并且,通过有效地利用图像信息、浓淡信息来检测躲避对象物体的形状,判断该躲避对象物体的类型(车辆、人、护栏等道路设施)。
接着,对本车辆能够行驶的路线进行识别(步骤S104)。至少需要的路线信息是车道信息,能够有效地利用摄像头来进行车道的识别。例如,在能够识别车道的情况下,设为能够识别路线,在不能识别车道的情况下,设为不能识别路线。另外,能够有效地利用由车载导航系统得到的信息中的本车辆位置的映射功能。例如,在本车辆被映射到道路上的情况下,设为能够识别路线,在本车辆未被映射到道路上的情况下,设为不能识别路线。
接着,判断本车辆的周围信息的识别水平(步骤S105)。周围信息是指躲避对象物体的信息和路线的信息。特别是如下那样考虑躲避对象物体的识别水平。具有以下情况:从本车辆看来躲避对象物体近距离地存在、远距离地存在。在此,关于近距离和远距离的定义,例如能够预先设定为系统的设计项目。例如在作为检测躲避对象物体的雷达的分辨率存在30[m]~60[m]范围和100[m]~200[m]范围的情况下,作为区分近距离和远距离的阈值(距离阈值),例如能够设定为60m~100m左右的范围内的值。
在物体近距离地存在的情况下,所检测的物体的尺寸大,并且获得准确(精度高)的测距结果。相反地,在物体远距离地存在的情况下,所检测的物体的尺寸小,并且大多获得包含大的误差(精度低)的测距结果。因此,在物体近距离地存在的情况下也能够准确地计算物体的移动量,另一方面在物体远距离地存在的情况下,大多不能以与近距离时相同的精度来准确地计算物体的移动量。
但是,在能够有效地利用无线通信的情况下,能够直接获取各车辆的信息,因此即使对于远距离地存在的物体,也能够准确地获取相对位置、相对移动量。另外,对于本车辆的移动量,根据周边环境不同而精度也不同。例如存在以下情况:在易滑的路面上,实际的车速与由车速传感器得到的信息不同。在该情况下,通过有效地利用以装载于车辆的滑动传感器来检测滑动状态的方法、与使用GPS得到的车速相比较的方法,来估计车速的检测精度。对于转向角,也可能产生同样的状况,因此与车速的情况同样地估计转向角的检测精度。
接着,能够判断周围信息的识别水平(识别状态),判定是否能够决定行驶方案(步骤S106)。在判定的结果为能够判断周围信息的识别水平、能够决定行驶方案的情况下,基于周围信息的识别水平来决定行驶方案(步骤S107)。另一方面,在不能判断周围信息的识别水平或者不能决定行驶方案的情况下,判断为难以利用本系统进行该程度以上的自主行驶控制。在该情况下,进行请驾驶员自己进行驾驶操作的意思的信息提示(步骤S112)。
接着,说明基于周围信息的识别水平来决定行驶方案的方法。在系统结构数据库17中,与需要的识别水平相对应地预先存储安装有如图3所示的行驶方案1~4以及能够实现这些行驶方案1~4的系统结构。对系统结构设定了与实现行驶方案所需的感知、识别、控制的各功能块有关的各详细功能及其连接关系进行设定。
在此,为了简化说明易于理解,对使用了实际应用毫米波雷达等的车载用雷达时的躲避对象物体的识别进行说明。根据躲避对象物体的识别水平(相对位置的检测精度、相对移动量的计算精度)来定义行驶方案1~4。行驶方案1~4是基于躲避对象物体的移动量的识别状态,在作为与各个行驶方案1~4相应地预先设定的规定的碰撞时间(TTC)和车间时距(THW)的定时对躲避对象物体进行躲避。关于详细情况如下那样。
在此,例如能够如下面那样判断躲避对象物体的识别水平(相对位置的计算精度、相对移动量的计算精度)的高低。关于躲避对象物体的位置的计算精度,首先判断是否通过在本车辆与躲避对象物体之间进行通信而直接获取到躲避对象物体的位置。在直接获取到躲避对象物体的位置的情况下,判断为以高精度计算出躲避对象物体的位置。
另一方面,在不是直接获取到躲避对象物体的位置的情况下,将被预先设定为判断躲避对象物体的计算精度的高低时的判断值的距离阈值与本车辆和躲避对象物体的距离进行比较。在比较结果为本车辆与躲避对象物体的距离为距离阈值以下的情况下,判断为以高精度计算出躲避对象物体的位置。另一方面,在比较结果为本车辆与躲避对象物体的距离为距离阈值以上的情况下,判断为以低精度计算出躲避对象物体的位置。上述距离阈值被设定为本车辆与躲避对象物体的距离中的用于区分近距离和远距离的值,例如被设定为60m~100m左右的范围内的值。
关于躲避对象物体的移动量的计算精度,首先在判断为以高精度计算出躲避对象物体的位置及本车辆的移动量的情况下,判断为以高精度计算出躲避对象物体的移动量。另一方面,在判断为躲避对象物体的位置及本车辆的移动量的计算精度中的至少一方或者双方的精度为低精度的情况下,判断为以低精度计算出躲避对象物体的移动量。
接着,例如能够如下面那样判断本车辆的移动量的计算精度的高低。在利用滑动传感器等辨别为本车辆在易滑的路面上行驶的情况下,大多存在以下情况,即由车速传感器、转向编码器获取到的车速、转向角与实际的值不同。因而,在这种情况下,判断为根据车速和转向角计算的本车辆的移动量是以低精度计算出的。另一方面,在辨别为本车辆不是在易滑的路面上行驶的情况下,由车速传感器、转向编码器获取到的车速、转向角与实际的值大致一致。因而,在这种情况下,判断为根据车速和转向角计算的本车辆的移动量是以高精度计算出的。
如图4所示,如果将相对于本车辆的躲避对象物体设为在本车辆的前方行驶的第一车辆和第二车辆,则在躲避对象物体的识别水平(相对位置的检测精度、相对移动量的计算精度)为最高水平的情况下,执行反映考虑了物体存在的相对位置和相对移动量的行驶方案4。即,执行如下行驶控制:设为所有物体分别以所检测出的速度进行移动并躲避这些物体。在此,所谓躲避对象物体的识别水平为最高水平,是从近距离到远距离的过程中以高精度检测出躲避对象物体的相对位置和相对移动量的情况。通过执行行驶方案4来进行与物体的相对位置和相对移动量相应的恰当的躲避,因此能够一边防止过小、过大的躲避量一边实现安全的行驶。
如图5所示,在判断为针对远距离地存在的躲避对象物体以低精度计算出移动量的情况下,执行图3所示的行驶方案3。该行驶方案3是针对近距离地存在的物体反映考虑了其相对位置和相对移动量的行驶方案。另一方面,针对存在于远方的物体,进行仅反映考虑其相对位置、假定为静止物体来进行躲避控制。对于远方的物体,距本车辆的相对距离长,到碰撞为止要花费时间,因此只要预先识别为静止物体就能够躲避。即使假设以大的相对速度向本车辆靠近,也能够在经过规定的时间后相对距离缩短时作为近距离地存在的物体来进行躲避控制。
如图6所示,在针对远距离地存在的物体以低精度计算出相对位置和相对移动量、针对近距离地存在的物体以高精度计算出相对位置和相对移动量的情况下,执行图3所示的行驶方案2。该行驶方案2是针对近距离地存在的物体反映考虑了其相对位置和相对移动量的行驶方案。在该情况下,未以高精度计算出存在于远方的物体的相对位置和相对移动量。因而,如果反映考虑存在于远方的物体的相对位置和相对移动量,则本车辆的移动范围受限制的可能性高,因此不会对存在于远方的物体进行躲避行为。
如图7所示,在针对近距离地存在的物体仅相对位置以高精度计算出的情况下,执行图3所示的行驶方案1。该行驶方案1是针对近距离地存在的物体反映考虑了其相对位置的行驶方案,但没有以高精度计算出其移动量,因此不能决定恰当的躲避量。因此,在该行驶方案1中,针对近距离地存在的物体,作为以预先规定的相对速度靠近的靠近物体来进行躲避。在此,所谓规定的相对速度,例如设为本车辆的速度的2倍。通过这样规定,假设在近距离地存在的物体为静止物体的情况下,也能够使碰撞时间变为原来的2倍,即使在物体以相同的速度靠近的情况下,也能够设为恰当的碰撞时间。
返回到图2,在如上述那样决定行驶方案之后,决定能够实现所决定的行驶方案的系统结构(步骤S108)。如之前提及的那样,在系统结构数据库17中存储安装有感知、识别、控制各功能块的各详细功能及其连接关系,来作为能够实现行驶方案的系统结构。例如在如上述那样检测物体时仅使用了雷达的情况下,实现在图2所示的步骤S107中说明的第一~行驶方案4的系统结构以如下那样的功能块及其连接关系来构成。此外,在图8中表示实现行驶方案3的系统结构例,在图9中表示实现行驶方案1的系统结构例。在两个图中,用虚线示出的部分是作为系统结构整体而被配置,但却是在构成实现所对应的行驶方案的系统上不利用的功能块和连接关系。
在图9所示的实现行驶方案1的系统结构中,感知的功能块31具备利用雷达检测物体的功能,识别的功能块32具备相对位置的识别功能。另外,控制的功能块33针对近距离具备生成假定物体以规定速度靠近时的路径及躲避控制的功能。
在实现行驶方案2的系统结构中,感知的功能块具备利用雷达检测物体的功能,识别的功能块具备相对位置的识别功能和相对速度的识别功能。另外,控制的功能块针对近距离具备生成考虑反映了物体的移动量的路径及躲避控制的功能。
在图8所示的实现行驶方案3的系统结构中,感知的功能块31具备利用雷达检测物体的功能,识别的功能块32具备相对位置的识别功能和相对速度的识别功能。另外,控制的功能块33具备在近距离的情况下生成考虑了物体的移动量的路径及躲避控制的功能、在远距离的情况下生成假定为静止物体的路径、躲避控制的功能。
在实现行驶方案4的系统结构中,感知的功能块具备利用雷达检测物体的功能,识别的功能块具备相对位置的识别功能和相对速度的识别功能。另外,控制的功能块在近距离和远距离的情况下均具备生成考虑了物体的移动量的路径及躲避控制的功能。
返回到图2,在如上述那样决定系统结构之后,随着行驶方案的变更进行系统的重建(步骤S109)。在以软件形式安装了各功能块的功能的情况下,进行所要使用的功能块的选择和各功能块间的变量的移动目的地的变更。
例如,在行驶方案3中,利用雷达检测物体,根据其检测结果来进一步识别物体的相对位置和相对移动量。构成能够进行如下躲避控制的结构:针对物体的移动量的计算精度高的近距离的物体,进行考虑了物体的移动量的躲避控制,针对物体的移动量的计算精度低的远距离的物体进行假定为静止物体的躲避控制。之后,在下一个控制周期中从行驶方案3转移到行驶方案1的情况下,利用雷达检测物体的方式不变。但是,在计算出物体的相对位置和相对移动量之后,针对近距离的物体仅识别出物体的相对位置,因此在假定物体以规定速度靠近并进行躲避控制的系统中重建系统。
此外,通过硬件的切换还能够切换各功能块的连接关系。例如图10所示,预先用硬件构成感知的功能块31、识别的功能块32、控制的功能块33并将它们相连接。利用软件来实现控制它们的功能块,并进行软件的切换,由此能够进行系统的重建。
接着,在对本车辆进行自主行驶控制之后,有时由于系统结构的变更而产生各行驶方案下的控制指令值的不匹配。因此,需要在考虑上一次的控制指令值之后决定本次的控制指令值。因此,在之前的步骤S109中进行系统的重建之后,判定作为控制指令值是否存在解(步骤S110)。
作为判定方法,例如能够考虑使上一次的控制指令值中的本车辆的移动矢量(表示本车辆的速度和方向)与本次的控制指令值中的移动矢量内的速度和方向双方或者某一方匹配等的处理。在图11中示出了从行驶方案3转移到行驶方案1时的控制指令值的变更例。在图11的(a)所示的上一次的控制周期中采用了行驶方案3,在本车辆行进方向右侧设定了躲避路径。在这种状况下,在图11的(b)所示的本次的控制周期中,不反映考虑存在处于远距离的第二车辆而采用行驶方案1。在这种情况下,在变更后的行驶方案1中,在本车辆的行进方向左右存在两条躲避路径。在此,将上一次的躲避路径设定在了本车辆行进方向右侧,因此为了获得与该躲避路径的匹配性,在本次也选择右侧的躲避路径。
在像这样地决定躲避路径并获得了作为控制指令值的解的情况下,输出本车辆的速度、转角等控制行驶的控制指令值,使得本车辆能够在所决定的躲避路径自主行驶(步骤S111)。另一方面,在不能获得作为控制指令值的解的情况下,进行请驾驶员进行驾驶操作的意思的信息提示(S112)。此外,在存在多个物体的行驶环境中,实现能够使上述处理(行驶方案)相配合的系统结构,实现适于该行驶场景的行驶控制。
如以上说明那样,在该第一实施方式中,对存在于本车辆的周围的躲避对象物体进行检测,并且识别其相对位置和相对移动量,基于其识别水平来进行对躲避对象物体进行躲避的自主行驶控制。由此,除了能够扩大可进行躲避控制的场景以外,还能够进行适于该场景的躲避控制。
对存在于本车辆的周围的物体进行感知、识别,进行采用了躲避对象物体的移动量的识别状态的有无及其精度的自主行驶控制,由此能够抑制由于感知、识别的精度不足而不能进行自主行驶控制的情况。
对由感知、识别、控制各功能块构成的系统的组合进行变更,由此能够与感知、识别的精度相应地选择能够保证系统的成立性的系统结构。
对基于躲避对象物体的位置的精度和移动量的精度的行驶方案进行定义,因此能够防止系统的过度复杂化并且能够保证行驶中的安全。
基于躲避对象物体的移动量的识别状态,在作为规定的碰撞时间和车间时距的定时进行躲避,因此能够保证获得固定的安全裕度的行驶。
在判断为离本车辆近的距离处检测到躲避对象物体、以低精度计算出移动量的情况下,将躲避对象物体识别为以规定速度靠近的靠近物体来进行躲避,因此能够保证与实际相比获得更大的安全裕度的行驶。
在判断为本车辆的远方检测到躲避对象物体、以低精度计算出移动量的情况下,将躲避对象物体识别为静止物体来进行躲避,因此能够防止对碰撞危险性低的躲避对象物体进行紧急躲避。
当切换各行驶方案时,输出具有与切换前输出的控制指令值相同的移动矢量的控制指令值,由此能够抑制由系统结构的变更引起的自主行驶控制的不适感。
(第二实施方式)
图12是表示本发明的第二实施方式所涉及的车辆用自主行驶控制系统的结构的图。在第二实施方式中,与之前的第一实施方式的不同点在于,代替行驶方案决定部14而具备新的行驶方案决定部20。该行驶方案决定部20具备新的系统动作水平判断部21来代替在第一实施方式中采用的系统动作水平判断部16。系统动作水平判断部21构成为除了具备与第一实施方式相同的识别状态判断部18以外还具备本车辆位置精度判断部22。除了这些结构以外,与之前的第一实施方式相同,因此省略相同的部分的说明。
行驶方案决定部20除了具备在之前的第一实施方式中采用的行驶方案决定部14所具备的功能以外,还基于由本车辆位置精度判断部22判断出的本车辆的位置的检测精度来决定包括到规定的目的地为止的行驶控制在内的行驶方案。
系统动作水平判断部21除了具备与之前的第一实施方式相同的识别状态判断部18以外还具备本车辆位置精度判断部22。系统动作水平判断部21除了具备系统动作水平判断部16所具备的功能以外,还对由本车辆位置精度判断部22利用GPS等检测出的本车辆的位置的检测精度进行判断。
在以第一阈值的量级检测到本车辆的位置的情况下,本车辆位置精度判断部22判断为以高精度检测出本车辆的位置,该第一阈值被预先设定为判断本车辆的位置的检测精度的高低时的判断值。在以第二阈值的量级检测到本车辆的位置的情况下,本车辆位置精度判断部22判断为以低精度检测出本车辆的位置,该第二阈值被预先设定为判断本车辆的位置的检测精度的高低时的判断值。在此,第一阈值的量级例如能够设定为检测值为数cm左右的量级,第二阈值的量级例如能够设定为检测值为数m左右的量级。
接着,参照图13所示的流程图来说明该第二实施方式的自主行驶控制的过程。此外,关于图13的流程图所示的过程,对之前的图2的流程图所示的过程添加了步骤S201~S203的处理,省略与图2重复的步骤S101~S112的说明。步骤S201~S202所示的处理是进行估计本车辆的位置的检测精度并判断其精度的动作。步骤S203所示的处理进行基于周围信息的识别水平和本车辆的位置的检测精度来决定行驶方案的动作。在此,作为具体的例子,对以下动作进行说明:为了采用使基于本车辆的位置的检测精度、躲避对象物体的识别水平的躲避与向目的地的移动相配合的控制来实现其控制,对系统进行重建。
在图2中,作为在步骤S101中获取到的车辆信息之一,对本车辆的位置进行检测,此时估计检测精度(步骤S201)。例如,在用GPS检测本车辆的位置的情况下,能够获取捕捉到的卫星数的信息。根据该信息来估计当前检测出的本车辆的位置的精度。即,估计为所捕捉到的卫星数越多检测精度越高。另一方面,在行驶中没有发生滑动的情况下,将对上一次检测时的本车辆的位置追加本车辆的移动量和转向角而得到的结果与当前检测出的本车辆的位置进行比较。由此,估计出本车辆的位置的检测精度。例如图14所示,相对于上一次的控制周期(该图的(a))中的本车辆的位置来检测本次的控制周期(该图的(b))的本车辆的位置。在该本车辆的位置检测中,估计为追加了本车辆的移动量和转向角而得到的位置与利用雷达等实际检测到的位置的偏差越小,则检测精度越高。
当估计出本车辆的位置检测的精度时,接着与第一实施方式同样地执行步骤S102~S105所示的处理,对本车辆周围的路线和躲避对象物体进行识别,并判断周围信息的识别水平。
接着,判断本车辆的位置的检测精度(步骤S202)。关于判断,针对在之前的步骤S201中估计出的检测精度例如至少设定以下所示的两个检测水平。在本车辆的位置的检测值例如为数m左右的量级的精度的情况下,将检测精度设为低精度的检测水平(水平1),例如在本车辆的位置的检测值为数cm左右的量级的精度的情况下,将检测精度设为高精度的检测水平(水平2)。另外,也可以进一步对低精度的检测水平(水平1)进行细化。例如,在不能检测本车辆的位置,通过使用了车速传感器、陀螺仪传感器、导航系统中的地图匹配的补充运算来估计本车辆的位置的情况下,检测精度为更低的精度且设为比水平1的精度低的水平0。
接着,在利用步骤S106所示的判定结果能够判断周围信息的识别水平、能够决定行驶方案的情况下,基于周围信息的识别水平和本车辆的位置的检测精度来决定行驶方案(步骤S203)。
在系统结构数据库17中,与需要的识别水平和本车辆的位置的检测精度相对应地预先存储安装有如图15所示的行驶方案1-1~4-2以及能够实现这些行驶方案1~4的系统结构。相对于之前的第一实施方式,反映考虑本车辆的位置的检测精度来构成该第二实施方式的系统结构数据库17。即,在图15中,行驶方案1-1、2-1、3-1、4-1与之前的图3所示的行驶方案1、2、3、4相同,是对躲避对象物体进行躲避的行驶控制。因而,在除行驶方案1-1以外的行驶方案下执行将向目的地的移动与对物体的躲避整合的行驶控制。另外,行驶方案1-2、2-2、3-3、4-4是除了之前的图3所示行驶方案1、2、3、4以外还包括生成到目的地为止的移动路径的行驶方案。
在本车辆的位置的检测精度高的情况下,本车辆的位置的可靠性高,因此例如能够在如图16的(a)所示那样移动到规定的目的地时高精度地生成到目的地为止的路径并进行移动。此时,即使在存在躲避对象物体的情况下,也能够一边恰当地对躲避对象物体进行躲避一边向目的地移动。因而,在本车辆的位置的检测精度高的情况下,设为在一边对躲避对象物体进行躲避一边向目的地进行移动时将这两种行驶控制进行整合的行驶方案。
另一方面,在本车辆的位置的检测精度低的情况下,本车辆的位置的可靠性低,因此例如即使在如图16的(b)所示那样移动到规定的目的地时生成要进行移动的路径,能够按该路径移动的可能性也低。即,这是由于在当前时刻的本车辆的位置不准确的情况下,即使生成了到目的地为止的路径,该路径也不准确,作为结果有可能生成了错误的控制指令值。因此,在本车辆的位置的检测精度低的情况下,设为仅进行对躲避对象物体的躲避控制的行驶方案。此外,在行驶中本车辆的位置的检测精度从低精度转变为高精度的情况下,变更为将躲避对象物体的躲避与向目的地的移动这两种控制进行整合的行驶方案。
接着,在对能够实现与第一实施方式同样地决定的行驶方案的系统结构进行决定、重建之后,输出控制车辆的控制指令值,由此进行实现所决定的行驶方案的自主行驶控制。另一方面,在不能决定行驶方案、得不到作为控制指令值的解的情况下,进行请驾驶员进行驾驶操作的意思的信息提示。
如以上说明那样,在该第二实施方式中,在高精度地检测出本车辆的位置的情况下,生成包括躲避对象物体的躲避在内的向目的地的移动路径,在低精度地检测出本车辆的位置的情况下,仅进行躲避对象物体的躲避。由此,除了在之前的实施例1中得到的效果以外,还能够一边可靠地对躲避对象物体进行躲避,一边安全地移到到目的地。
在不能高精度地检测出本车辆的位置的情况下,暂时切换为仅对躲避对象物体进行躲避的行驶控制,因此在本车辆的位置精度模糊的情况下,通过优先进行对躲避对象物体的躲避,能够保证行驶中的安全。
当从不能高精度地检测出本车辆的位置变为能够高精度地检测出本车辆的位置时,切换为使向目的地的移动与对躲避对象物体的躲避相配合的行驶控制,因此能够一边对躲避对象物体进行躲避,一边以顺畅的行驶轨迹向目的地移动。
根据本发明,根据躲避对象物体的位置和移动量的识别状态来决定对躲避对象物体进行躲避的行驶方案,因此能够增加可自主行驶控制的机会,并且能够进行适于行驶环境的自主行驶控制。
(美国指定)
该国际专利申请涉及美国指定,主张2011年8月25日申请的日本专利申请第2011-183363号的优先权,援引基于美国专利法第119条的(a)的优先权的权利,引用了该公开内容。

Claims (15)

1.一种车辆用自主行驶控制系统,检测本车辆以及存在于上述本车辆的周围的躲避对象物体的位置,来决定向目的地移动时应该行驶的路径并进行自主行驶控制,该车辆用自主行驶控制系统的特征在于,
具有行驶方案决定单元,其基于上述本车辆与上述躲避对象物体的距离以及上述躲避对象物体的位置和移动量的计算精度的高低来决定躲避上述躲避对象物体时的行驶方案,
基于以在上述本车辆中实施与由上述行驶方案决定单元决定的行驶方案相应的自主行驶控制的方式所决定的控制指令值,来控制上述本车辆。
2.根据权利要求1所述的车辆用自主行驶控制系统,其特征在于,
在判断为以高精度计算出上述躲避对象物体的位置为近距离、以低精度计算出上述躲避对象物体的移动量的情况下,选择将上述躲避对象物体作为以规定的速度靠近的物体来进行躲避的行驶方案。
3.根据权利要求2所述的车辆用自主行驶系统,其特征在于,
在判断为以高精度计算出上述躲避对象物体的位置为近距离、以高精度计算出上述躲避对象物体的移动量为近距离的情况下,选择将上述躲避对象物体作为以所检测出的速度移动的物体来躲避的行驶方案。
4.根据权利要求1所述的车辆用自主行驶系统,其特征在于,
在判断为以高精度计算出上述躲避对象物体的位置为远距离、以低精度计算出上述躲避对象物体的移动量的情况下,选择将上述躲避对象物体作为静止物体来进行躲避的行驶方案。
5.根据权利要求4所述的车辆用自主行驶系统,其特征在于,
在判断为以高精度计算出上述躲避对象物体的位置为远距离、以高精度计算出上述躲避对象物体的移动量的情况下,选择将上述躲避对象物体作为以所检测出的速度移动的物体来躲避的行驶方案。
6.根据权利要求1~5中的任一项所述的车辆用自主行驶控制系统,其特征在于,
上述行驶方案决定单元具有:
系统结构数据库,其存储安装有上述躲避对象物体的位置的计算精度和移动量的计算精度以及实施与这些精度相应的行驶方案的系统结构;以及
系统动作水平判断单元,其基于上述躲避对象物体的位置的计算精度和移动量的计算精度来判断并决定实施自主行驶控制的系统结构。
7.根据权利要求6所述的车辆用自主行驶控制系统,其特征在于,
(i)在直接获取到上述躲避对象物体的位置的情况下以及在检测出上述躲避对象物体与上述本车辆的距离为距离阈值以下的情况下,上述行驶方案决定单元判断为以高精度计算出上述躲避对象物体的位置,
(ii)在不是直接获取上述躲避对象物体的位置且检测出上述躲避对象物体与上述本车辆的距离为上述距离阈值以上的情况下,上述行驶方案决定单元判断为以低精度计算出上述躲避对象物体的位置,
(iii)在判断为以高精度计算出上述躲避对象物体的位置和上述本车辆的移动量的情况下,上述行驶方案决定单元判断为以高精度计算出上述躲避对象物体的移动量,
(iv)在判断为上述躲避对象物体的位置和上述本车辆的移动量的计算精度中的至少一方的精度为低精度的情况下,上述行驶方案决定单元判断为以低精度计算出上述躲避对象物体的移动量。
8.根据权利要求6所述的车辆用自主行驶控制系统,其特征在于,
在上述本车辆不是在易滑的路面上行驶的情况下,上述行驶方案决定单元判断为以高精度检测出上述本车辆的移动量,
在上述本车辆在易滑的路面上行驶的情况下,上述行驶方案决定单元判断为以低精度检测出上述本车辆的移动量。
9.根据权利要求7或8所述的车辆用自主行驶控制系统,其特征在于,
上述系统动作水平判断单元具有判断上述本车辆的位置的检测精度的本车辆位置精度判断单元,在以第一阈值的量级检测出上述本车辆的位置的情况下,上述本车辆位置精度判断单元判断为以高精度检测出上述本车辆的位置,其中,该第一阈值被预先设定为判断上述本车辆的位置的检测精度的高低时的判断值;在以第二阈值的量级检测出上述本车辆的位置的情况下,上述本车辆位置精度判断单元判断为以低精度检测出上述本车辆的位置,其中,该第二阈值被预先设定为判断上述本车辆的位置的检测精度的高低时的判断值,
上述行驶方案决定单元基于由上述本车辆位置精度判断单元判断出的上述本车辆的位置的检测精度来决定包括到规定的目的地为止的行驶控制在内的行驶方案。
10.根据权利要求7~9中的任一项所述的车辆用自主行驶控制系统,其特征在于,
上述行驶方案决定单元基于上述躲避对象物体的移动量的识别状态,在成为规定的碰撞时间(TTC)和车间时距(THW)的定时躲避上述躲避对象物体。
11.根据权利要求9所述的车辆用自主行驶控制系统,其特征在于,
在由上述本车辆位置判断单元判断为上述本车辆的位置的检测精度为低精度的情况下,在判断的期间中断到规定的目的地为止的行驶控制,仅实施只躲避上述躲避对象物体的行驶控制。
12.根据权利要求11所述的车辆用自主行驶控制系统,其特征在于,
在判断为上述本车辆的位置的检测精度为低精度、仅实施只躲避上述躲避对象物体的行驶控制时,在判断为上述本车辆的位置的检测精度从低精度变为高精度而更新了检测精度的情况下,再实施被中断的到目的地为止的行驶控制。
13.根据权利要求1~12中的任一项所述的车辆用自主行驶控制系统,其特征在于,
当变更由上述行驶方案决定单元决定的行驶方案时,在与变更后的作为候选的多个行驶方案分别对应的控制指令值内存在包含与变更前实施的行驶方案所对应的控制指令值中包含的本车辆的移动矢量相同的移动矢量的控制指令值的情况下,变更后的控制指令值选择包含与变更前相同的本车辆的移动矢量的控制指令值。
14.根据权利要求1所述的车辆用自主行驶控制系统,其特征在于,还具备:
车辆信息获取单元,其至少获取上述本车辆的位置、速度、转向角;
躲避对象物体检测单元,其根据存在于上述本车辆的周围的物体来检测上述躲避对象物体,对所检测出的上述躲避对象物体与上述本车辆的距离以及角度进行检测;以及
周围信息识别单元,其对上述本车辆能够行驶的路线进行识别,并且基于由上述车辆信息获取单元获取到的上述本车辆的位置和由上述躲避对象物体检测单元检测出的上述躲避对象物体与上述本车辆的距离以及角度,来计算上述躲避对象物体相对于上述本车辆的位置,基于所计算出的上述躲避对象物体的位置和上述本车辆的移动量来计算上述躲避对象物体的移动量,其中,上述本车辆的移动量是基于由上述车辆信息获取单元获取到的上述本车辆的速度和转向角而计算出的。
15.一种车辆用自主行驶控制系统,检测本车辆以及存在于上述本车辆的周围的物体的位置,来决定向目的地移动时应该行驶的路径并进行自主行驶控制,该车辆用自主行驶控制系统的特征在于,具备:
车辆信息获取单元,其至少获取上述本车辆的位置、速度、转向角;
躲避对象物体检测单元,其根据存在于上述本车辆的周围的物体来检测躲避对象物体,对所检测出的上述躲避对象物体与上述本车辆的距离以及角度进行检测;
周围信息识别单元,其对上述本车辆能够行驶的路线进行识别,并且基于由上述车辆信息获取单元获取到的上述本车辆的位置和由上述躲避对象物体检测单元检测出的上述躲避对象物体与上述本车辆的距离以及角度,来计算上述躲避对象物体相对于上述本车辆的位置,基于所计算出的上述躲避对象物体的位置和上述本车辆的移动量来计算上述躲避对象物体的移动量,其中,上述本车辆的移动量是基于由上述车辆信息获取单元获取到的上述本车辆的速度和转向角而计算出的;
行驶方案决定单元,其基于上述本车辆和上述躲避对象物体的距离与被预先设定为判断上述躲避对象物体的位置的计算精度的高低时的判断值的距离阈值的比较结果以及是否直接获取到上述躲避对象物体的位置,来判断上述躲避对象物体的位置的计算精度,基于上述躲避对象物体的位置以及上述本车辆的移动量的计算精度来判断上述躲避对象物体的移动量的计算精度,基于上述躲避对象物体的位置及移动量的计算精度来决定表示躲避上述躲避对象物体时的行驶控制的行驶方案;以及
控制指令值决定单元,其决定以在上述本车辆中实施与由上述行驶方案决定单元决定的行驶方案相应的自主行驶控制的方式控制上述本车辆的控制指令值并输出。
CN201280041406.3A 2011-08-25 2012-08-23 车辆用自主行驶控制系统 Active CN103781685B (zh)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2011183363 2011-08-25
JP2011-183363 2011-08-25
PCT/JP2012/071340 WO2013027803A1 (ja) 2011-08-25 2012-08-23 車両用自律走行制御システム

Publications (2)

Publication Number Publication Date
CN103781685A true CN103781685A (zh) 2014-05-07
CN103781685B CN103781685B (zh) 2016-08-24

Family

ID=47746541

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201280041406.3A Active CN103781685B (zh) 2011-08-25 2012-08-23 车辆用自主行驶控制系统

Country Status (5)

Country Link
US (1) US9182761B2 (zh)
EP (1) EP2749468B1 (zh)
JP (1) JP5786941B2 (zh)
CN (1) CN103781685B (zh)
WO (1) WO2013027803A1 (zh)

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106218632A (zh) * 2016-07-19 2016-12-14 百度在线网络技术(北京)有限公司 用于控制无人驾驶车辆的方法和装置
CN107000714A (zh) * 2014-11-28 2017-08-01 株式会社爱德克斯 避撞装置
CN107076565A (zh) * 2014-10-22 2017-08-18 日产自动车株式会社 行驶路径运算装置
CN107368068A (zh) * 2016-05-13 2017-11-21 德尔福技术有限公司 用于自动车辆的脱险路径规划系统
CN108885826A (zh) * 2016-04-15 2018-11-23 本田技研工业株式会社 车辆控制系统、车辆控制方法及车辆控制程序
CN109328376A (zh) * 2016-06-27 2019-02-12 日产自动车株式会社 物体跟踪方法及物体跟踪装置
TWI676970B (zh) * 2017-04-20 2019-11-11 大陸商騰訊科技(深圳)有限公司 車道選擇方法、目標車輛及計算機儲存介質
CN111149142A (zh) * 2017-09-28 2020-05-12 株式会社电装 控制对象车辆设定装置、控制对象车辆设定系统及控制对象车辆设定方法
CN111315623A (zh) * 2017-11-06 2020-06-19 本田技研工业株式会社 车辆控制装置
CN112229417A (zh) * 2019-07-17 2021-01-15 北京新能源汽车技术创新中心有限公司 车辆定位方法、装置、计算机设备和存储介质

Families Citing this family (45)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10254764B2 (en) 2016-05-31 2019-04-09 Peloton Technology, Inc. Platoon controller state machine
US10520581B2 (en) 2011-07-06 2019-12-31 Peloton Technology, Inc. Sensor fusion for autonomous or partially autonomous vehicle control
US20170242443A1 (en) 2015-11-02 2017-08-24 Peloton Technology, Inc. Gap measurement for vehicle convoying
US9582006B2 (en) 2011-07-06 2017-02-28 Peloton Technology, Inc. Systems and methods for semi-autonomous convoying of vehicles
EP2749468B1 (en) * 2011-08-25 2019-02-27 Nissan Motor Co., Ltd Autonomous driving control system for vehicle
CN103842229A (zh) * 2011-10-03 2014-06-04 丰田自动车株式会社 车辆的驾驶辅助系统
DE102013203216A1 (de) * 2013-02-27 2014-08-28 Robert Bosch Gmbh Verfahren zur Unterstützung des Fahrers eines Kraftfahrzeugs bei einem Kollisionsvermeidungsmanöver
US11294396B2 (en) 2013-03-15 2022-04-05 Peloton Technology, Inc. System and method for implementing pre-cognition braking and/or avoiding or mitigation risks among platooning vehicles
US20180210463A1 (en) 2013-03-15 2018-07-26 Peloton Technology, Inc. System and method for implementing pre-cognition braking and/or avoiding or mitigation risks among platooning vehicles
DE102013205840A1 (de) * 2013-04-03 2014-10-09 Robert Bosch Gmbh Automatisches Befahren einer Strecke
DE102013222586A1 (de) * 2013-11-07 2015-05-07 Robert Bosch Gmbh Verfahren zur Vermeidung einer Kollision eines Kraftfahrzeugs mit einem falschfahrenden Fahrzeug und Steuer- und Erfassungseinrichtung für ein Kraftfahrzeug zur Vermeidung einer Kollision des Kraftfahrzeugs mit einem falschfahrenden Fahrzeug
TWI583581B (zh) * 2014-12-16 2017-05-21 Automatic Driving System with Driving Behavior Decision and Its
WO2016139747A1 (ja) * 2015-03-03 2016-09-09 パイオニア株式会社 車両制御装置、制御方法、プログラム及び記憶媒体
WO2016139748A1 (ja) * 2015-03-03 2016-09-09 パイオニア株式会社 経路探索装置、制御方法、プログラム及び記憶媒体
US10031522B2 (en) 2015-05-27 2018-07-24 Dov Moran Alerting predicted accidents between driverless cars
EP3304520B1 (en) 2015-05-27 2023-09-20 Dov Moran Alerting predicted accidents between driverless cars
JP6500984B2 (ja) * 2015-06-02 2019-04-17 日産自動車株式会社 車両制御装置及び車両制御方法
DE102015109146A1 (de) * 2015-06-10 2016-12-15 Valeo Schalter Und Sensoren Gmbh Verfahren zum Ändern einer Bewegungsrichtung eines zumindest semiautonom betriebenen Kraftfahrzeugs, Fahrerassistenzsystem und Kraftfahrzeug
DE112016003758T5 (de) * 2015-08-19 2018-05-03 Honda Motor Co., Ltd. Fahrzeugsteuervorrichtung, Fahrzeugsteuerverfahren und Fahrzeugsteuerprogramm
CN105216714B (zh) * 2015-09-29 2017-09-12 大连楼兰科技股份有限公司 一种基于mems传感器的碰撞事故识别方法
KR101745161B1 (ko) 2015-10-28 2017-06-08 현대자동차주식회사 목적지 유형에 따른 차량의 제어 방법
JP6652401B2 (ja) * 2016-02-22 2020-02-19 本田技研工業株式会社 車両走行制御装置
KR20170124816A (ko) 2016-05-03 2017-11-13 현대자동차주식회사 차량 주행 상황을 고려한 경로 산출 장치 및 방법
US10369998B2 (en) 2016-08-22 2019-08-06 Peloton Technology, Inc. Dynamic gap control for automated driving
EP3500940A4 (en) * 2016-08-22 2020-03-18 Peloton Technology, Inc. AUTOMATED CONNECTED VEHICLE CONTROL SYSTEM ARCHITECTURE
EP3309721A1 (en) * 2016-09-23 2018-04-18 KPIT Technologies Ltd. Autonomous system validation
JP6668375B2 (ja) * 2016-11-24 2020-03-18 バイドゥドットコム タイムズ テクノロジー (ベイジン) カンパニー リミテッドBaidu.com Times Technology (Beijing) Co., Ltd. 比例、積分及び微分(pid)コントローラを用いた自律走行車のステアリング制御方法及びシステム
KR102638977B1 (ko) 2016-12-15 2024-02-22 현대자동차주식회사 차량 및 그 제어방법
JP6867184B2 (ja) * 2017-02-13 2021-04-28 トヨタ自動車株式会社 運転支援装置
JP6558393B2 (ja) 2017-04-06 2019-08-14 トヨタ自動車株式会社 進路設定装置及び進路設定方法
JP6272592B1 (ja) * 2017-05-22 2018-01-31 三菱電機株式会社 位置推定装置、位置推定方法及び位置推定プログラム
JP6790258B2 (ja) * 2017-06-02 2020-12-02 本田技研工業株式会社 ポリシー生成装置及び車両
WO2019026348A1 (ja) * 2017-07-31 2019-02-07 株式会社Jvcケンウッド 表示制御装置、表示制御システム、表示制御方法およびプログラム
CN111133398B (zh) * 2017-09-22 2023-09-26 伟摩有限责任公司 使用雷达技术检测自动驾驶车辆的运动
JP7034741B2 (ja) * 2018-01-26 2022-03-14 アルパイン株式会社 情報処理装置、自車位置算出システム及び車両
KR102423172B1 (ko) * 2018-03-20 2022-07-22 모빌아이 비젼 테크놀로지스 엘티디 차량의 항법을 위한 시스템 및 방법
US20210179142A1 (en) * 2018-04-20 2021-06-17 Sony Corporation Mobile object, information processing apparatus, information processing method, and program
US11203334B2 (en) * 2018-10-10 2021-12-21 Roadtec, Inc. Proximity detection zone for working machine
JP7206938B2 (ja) * 2019-01-18 2023-01-18 株式会社デンソーテン 移動量算出装置
US10621858B1 (en) 2019-02-06 2020-04-14 Toyota Research Institute, Inc. Systems and methods for improving situational awareness of a user
US11210946B2 (en) * 2019-07-15 2021-12-28 Verizon Patent And Licensing Inc. Content sharing between vehicles based on a peer-to-peer connection
JP7347099B2 (ja) * 2019-10-11 2023-09-20 トヨタ自動車株式会社 車両警報装置
US11354913B1 (en) * 2019-11-27 2022-06-07 Woven Planet North America, Inc. Systems and methods for improving vehicle predictions using point representations of scene
US11938941B2 (en) 2020-08-31 2024-03-26 Denso International America, Inc. Mode selection according to system conditions
KR20220060404A (ko) * 2020-11-04 2022-05-11 현대자동차주식회사 자율 주행 시스템의 동적 검증을 위한 테스트 케이스 생성 방법 및 장치

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20020022927A1 (en) * 1993-08-11 2002-02-21 Lemelson Jerome H. GPS vehicle collision avoidance warning and control system and method
JP2005050187A (ja) * 2003-07-30 2005-02-24 Nissan Motor Co Ltd 周辺車両検出装置
JP2007255979A (ja) * 2006-03-22 2007-10-04 Nissan Motor Co Ltd 物体検出方法および物体検出装置
JP2008008679A (ja) * 2006-06-27 2008-01-17 Toyota Motor Corp 物体検出装置、衝突予測装置、及び車両制御装置
CN101959738A (zh) * 2008-09-19 2011-01-26 日立汽车系统株式会社 车辆控制装置
CN102069800A (zh) * 2010-12-28 2011-05-25 奇瑞汽车股份有限公司 车辆行驶控制方法及控制装置
DE102010002105A1 (de) * 2010-02-18 2011-08-18 Robert Bosch GmbH, 70469 Verfahren zur Unterstützung eines Fahrers eines Fahrzeugs bei einem Fahrmanöver

Family Cites Families (45)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3564547B2 (ja) 1995-04-17 2004-09-15 本田技研工業株式会社 自動走行誘導装置
US6405132B1 (en) * 1997-10-22 2002-06-11 Intelligent Technologies International, Inc. Accident avoidance system
US6370475B1 (en) * 1997-10-22 2002-04-09 Intelligent Technologies International Inc. Accident avoidance system
US5999865A (en) * 1998-01-29 1999-12-07 Inco Limited Autonomous vehicle guidance system
DE10036276A1 (de) * 2000-07-26 2002-02-07 Daimler Chrysler Ag Automatisches Brems- und Lenksystem für ein Fahrzeug
JP3695296B2 (ja) 2000-07-28 2005-09-14 株式会社デンソー クルーズ制御装置、車間警報装置及び記録媒体
JP3733875B2 (ja) * 2000-09-29 2006-01-11 日産自動車株式会社 道路白線認識装置
US6941200B2 (en) * 2000-10-16 2005-09-06 Matsushita Electric Industrial Co., Ltd. Automated guided vehicle, operation control system and method for the same, and automotive vehicle
US8718919B2 (en) * 2002-04-23 2014-05-06 Robert Bosch Gmbh Method and apparatus for lane recognition for a vehicle
KR100461869B1 (ko) * 2002-07-04 2004-12-14 삼성전자주식회사 무인반송 시스템의 제어방법
KR100478451B1 (ko) * 2002-07-05 2005-03-22 삼성전자주식회사 무인반송 시스템의 제어방법
US20050021195A1 (en) * 2003-07-21 2005-01-27 Rapistan Systems Advertising Corp. Dynamic object avoidance with automated guided vehicle
US20050216182A1 (en) * 2004-03-24 2005-09-29 Hussain Talib S Vehicle routing and path planning
JP4760715B2 (ja) * 2004-12-28 2011-08-31 株式会社豊田中央研究所 車両運動制御装置
EP1926654B1 (de) * 2005-09-15 2009-12-09 Continental Teves AG & Co. oHG Verfahren und vorrichtung zum lenken eines kraftfahrzeugs
US7991521B2 (en) * 2006-02-01 2011-08-02 Jervis B. Webb Company Variable path automated guided vehicle
JP4724043B2 (ja) * 2006-05-17 2011-07-13 トヨタ自動車株式会社 対象物認識装置
JP4816248B2 (ja) * 2006-05-23 2011-11-16 日産自動車株式会社 車両用運転操作補助装置
EP2054281B1 (de) * 2006-08-18 2013-12-25 Continental Teves AG & Co. oHG Ansteuerung von sicherheitsmitteln eines kraftfahrzeugs
JP2008121583A (ja) * 2006-11-13 2008-05-29 Toyota Motor Corp 車両制御装置
JP4706654B2 (ja) * 2007-03-27 2011-06-22 トヨタ自動車株式会社 衝突回避装置
JP5309633B2 (ja) * 2007-11-16 2013-10-09 アイシン・エィ・ダブリュ株式会社 車両制御装置、車両制御方法及びコンピュータプログラム
US8417444B2 (en) * 2007-11-27 2013-04-09 Nav-Track, Inc. Method and system for locating and navigating an autonomous vehicle
EP2085279B1 (en) * 2008-01-29 2011-05-25 Ford Global Technologies, LLC A system for collision course prediction
US8180513B2 (en) * 2008-05-05 2012-05-15 Southwest Research Institute Autonomous ground vehicle control system for high-speed and safe operation
JP4656456B2 (ja) * 2008-10-22 2011-03-23 日本電気株式会社 車線区画線検出装置、車線区画線検出方法、及び車線区画線検出プログラム
JP4853525B2 (ja) * 2009-02-09 2012-01-11 トヨタ自動車株式会社 移動領域予測装置
US8616320B2 (en) * 2009-02-12 2013-12-31 Edison Nation, Llc Automated vehicle and system utilizing an optical sensing system
WO2010101749A1 (en) * 2009-03-05 2010-09-10 Massachusetts Institute Of Technology Predictive semi-autonomous vehicle navigation system
JP5353455B2 (ja) * 2009-06-09 2013-11-27 コニカミノルタ株式会社 周辺監視装置
US20110035150A1 (en) * 2009-08-07 2011-02-10 Gm Global Technology Operations, Inc. Simple technique for dynamic path planning and collision avoidance
EP2316705B1 (en) * 2009-10-28 2012-06-20 Honda Research Institute Europe GmbH Behavior-based learning of visual characteristics from real-world traffic scenes for driver assistance systems
JP5532124B2 (ja) * 2010-04-05 2014-06-25 トヨタ自動車株式会社 車両の衝突判定装置
US8260539B2 (en) * 2010-05-12 2012-09-04 GM Global Technology Operations LLC Object and vehicle detection and tracking using 3-D laser rangefinder
CA2806852C (en) * 2010-08-03 2018-09-04 Fori Automation, Inc. Sensor system and method for use with an automated guided vehicle (agv)
CN103229222B (zh) * 2011-01-20 2015-09-16 丰田自动车株式会社 驾驶支援装置
DE102012203187A1 (de) * 2011-03-01 2012-09-06 Continental Teves Ag & Co. Ohg Verfahren und Vorrichtung zur Prädiktion und Adaption von Bewegungstrajektorien von Kraftfahrzeugen
US8761990B2 (en) * 2011-03-30 2014-06-24 Microsoft Corporation Semi-autonomous mobile device driving with obstacle avoidance
JPWO2012147166A1 (ja) * 2011-04-26 2014-07-28 トヨタ自動車株式会社 運転支援装置
EP2749468B1 (en) * 2011-08-25 2019-02-27 Nissan Motor Co., Ltd Autonomous driving control system for vehicle
US9318023B2 (en) * 2011-08-31 2016-04-19 GM Global Technology Operations LLC System and method for collision avoidance maneuver path determination with jerk limit
US9669828B2 (en) * 2012-06-01 2017-06-06 Toyota Motor Engineering & Manufacturing North America, Inc. Cooperative driving and collision avoidance by distributed receding horizon control
US8849515B2 (en) * 2012-07-24 2014-09-30 GM Global Technology Operations LLC Steering assist in driver initiated collision avoidance maneuver
US20150161894A1 (en) * 2013-12-05 2015-06-11 Elwha Llc Systems and methods for reporting characteristics of automatic-driving software
US9091558B2 (en) * 2013-12-23 2015-07-28 Automotive Research & Testing Center Autonomous driver assistance system and autonomous driving method thereof

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20020022927A1 (en) * 1993-08-11 2002-02-21 Lemelson Jerome H. GPS vehicle collision avoidance warning and control system and method
JP2005050187A (ja) * 2003-07-30 2005-02-24 Nissan Motor Co Ltd 周辺車両検出装置
JP2007255979A (ja) * 2006-03-22 2007-10-04 Nissan Motor Co Ltd 物体検出方法および物体検出装置
JP2008008679A (ja) * 2006-06-27 2008-01-17 Toyota Motor Corp 物体検出装置、衝突予測装置、及び車両制御装置
CN101959738A (zh) * 2008-09-19 2011-01-26 日立汽车系统株式会社 车辆控制装置
DE102010002105A1 (de) * 2010-02-18 2011-08-18 Robert Bosch GmbH, 70469 Verfahren zur Unterstützung eines Fahrers eines Fahrzeugs bei einem Fahrmanöver
CN102069800A (zh) * 2010-12-28 2011-05-25 奇瑞汽车股份有限公司 车辆行驶控制方法及控制装置

Cited By (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10585435B2 (en) 2014-10-22 2020-03-10 Nissan Motor Co., Ltd. Travel route calculation device
CN107076565A (zh) * 2014-10-22 2017-08-18 日产自动车株式会社 行驶路径运算装置
CN107000714A (zh) * 2014-11-28 2017-08-01 株式会社爱德克斯 避撞装置
CN108885826A (zh) * 2016-04-15 2018-11-23 本田技研工业株式会社 车辆控制系统、车辆控制方法及车辆控制程序
US10967877B2 (en) 2016-04-15 2021-04-06 Honda Motor Co., Ltd. Vehicle control system, vehicle control method, and vehicle control program
CN107368068A (zh) * 2016-05-13 2017-11-21 德尔福技术有限公司 用于自动车辆的脱险路径规划系统
US10510257B2 (en) 2016-06-27 2019-12-17 Nissan Motor Co., Ltd. Object tracking method and object tracking device
CN109328376A (zh) * 2016-06-27 2019-02-12 日产自动车株式会社 物体跟踪方法及物体跟踪装置
CN109328376B (zh) * 2016-06-27 2021-06-15 日产自动车株式会社 物体跟踪方法及物体跟踪装置
CN106218632A (zh) * 2016-07-19 2016-12-14 百度在线网络技术(北京)有限公司 用于控制无人驾驶车辆的方法和装置
CN106218632B (zh) * 2016-07-19 2019-01-01 百度在线网络技术(北京)有限公司 用于控制无人驾驶车辆的方法和装置
TWI676970B (zh) * 2017-04-20 2019-11-11 大陸商騰訊科技(深圳)有限公司 車道選擇方法、目標車輛及計算機儲存介質
US11059485B2 (en) 2017-04-20 2021-07-13 Tencent Technology (Shenzhen) Company Limited Lane selection method, target vehicle and computer storage medium
CN111149142A (zh) * 2017-09-28 2020-05-12 株式会社电装 控制对象车辆设定装置、控制对象车辆设定系统及控制对象车辆设定方法
CN111149142B (zh) * 2017-09-28 2022-09-27 株式会社电装 控制对象车辆设定装置及其系统、方法
CN111315623A (zh) * 2017-11-06 2020-06-19 本田技研工业株式会社 车辆控制装置
CN111315623B (zh) * 2017-11-06 2022-10-21 本田技研工业株式会社 车辆控制装置
CN112229417A (zh) * 2019-07-17 2021-01-15 北京新能源汽车技术创新中心有限公司 车辆定位方法、装置、计算机设备和存储介质
CN112229417B (zh) * 2019-07-17 2023-03-24 北京国家新能源汽车技术创新中心有限公司 车辆定位方法、装置、计算机设备和存储介质

Also Published As

Publication number Publication date
US9182761B2 (en) 2015-11-10
JP5786941B2 (ja) 2015-09-30
EP2749468B1 (en) 2019-02-27
CN103781685B (zh) 2016-08-24
US20140222278A1 (en) 2014-08-07
WO2013027803A1 (ja) 2013-02-28
EP2749468A4 (en) 2015-12-23
EP2749468A1 (en) 2014-07-02
JPWO2013027803A1 (ja) 2015-03-19

Similar Documents

Publication Publication Date Title
CN103781685B (zh) 车辆用自主行驶控制系统
US20220066457A1 (en) Trajectory setting device and trajectory setting method
CN108263383B (zh) 在协同自适应巡航控制系统中控制速度的装置和方法
CN112046501B (zh) 自动驾驶装置和方法
CN108688660B (zh) 运行范围确定装置
JP5782708B2 (ja) 走行支援装置
CN111201448B (zh) 用于产生反演传感器模型的方法和设备以及用于识别障碍物的方法
EP3343173B1 (en) Vehicle position estimation device, vehicle position estimation method
CN109426261B (zh) 自动驾驶装置
CN107241916A (zh) 车辆的行驶控制装置以及行驶控制方法
KR20200014931A (ko) 차량용 정보 기억 방법, 차량의 주행 제어 방법, 및 차량용 정보 기억 장치
US11433897B2 (en) Method and apparatus for determination of optimal cruising lane in an assisted driving system
CN112046481B (zh) 自动驾驶装置和方法
US11285953B2 (en) Determining visibility distances based on a dynamic field of view of a vehicle
JP6911312B2 (ja) 物体識別装置
CN112498347A (zh) 用于实时横向控制和转向致动评估的方法和装置
CN113859263B (zh) 预定行驶路径设定装置以及预定行驶路径设定方法
CN111959482A (zh) 自主驾驶装置及方法
JP2012256242A (ja) 他車両認識装置及び進路評価装置
CN109314763B (zh) 车间距离推定方法及车间距离推定装置
CN114426030B (zh) 一种行人穿行意图估计方法、装置、设备和汽车
CN111326002A (zh) 一种自动驾驶汽车环境感知的预测方法、装置及系统
CN112818727A (zh) 一种道路约束确定方法及装置
JP7567848B2 (ja) 車両制御装置
US20220315002A1 (en) Traveling lane planning device, medium storing computer program for traveling lane planning, and traveling lane planning method

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