CN110617828B - 车辆自动驾驶时动态目标线的生成方法、生成***及车辆 - Google Patents
车辆自动驾驶时动态目标线的生成方法、生成***及车辆 Download PDFInfo
- Publication number
- CN110617828B CN110617828B CN201811643956.8A CN201811643956A CN110617828B CN 110617828 B CN110617828 B CN 110617828B CN 201811643956 A CN201811643956 A CN 201811643956A CN 110617828 B CN110617828 B CN 110617828B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- lane
- width
- preset range
- target line
- 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 40
- 238000010586 diagram Methods 0.000 description 9
- PCTMTFRHKVHKIS-BMFZQQSSSA-N (1s,3r,4e,6e,8e,10e,12e,14e,16e,18s,19r,20r,21s,25r,27r,30r,31r,33s,35r,37s,38r)-3-[(2r,3s,4s,5s,6r)-4-amino-3,5-dihydroxy-6-methyloxan-2-yl]oxy-19,25,27,30,31,33,35,37-octahydroxy-18,20,21-trimethyl-23-oxo-22,39-dioxabicyclo[33.3.1]nonatriaconta-4,6,8,10 Chemical compound C1C=C2C[C@@H](OS(O)(=O)=O)CC[C@]2(C)[C@@H]2[C@@H]1[C@@H]1CC[C@H]([C@H](C)CCCC(C)C)[C@@]1(C)CC2.O[C@H]1[C@@H](N)[C@H](O)[C@@H](C)O[C@H]1O[C@H]1/C=C/C=C/C=C/C=C/C=C/C=C/C=C/[C@H](C)[C@@H](O)[C@@H](C)[C@H](C)OC(=O)C[C@H](O)C[C@H](O)CC[C@@H](O)[C@H](O)C[C@H](O)C[C@](O)(C[C@H](O)[C@H]2C(O)=O)O[C@H]2C1 PCTMTFRHKVHKIS-BMFZQQSSSA-N 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 238000012216 screening Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000026676 system process Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3407—Route searching; Route guidance specially adapted for specific applications
- G01C21/3415—Dynamic re-routing, e.g. recalculating the route when the user deviates from calculated route or after detecting real-time traffic data or accidents
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0219—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- Traffic Control Systems (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明提供了一种车辆自动驾驶时动态目标线的生成方法、生成***及车辆,该生成方法包括:获取车辆附近预设范围内所有车道内障碍物信息;在车辆附近第一预设范围内,如果车辆当前行驶车道前方不存在障碍物,则根据车辆当前行驶车道的曲率和宽度生成车辆当前行驶车道的第一动态目标线;在车辆附近第一预设范围内,如果车辆当前行驶车道前方存在障碍物,则获取车辆当前行驶车道的安全行驶宽度;如果车辆当前行驶车道的安全行驶宽度大于预设安全通行宽度,则根据安全行驶宽度生成当前行驶车道的第二动态目标线。本发明的方法可以针对不同环境生成最优动态目标线,以便车辆自动驾驶时根据生成的目标线控制车辆行驶。
Description
技术领域
本发明涉及车辆自动驾驶技术领域,特别涉及一种车辆自动驾驶时动态目标线的生成方法、生成***及车辆。
背景技术
车辆无人驾驶指通过车载传感***感知道路环境,自动规划行车路线并控制车辆行驶。动态目标线是根据车辆行驶过程的环境状态实时规划出一条最优路径用于换道避障。在车辆自动驾驶领域内,缺乏一种可以针对不同环境生成最优动态目标线的方法,以便车辆自动驾驶时根据生成的动态目标线控制车辆行驶。
发明内容
有鉴于此,本发明的第一个目的在于提出一种车辆自动驾驶时动态目标线的生成方法,该方法可以针对不同环境生成最优动态目标线,以便车辆自动驾驶时根据生成的目标线控制车辆行驶。
为达到上述目的,本发明的技术方案是这样实现的:
一种车辆自动驾驶时动态目标线的生成方法,包括以下步骤:获取车辆附近第一预设范围内所有车道内障碍物信息;在所述车辆附近所述第一预设范围内,如果所述车辆当前行驶车道前方不存在障碍物,则根据所述车辆当前行驶车道的曲率和宽度生成所述车辆当前行驶车道的第一动态目标线;在所述车辆附近所述第一预设范围内,如果所述车辆当前行驶车道前方存在障碍物,则获取所述车辆当前行驶车道的安全行驶宽度;如果所述车辆当前行驶车道的安全行驶宽度大于预设安全通行宽度,则根据所述安全行驶宽度生成所述当前行驶车道的第二动态目标线。
进一步的,在获取所述当前行驶车道的安全行驶宽度的步骤之后,还包括:如果所述车辆当前行驶车道的安全行驶宽度小于所述预设安全通行宽度,则判断所述车辆附近所述第一预设范围内相邻车道内是否存在障碍物;如果所述车辆附近所述第一预设范围内相邻车道内不存在障碍物,则生成所述相邻车道的第一动态目标线。
进一步的,在判断所述车辆附近所述第一预设范围内相邻车道内是否存在障碍物的步骤之后,还包括:如果所述车辆附近第二预设范围内所述相邻车道内存在障碍物,则控制所述车辆减速;其中,所述第二预设范围小于所述第一预设范围。
进一步的,还包括:如果所述车辆附近第二预设范围内所述相邻车道中不存在障碍物且所述车辆附近所述第一预设范围内所述相邻车道中位于所述车辆前方的位置存在障碍物时,则获取所述相邻车道的安全行驶宽度;如果所述相邻车道的安全行驶宽度大于所述预设安全通行宽度,则根据所述相邻车道的安全行驶宽度生成所述相邻车道的第二动态目标线;如果所述相邻车道的安全行驶宽度小于所述预设安全通行宽度,则控制所述车辆减速。
进一步的,还包括:在所述车辆沿着所述相邻车道的第一动态目标线或所述相邻车道的所述第二动态目标线行驶时,如果在所述车辆附近所述第一预设范围内原始行驶车道内不存在障碍物,且在所述车辆附近所述第二预设范围内所述车辆的侧方和后方不存在障碍物时,生成所述车辆回归到所述原始行驶车道后的动态目标线。
进一步的,还包括:在所述车辆附近所述第一预设范围内,如果所述车辆侧方存在障碍物且所述障碍物至少一部分进入所述车辆当前行驶车道内,则根据所述障碍物的位置和形状以及所述车辆当前行驶车道的曲率和宽度生成所述车辆当前行驶车道的第三动态目标线。
进一步的,在所述获取车辆附近第一预设范围内所有车道内障碍物信息的步骤之后,还包括:获取所述车辆的当前位置;根据所述车辆的当前位置得到所述车辆附近所述第一预设范围内的道路环境信息;根据所述车辆的当前位置和所述车辆附近所述第一预设范围内的道路环境信息生成当前行驶路段的所有车道的曲率和宽度;根据所述当前行驶路段的所有车道的曲率和宽度生成所有车道的拟合车道线。
相对于现有技术,本发明所述的车辆自动驾驶时动态目标线的生成方法具有以下优势:
本发明所述的车辆自动驾驶时动态目标线的生成方法,根据车辆前方预设范围内所有车道内障碍物信息和车辆信息判断当前行驶车道是否可以安全通过,如果当前行驶车道可以安全通过则输出当前行驶车道的动态目标线,以便车辆根据当前行驶车道的动态目标线行驶;如果当前行驶车道不可以安全通过则判断相邻车道是否可以安全通过,如果是则生成相邻车道的动态目标线,以便车辆根据相邻车道的动态目标线行驶;如果当前行驶车道和相邻车道均不可以安全通过,则控制车辆减速;在车辆改变车道行驶时,如果原车道满足行驶要求且本车与原车道后方的车辆距离大于安全距离时,控制车辆会原车道行驶并生成原车道的动态目标线。本实施例中附近预设范围内行驶的车辆在某个时刻可以视为固定障碍物,当前方预设范围内的车辆位置发生变化时,生成的动态目标线随之实时更新,确保车辆自动驾驶时可以根据当前的动态目标线进行行驶。
本发明的另一个目的在于提出一种车辆自动驾驶时动态目标线的生成***,该***可以针对不同环境生成最优动态目标线,以便车辆自动驾驶时根据生成的目标线控制车辆行驶。
为达到上述目的,本发明的技术方案是这样实现的:
一种车辆自动驾驶时动态目标线的生成***,包括:信息获取模块,用于获取车辆附近预设范围内所有车道内障碍物信息;车道线生成模块,用于生成动态车道线;控制模块,用于在所述车辆附近所述第一预设范围内,如果所述车辆当前行驶车道前方不存在障碍物,则根据所述车辆当前行驶车道的曲率和宽度控制所述车道线生成模块生成所述车辆当前行驶车道的第一动态目标线;如果所述车辆当前行驶车道前方存在障碍物,则根据所述车辆当前行驶车道前方的障碍物信息得到所述车辆当前行驶车道的安全行驶宽度,并在所述车辆当前行驶车道的安全行驶宽度大于预设安全通行宽度时根据所述当前行驶车道的安全行驶宽度控制所述车道线生成模块生成所述当前行驶车道的第二动态目标线。
进一步的,所述控制模块还用于在所述车辆附近所述第一预设范围内,如果所述车辆当前行驶车道前方存在障碍物、所述车辆当前行驶车道的安全行驶宽度小于所述预设安全通行宽度且相邻车道中不存在障碍物,则控制所述车道线生成模块生成所述相邻车道的第一动态目标线。
进一步的,所述控制模块还用于在所述车辆附近所述第一预设范围内所述车辆当前行驶车道前方存在障碍物且所述车辆当前行驶车道的安全行驶宽度小于所述预设安全通行宽度时,如果在所述车辆附近第二预设范围内所述相邻车道存在障碍物,则控制所述车辆减速,所述第二预设范围小于所述第一预设范围。
进一步的,所述控制模块还用于在所述车辆附近所述第一预设范围内所述车辆当前行驶车道前方存在障碍物、所述车辆当前行驶车道的安全行驶宽度小于所述预设安全通行宽度、在所述车辆附近所述第二预设范围内所述相邻车道不存在障碍物且在所述车辆附近所述第一预设范围内所述相邻车道前方存在障碍物的情况下,如果所述相邻车道的安全行驶宽度大于所述预设安全通行宽度,则根据所述相邻车道的安全行驶宽度控制所述车道线生成模块生成所述相邻车道的第二动态目标线;如果所述相邻车道的安全行驶宽度小于所述预设安全通行宽度,则控制所述车辆减速。
进一步的,所述控制模块还用于在所述车辆沿着所述相邻车道的第一动态目标线或所述相邻车道的第二动态目标线行驶时,如果在所述车辆附近所述第一预设范围内原始行驶车道内不存在障碍物,且在所述车辆附近所述第二预设范围内所述车辆的侧方和后方不存在障碍物时,生成所述车辆回归到所述原始行驶车道后的动态目标线。
进一步的,所述控制模块还用于在所述车辆附近所述第一预设范围内,如果所述车辆侧方存在障碍物且所述障碍物至少一部分进入所述车辆当前行驶车道内,则根据所述车辆障碍物的位置和形状以及所述车辆当前行驶车道的曲率和宽度控制所述车道线生成模块生成所述车辆当前行驶车道的第三动态目标线。
进一步的,车辆自动驾驶时动态目标线的生成***还包括:定位模块,用于获取所述车辆的当前位置;其中,所述控制模块还用于根据所述车辆的当前位置和所述车辆附近所述第一预设范围内的道路环境信息生成当前行驶路段的所有车道的曲率和宽度,进而根据所述当前行驶路段的所有车道的曲率和宽度生成所有车道的拟合车道线。
所述的车辆自动驾驶时动态目标线的生成***与上述的车辆自动驾驶时动态目标线的生成方法相对于现有技术所具有的优势相同,在此不再赘述。
本发明的另一个目的在于提出一种车辆,该车辆可以针对不同环境生成最优动态目标线,进而在车辆自动驾驶时根据生成的目标线行驶。
为达到上述目的,本发明的技术方案是这样实现的:
一种车辆,设置有如上述实施例所述的车辆自动驾驶时动态目标线的生成***。
所述的车辆与上述的车辆自动驾驶时动态目标线的生成***相对于现有技术所具有的优势相同,在此不再赘述。
附图说明
构成本发明的一部分的附图用来提供对本发明的进一步理解,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:
图1为本发明实施例的车辆自动驾驶时动态目标线的生成方法的流程图;
图2为本发明一个实施例中生成动态目标线的示意图;
图3为本发明另一个实施例中生成动态目标线的示意图;
图4为本发明又一个实施例中生成动态目标线的示意图;
图5是本发明一个实施例中车辆回归到原始行驶车道后的示意图;
图6是本发明一个实施例中车辆侧方存在障碍物时生成动态目标线的示意图;
图7是发明一个实施例中车辆生成动态目标线的示意图;
图8为本发明实施例的车辆自动驾驶时动态目标线的生成***的结构框图。
具体实施方式
需要说明的是,在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合。
下面将参考附图并结合实施例来详细说明本发明。
图1是根据本发明一个实施例的车辆自动驾驶时动态目标线的生成方法的流程图。
如图1所示,根据本发明一个实施例的车辆自动驾驶时动态目标线的生成方法,包括如下步骤:
S1:获取车辆附近第一预设范围内所有车道内障碍物信息。
具体的,在车辆上安装多个传感器组成环境感知***,通过环境感知***感知车辆前方预设范围内的所有车道内的障碍物信息。其中,环境感知***提取车辆、行人、气候、道路等车辆当前行驶环境信息,然后将不同传感器数据信息筛选、关联、追踪、过滤等处理以便获得更为精确的道路信息、物体目标位置、速度、尺寸等信息。在本发明的一个示例中,第一预设范围为车辆附近半径为200米的圆形区域,根据道路情况和车速进行设定,可以根据需求进行调节。
在本发明一个实施例中,在步骤S1和S2之间,还包括:
获取车辆的当前位置。可以选用高精度GPS定位设备对车辆进行定位。
根据车辆的当前位置得到车辆附近第一预设范围内的道路环境信息。通过导航***配合车辆的环境感知***可以得到附近第一预设范围内的道路环境信息。
根据车辆的当前位置和前方预设范围内的道路环境信息生成当前行驶路段的所有车道的曲率和宽度。
根据当前行驶路段的所有车道的曲率和宽度生成所有车道的拟合车道线。由控制***对车辆的当前位置和前方预设范围内的道路环境信息处理运算后实时输出自动驾驶车辆附近200m范围内高精度地图车道线离散点经纬度(经纬度以地心为原点)、离散点航向角(以正北方向为0°顺时针为证)、车道线类型、每一条车道宽度、车道数量、道路边界等信息,进而形成高精度地图。高精度地图输出点间距(2~5m,可以根据需求设定),其次对拟合曲线进行等间距离散处理获得处理后高精度地图离散数据点,最后将处理后离散数据点坐标转换到自动驾驶车辆车体坐标系下。
S2:在车辆附近第一预设范围内,如果车辆当前行驶车道前方不存在障碍物,则根据车辆当前行驶车道的曲率和宽度生成车辆当前行驶车道的第一动态目标线。其中,障碍物可以包括路障、路锥、无法移动事故车辆和正在移动的车辆。
图2为本发明一个实施例中生成动态目标线的示意图。如图2所示,L为前述预设范围,在本示例中,L为200米,3条车道线分别为L1、L2和L3。由于当前行驶车道前方200米内没有障碍物,则可行驶安全域ABCD,动态目标线为过AD与BC中间线EF,通常为当前行驶车道的中心线。
S3:在车辆附近第一预设范围内,如果车辆当前行驶车道前方存在障碍物,则获取车辆当前行驶车道的安全行驶宽度。
图3为本发明另一个实施例中生成动态目标线的示意图。如图3所示,3条车道线分别为L1、L2和L3。当前行驶车道内预设范围内存在障碍物时,车辆可行驶安全域变窄因此需要重新计算可行驶安全域,获取物体目标与自动驾驶车辆之间纵向最近点O1,根据道路曲率获取纵向最近距离O1O2。车辆在本车道内可行驶安全域ABCD,其中,AD、BC宽度即为安全行驶宽度。
S4:如果车辆当前行驶车道的安全行驶宽度大于预设安全通行宽度,则根据安全行驶宽度生成当前行驶车道的第二动态目标线。
当AD、BC宽度距离大于预设安全通行宽度(例如2.4m(1.2*车辆宽度))时车辆不会与物体目标发生碰撞,车辆能够安全通过,输出当前行驶车道的第二动态目标线EF。
在本发明的一个实施例中,在步骤S3之后还包括:如果车辆当前行驶车道的安全行驶宽度小于预设安全通行宽度,表示车辆在当前行驶车道内无法安全通过,则判断车辆附近第一预设范围内相邻车道内是否存在障碍物;如果车辆附近第一预设范围内相邻车道内不存在障碍物,则生成相邻车道的第一动态目标。
在本发明的一个实施例中,在判断车辆附近第一预设范围内相邻车道内是否存在障碍物的步骤之后,还包括:如果车辆附近第二预设范围内相邻车道内存在障碍物,则控制车辆减速。其中,第二预设范围小于第一预设范围。在一些示例中,第二预设范围为直径为20米的区域,可以根据需求进行调整。即在当前行驶车道无法通行时,如果本车附近半径为20米的圆形区域内的相邻车道内存在障碍物,则表示本车无法安全地向相邻车道换道,此时控制车辆减速行驶。在本发明的一个实施例中,车辆自动驾驶时动态目标线的生成方法还包括:
如果车辆附近第二预设范围内相邻车道中不存在障碍物且车辆附近第一预设范围内相邻车道中位于车辆前方的位置存在障碍物时,即表示本车可以安全地向相邻车道换道,但相邻车道内存在障碍物,此时需要获取相邻车道的安全行驶宽度。其中,计算相邻车道内的安全通行宽度的方式与前文使用的计算当前行驶车道宽度的方式相同。如果相邻车道的安全行驶宽度大于预设安全通行宽度,则表示车辆可以在相邻车道避开障碍物行驶,此时根据相邻车道的安全行驶宽度生成相邻车道的第二动态目标线。
如果相邻车道的安全行驶宽度小于预设安全通行宽度,则表示车辆可以在相邻车道无法避开障碍物,此时控制车辆减速,不向相邻车道换道。
图4为本发明又一个实施例中生成动态目标线的示意图。如图4所示,3条车道线分别为L1、L2和L3。当前行驶车道前方200m范围内出现障碍物时,自动驾驶车辆可行驶安全域变窄,获取物体目标与自动驾驶车辆之间纵向最近点O1和O4,通过车道线L2平移通过O1点获得自动驾驶车辆与物体目标之间最近纵向距离O1O2,通过车道线L1平移通过O4点获得自动驾驶车辆与物体目标之间最近纵向距离O3O4,车辆在本车道内可行驶安全域ABCD。当本车道内可行驶安全域宽度AD小于安全行驶宽度(例如2.4m)时在本车道内行驶存在与前方物体目标碰撞危险,自动驾驶车辆无法安全通过当前行驶车道。
获取相邻车道纵向最近点O5,通过车道线L2平移通过O5点获得自动驾驶车辆与物体目标之间最近纵向距离O5O6,车辆在相邻车道内可行驶安全域A1B1C1D1,如果A1D1之间的距离大于安全行驶宽度(例如2.4m)时生成相邻车道的第二动态目标线,即过A1D1与B1C1中间线E1F1。如果A1D1之间的距离小于安全行驶宽度(例如2.4m)时,控制车辆减速。
在本发明的一个实施例中,车辆自动驾驶时动态目标线的生成方法还包括:在车辆沿着相邻车道的第一动态目标线或相邻车道的第二动态目标线行驶时,如果在车辆附近第一预设范围内原始行驶车道内不存在障碍物,且在车辆附近第二预设范围内车辆的侧方和后方不存在障碍物时,生成车辆回归到原始行驶车道后的动态目标线。
图5是本发明一个实施例中车辆回归到原始行驶车道后的示意图。如图5所示,如果本车侧方无车、在车辆附近的第一预设范围(例如200米范围)的原始行驶车道内前方无车,且本车与原始行驶车道内最近的后方车辆之间的距离O1O2大于低于安全距离(例如20米)时,生成车辆回归到原始行驶车道后的动态目标线。
在本发明的一个实施例中,车辆自动驾驶时动态目标线的生成方法还包括:在车辆附近第一预设范围内,如果车辆侧方存在障碍物且障碍物至少一部分进入车辆当前行驶车道内,则根据障碍物的位置和形状以及车辆当前行驶车道的曲率和宽度生成车辆当前行驶车道的第三动态目标线。
图6是本发明一个实施例中车辆侧方存在障碍物时生成动态目标线的示意图。如图6所示,当本车侧方有车辆进入本车道时,控制本车根据侧方车辆在本车道内的位置和尺寸调整本车的动态目标线,生成当前行驶车道的第三动态目标线,即EF的沿线。图7是发明一个实施例中车辆生成动态目标线的示意图。
如图7所示,本车M在行驶过程中在第一预设范围内发现当前行驶车道内存在障碍物,即车辆V1和车辆V2。此时需要判断当前行驶车道内的安全行驶宽度AD是否大于预设安全通行宽度。
如果当前行驶车道的安全行驶宽度AD大于预设安全通行宽度,则生成当前行驶车道的动态目标线EF。
如果当前行驶车道的安全行驶宽度AD不大于预设安全通行宽度,则判断在第一预设范围内相邻车道内是否存在障碍物,由于本车M的右侧无行车道(车辆V4压线停靠),故只需考虑左侧车道是否可以生成动态目标线;
如果本车M左侧存在车辆V3,则判断T3是否在本车M附近的第二预设范围(例如半径为20米的圆形范围)内,由于车辆V3在本车M的第二预设范围内,因此控制本车M减速;
如果本车M左侧不存在车辆V3,则判断左侧车道的安全行驶宽度B1C1是否大于预设安全通行宽度,如果左侧车道的安全行驶宽度B1C1大于预设安全通行宽度,则生成左侧车道的动态目标线E1F1;如果左侧车道的安全行驶宽度B1C1不大于预设安全通行宽度,则控制本车M减速行驶。
根据本发明实施例的车辆自动驾驶时动态目标线的生成方法,根据车辆前方预设范围内所有车道内障碍物信息和车辆信息判断当前行驶车道是否可以安全通过,如果当前行驶车道可以安全通过则输出当前行驶车道的动态目标线,以便车辆根据当前行驶车道的动态目标线行驶;如果当前行驶车道不可以安全通过则判断相邻车道是否可以安全通过,如果是则生成相邻车道的动态目标线,以便车辆根据相邻车道的动态目标线行驶;如果当前行驶车道和相邻车道均不可以安全通过,则控制车辆减速;在车辆改变车道行驶时,如果原车道满足行驶要求且本车与原车道后方的车辆距离大于安全距离时,控制车辆会原车道行驶并生成原车道的动态目标线。本实施例中前方预设范围内行驶的车辆在某个时刻可以视为固定障碍物,当前方预设范围内的车辆位置发生变化时,生成的动态目标线随之实时更新,确保车辆自动驾驶时可以根据当前的动态目标线进行行驶。
图8是根据本发明一个实施例的车辆自动驾驶时动态目标线的生成***的结构框图。如图8所示,根据本发明一个实施例的车辆自动驾驶时动态目标线的生成***,包括:信息获取模块100、车道线生成模块200和控制模块300。
其中,信息获取模块100用于获取车辆附近预设范围内所有车道内障碍物信息。车道线生成模块200用于生成动态车道线。控制模块300用于在车辆附近第一预设范围内,如果车辆当前行驶车道前方不存在障碍物,则根据车辆当前行驶车道的曲率和宽度控制车道线生成模块200生成车辆当前行驶车道的第一动态目标线;如果车辆当前行驶车道前方存在障碍物,则根据车辆当前行驶车道前方的障碍物信息得到车辆当前行驶车道的安全行驶宽度,并在车辆当前行驶车道的安全行驶宽度大于预设安全通行宽度时根据当前行驶车道的安全行驶宽度控制车道线生成模块200生成当前行驶车道的第二动态目标线。
在本发明的一个实施例中,控制模块300还用于在车辆附近第一预设范围内,如果车辆当前行驶车道前方存在障碍物、车辆当前行驶车道的安全行驶宽度小于预设安全通行宽度且相邻车道中不存在障碍物,则控制车道线生成模块200生成相邻车道的第一动态目标线。
在本发明的一个实施例中,控制模块300还用于在车辆附近第一预设范围内车辆当前行驶车道前方存在障碍物且车辆当前行驶车道的安全行驶宽度小于预设安全通行宽度时,如果在车辆附近第二预设范围内相邻车道存在障碍物,则控制车辆减速。其中,第二预设范围小于第一预设范围。
在本发明的一个实施例中,控制模块300还用于在车辆附近第一预设范围内车辆当前行驶车道前方存在障碍物、车辆当前行驶车道的安全行驶宽度小于预设安全通行宽度、在车辆附近第二预设范围内相邻车道不存在障碍物且在车辆附近第一预设范围内相邻车道前方存在障碍物的情况下:如果相邻车道的安全行驶宽度大于预设安全通行宽度,则根据相邻车道的安全行驶宽度控制车道线生成模块200生成相邻车道的第二动态目标线;如果相邻车道的安全行驶宽度小于预设安全通行宽度,则控制车辆减速。
在本发明的一个实施例中,控制模块300还用于在车辆沿着相邻车道的第一动态目标线或相邻车道的第二动态目标线行驶时,如果在车辆附近第一预设范围内原始行驶车道内不存在障碍物,且在车辆附近第二预设范围内车辆的侧方和后方不存在障碍物时,控制车道线生成模块200生成车辆回归到原始行驶车道后的动态目标线。
在本发明的一个实施例中,控制模块还用于在车辆附近第一预设范围内,如果车辆侧方存在障碍物且障碍物至少一部分进入车辆当前行驶车道内,则根据车辆障碍物的位置和形状以及车辆当前行驶车道的曲率和宽度控制车道线生成模块生成200车辆当前行驶车道的第三动态目标线。
在本发明的一个实施例中,车辆自动驾驶时动态目标线的生成***还包括定位模块。定位模块用于获取车辆的当前位置。其中,控制模块300还用于根据车辆的当前位置和车辆附近第一预设范围内的道路环境信息生成当前行驶路段的所有车道的曲率和宽度,进而根据当前行驶路段的所有车道的曲率和宽度控制车道线生成模块200生成所有车道的拟合车道线。
本发明实施例的车辆自动驾驶时动态目标线的生成***,根据车辆前方预设范围内所有车道内障碍物信息和车辆信息判断当前行驶车道是否可以安全通过,如果当前行驶车道可以安全通过则输出当前行驶车道的动态目标线,以便车辆根据当前行驶车道的动态目标线行驶;如果当前行驶车道不可以安全通过则判断相邻车道是否可以安全通过,如果是则生成相邻车道的动态目标线,以便车辆根据相邻车道的动态目标线行驶;如果当前行驶车道和相邻车道均不可以安全通过,则控制车辆减速;在车辆改变车道行驶时,如果原车道满足行驶要求且本车与原车道后方的车辆距离大于安全距离时,控制车辆会原车道行驶并生成原车道的动态目标线。本实施例中前方预设范围内行驶的车辆在某个时刻可以视为固定障碍物,当前方预设范围内的车辆位置发生变化时,生成的动态目标线随之实时更新,确保车辆自动驾驶时可以根据当前的动态目标线进行行驶。
需要说明的是,本发明实施例的车辆自动驾驶时动态目标线的生成***的具体实现方式与本发明实施例的车辆自动驾驶时动态目标线的生成方法的具体实现方式类似,具体请参见方法部分的描述,为了减少冗余,此处不做赘述。
进一步地,本发明的实施例公开了一种车辆,设置有如上述任意一个实施例中的车辆自动驾驶时动态目标线的生成***。该车辆可以针对不同环境生成最优动态目标线,进而在车辆自动驾驶时根据生成的目标线行驶。
另外,根据本发明实施例的车辆的其它构成以及作用对于本领域的普通技术人员而言都是已知的,为了减少冗余,此处不做赘述。
以上仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (9)
1.一种车辆自动驾驶时动态目标线的生成方法,其特征在于,包括以下步骤:
获取车辆附近第一预设范围内所有车道内障碍物信息;
在所述车辆附近所述第一预设范围内,如果所述车辆当前行驶车道前方不存在障碍物,则根据所述车辆当前行驶车道的曲率和宽度生成所述车辆当前行驶车道的第一动态目标线;
在所述车辆附近所述第一预设范围内,如果所述车辆当前行驶车道前方存在障碍物,则获取所述车辆当前行驶车道的安全行驶宽度;
如果所述车辆当前行驶车道的安全行驶宽度大于预设安全通行宽度,则根据所述安全行驶宽度生成所述当前行驶车道的第二动态目标线;
在获取所述当前行驶车道的安全行驶宽度的步骤之后,还包括:
如果所述车辆当前行驶车道的安全行驶宽度小于所述预设安全通行宽度,则判断所述车辆附近所述第一预设范围内相邻车道内是否存在障碍物;
如果所述车辆附近所述第一预设范围内相邻车道内不存在障碍物,则生成所述相邻车道的第一动态目标线;
在判断所述车辆附近所述第一预设范围内相邻车道内是否存在障碍物的步骤之后,还包括:
如果所述车辆附近第二预设范围内所述相邻车道内存在障碍物,则控制所述车辆减速;
其中,所述第二预设范围小于所述第一预设范围;
如果所述车辆附近第二预设范围内所述相邻车道中不存在障碍物且所述车辆附近所述第一预设范围内所述相邻车道中位于所述车辆前方的位置存在障碍物时,则获取所述相邻车道的安全行驶宽度;
如果所述相邻车道的安全行驶宽度大于所述预设安全通行宽度,则根据所述相邻车道的安全行驶宽度生成所述相邻车道的第二动态目标线;
如果所述相邻车道的安全行驶宽度小于所述预设安全通行宽度,则控制所述车辆减速。
2.根据权利要求1所述的车辆自动驾驶时动态目标线的生成方法,其特征在于,还包括:
在所述车辆沿着所述相邻车道的第一动态目标线或所述相邻车道的所述第二动态目标线行驶时,如果在所述车辆附近所述第一预设范围内原始行驶车道内不存在障碍物,且在所述车辆附近所述第二预设范围内所述车辆的侧方和后方不存在障碍物时,生成所述车辆回归到所述原始行驶车道后的动态目标线。
3.根据权利要求1所述的车辆自动驾驶时动态目标线的生成方法,其特征在于,还包括:
在所述车辆附近所述第一预设范围内,如果所述车辆侧方存在障碍物且所述障碍物至少一部分进入所述车辆当前行驶车道内,则根据所述障碍物的位置和形状以及所述车辆当前行驶车道的曲率和宽度生成所述车辆当前行驶车道的第三动态目标线。
4.根据权利要求1所述的车辆自动驾驶时动态目标线的生成方法,其特征在于,在所述获取车辆附近第一预设范围内所有车道内障碍物信息的步骤之后,还包括:
获取所述车辆的当前位置;
根据所述车辆的当前位置得到所述车辆附近所述第一预设范围内的道路环境信息;
根据所述车辆的当前位置和所述车辆附近所述第一预设范围内的道路环境信息生成当前行驶路段的所有车道的曲率和宽度;
根据所述当前行驶路段的所有车道的曲率和宽度生成所有车道的拟合车道线。
5.一种车辆自动驾驶时动态目标线的生成***,其特征在于,包括:
信息获取模块,用于获取车辆附近第一预设范围内所有车道内障碍物信息;
车道线生成模块,用于生成动态车道线;
控制模块,用于在所述车辆附近所述第一预设范围内,
如果所述车辆当前行驶车道前方不存在障碍物,则根据所述车辆当前行驶车道的曲率和宽度控制所述车道线生成模块生成所述车辆当前行驶车道的第一动态目标线;
如果所述车辆当前行驶车道前方存在障碍物,则根据所述车辆当前行驶车道前方的障碍物信息得到所述车辆当前行驶车道的安全行驶宽度,并在所述车辆当前行驶车道的安全行驶宽度大于预设安全通行宽度时根据所述当前行驶车道的安全行驶宽度控制所述车道线生成模块生成所述当前行驶车道的第二动态目标线;
所述控制模块还用于在所述车辆附近所述第一预设范围内,如果所述车辆当前行驶车道前方存在障碍物、所述车辆当前行驶车道的安全行驶宽度小于所述预设安全通行宽度且相邻车道中不存在障碍物,则控制所述车道线生成模块生成所述相邻车道的第一动态目标线;
所述控制模块还用于在所述车辆附近所述第一预设范围内所述车辆当前行驶车道前方存在障碍物且所述车辆当前行驶车道的安全行驶宽度小于所述预设安全通行宽度时,如果在所述车辆附近第二预设范围内所述相邻车道存在障碍物,则控制所述车辆减速,所述第二预设范围小于所述第一预设范围;
所述控制模块还用于在所述车辆附近所述第一预设范围内所述车辆当前行驶车道前方存在障碍物、所述车辆当前行驶车道的安全行驶宽度小于所述预设安全通行宽度、在所述车辆附近所述第二预设范围内所述相邻车道不存在障碍物且在所述车辆附近所述第一预设范围内所述相邻车道前方存在障碍物的情况下,
如果所述相邻车道的安全行驶宽度大于所述预设安全通行宽度,则根据所述相邻车道的安全行驶宽度控制所述车道线生成模块生成所述相邻车道的第二动态目标线;
如果所述相邻车道的安全行驶宽度小于所述预设安全通行宽度,则控制所述车辆减速。
6.根据权利要求5所述的车辆自动驾驶时动态目标线的生成***,其特征在于,所述控制模块还用于在所述车辆沿着所述相邻车道的第一动态目标线或所述相邻车道的第二动态目标线行驶时,如果在所述车辆附近所述第一预设范围内原始行驶车道内不存在障碍物,且在所述车辆附近所述第二预设范围内所述车辆的侧方和后方不存在障碍物时,控制所述车道线生成模块生成所述车辆回归到所述原始行驶车道后的动态目标线。
7.根据权利要求5所述的车辆自动驾驶时动态目标线的生成***,其特征在于,所述控制模块还用于在所述车辆附近所述第一预设范围内,如果所述车辆侧方存在障碍物且车辆侧方存在的障碍物至少一部分进入所述车辆当前行驶车道内,则根据所述车辆侧方存在的障碍物的位置和形状以及所述车辆当前行驶车道的曲率和宽度控制所述车道线生成模块生成所述车辆当前行驶车道的第三动态目标线。
8.根据权利要求5所述的车辆自动驾驶时动态目标线的生成***,其特征在于,还包括:
定位模块,用于获取所述车辆的当前位置;
其中,所述控制模块还用于根据所述车辆的当前位置和所述车辆附近所述第一预设范围内的道路环境信息生成当前行驶路段的所有车道的曲率和宽度,进而根据所述当前行驶路段的所有车道的曲率和宽度控制所述车道线生成模块生成所有车道的拟合车道线。
9.一种车辆,其特征在于,包括权利要求5-8中任一项所述的车辆自动驾驶时动态目标线的生成***。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811643956.8A CN110617828B (zh) | 2018-12-29 | 2018-12-29 | 车辆自动驾驶时动态目标线的生成方法、生成***及车辆 |
EP19904248.2A EP3889722B1 (en) | 2018-12-29 | 2019-12-27 | Generation method and generation system for dynamic target line during automatic driving of vehicle, and vehicle |
PCT/CN2019/129386 WO2020135772A1 (zh) | 2018-12-29 | 2019-12-27 | 车辆自动驾驶时动态目标线的生成方法、生成***及车辆 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811643956.8A CN110617828B (zh) | 2018-12-29 | 2018-12-29 | 车辆自动驾驶时动态目标线的生成方法、生成***及车辆 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110617828A CN110617828A (zh) | 2019-12-27 |
CN110617828B true CN110617828B (zh) | 2022-04-01 |
Family
ID=68920827
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811643956.8A Active CN110617828B (zh) | 2018-12-29 | 2018-12-29 | 车辆自动驾驶时动态目标线的生成方法、生成***及车辆 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110617828B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111273662B (zh) * | 2020-02-05 | 2023-09-26 | 北京百度网讯科技有限公司 | 车辆控制方法、装置、电子设备及可读存储介质 |
CN111559388B (zh) * | 2020-03-26 | 2022-07-12 | 吉利汽车研究院(宁波)有限公司 | 一种目标车辆筛选方法、装置、设备及存储介质 |
CN113532448A (zh) * | 2020-04-13 | 2021-10-22 | 广州汽车集团股份有限公司 | 一种自动驾驶车辆的导航方法及其***、驾驶控制设备 |
CN111561945B (zh) * | 2020-05-26 | 2022-01-04 | 中咨数据有限公司 | 基于车联网的导航路径生成方法及装置 |
CN111637898B (zh) * | 2020-06-02 | 2022-07-01 | 安徽宇呈数据技术有限公司 | 一种高精度导航电子地图的处理方法和装置 |
CN112009473B (zh) * | 2020-10-16 | 2021-02-26 | 福瑞泰克智能***有限公司 | 一种自适应巡航目标选择的方法、装置和计算机设备 |
CN114379552B (zh) * | 2021-11-11 | 2024-03-26 | 重庆大学 | 一种基于高精度地图和车载传感器的自适应车道保持控制***及方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008110620A (ja) * | 2006-10-27 | 2008-05-15 | Toyota Motor Corp | 車両走行制御装置 |
CN101837781A (zh) * | 2009-03-06 | 2010-09-22 | 通用汽车环球科技运作公司 | 用于自动车道对正或换道的控制***的基于模型的预测控制 |
CN106080744A (zh) * | 2015-04-27 | 2016-11-09 | 丰田自动车株式会社 | 自动驾驶车辆*** |
CN106338988A (zh) * | 2015-07-06 | 2017-01-18 | 丰田自动车株式会社 | 自动驾驶车辆的控制装置 |
CN107564317A (zh) * | 2017-10-27 | 2018-01-09 | 左依宁 | 一种自动驾驶车辆控制***及方法 |
CN108072382A (zh) * | 2016-11-11 | 2018-05-25 | 现代自动车株式会社 | 用于自主驾驶车辆的路径确定装置及路径确定方法 |
CN108583578A (zh) * | 2018-04-26 | 2018-09-28 | 北京领骏科技有限公司 | 用于自动驾驶车辆的基于多目标决策矩阵的车道决策方法 |
CN108657189A (zh) * | 2018-06-22 | 2018-10-16 | 南京航空航天大学 | 基于bp神经网络和安全距离移线工况自动驾驶转向***及其控制方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106463061B (zh) * | 2014-05-27 | 2019-10-18 | 本田技研工业株式会社 | 碰撞可能性判定装置 |
KR101714273B1 (ko) * | 2015-12-11 | 2017-03-08 | 현대자동차주식회사 | 자율 주행 시스템의 경로 제어 방법 및 그 장치 |
JP6565893B2 (ja) * | 2016-12-26 | 2019-08-28 | トヨタ自動車株式会社 | 運転支援装置 |
-
2018
- 2018-12-29 CN CN201811643956.8A patent/CN110617828B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008110620A (ja) * | 2006-10-27 | 2008-05-15 | Toyota Motor Corp | 車両走行制御装置 |
CN101837781A (zh) * | 2009-03-06 | 2010-09-22 | 通用汽车环球科技运作公司 | 用于自动车道对正或换道的控制***的基于模型的预测控制 |
CN106080744A (zh) * | 2015-04-27 | 2016-11-09 | 丰田自动车株式会社 | 自动驾驶车辆*** |
CN106338988A (zh) * | 2015-07-06 | 2017-01-18 | 丰田自动车株式会社 | 自动驾驶车辆的控制装置 |
CN108072382A (zh) * | 2016-11-11 | 2018-05-25 | 现代自动车株式会社 | 用于自主驾驶车辆的路径确定装置及路径确定方法 |
CN107564317A (zh) * | 2017-10-27 | 2018-01-09 | 左依宁 | 一种自动驾驶车辆控制***及方法 |
CN108583578A (zh) * | 2018-04-26 | 2018-09-28 | 北京领骏科技有限公司 | 用于自动驾驶车辆的基于多目标决策矩阵的车道决策方法 |
CN108657189A (zh) * | 2018-06-22 | 2018-10-16 | 南京航空航天大学 | 基于bp神经网络和安全距离移线工况自动驾驶转向***及其控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110617828A (zh) | 2019-12-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110617828B (zh) | 车辆自动驾驶时动态目标线的生成方法、生成***及车辆 | |
EP3889722B1 (en) | Generation method and generation system for dynamic target line during automatic driving of vehicle, and vehicle | |
CN109952547B (zh) | 根据车道数据对机动车的自动控制和机动车 | |
US10310508B2 (en) | Vehicle control apparatus | |
EP3888986B1 (en) | Control method and control system for lane changing during automatic driving of vehicle, and vehicle | |
CN108688659B (zh) | 车辆的行驶控制装置 | |
RU2642547C1 (ru) | Система определения обновления карт | |
US9733642B2 (en) | Vehicle control device | |
EP3088280B1 (en) | Autonomous driving vehicle system | |
US10331139B2 (en) | Navigation device for autonomously driving vehicle | |
CN110614993B (zh) | 自动驾驶车辆的换道方法、***及车辆 | |
US10953883B2 (en) | Vehicle control device | |
JP6465319B2 (ja) | 車両の走行制御装置 | |
US11167761B2 (en) | Vehicle control device, vehicle control method, and storage medium | |
JP7360269B2 (ja) | 車両の走行制御装置 | |
EP3626569A1 (en) | Driving assistance device and driving assistance method | |
RU2760714C1 (ru) | Способ содействия вождению и устройство содействия вождению | |
US11423780B2 (en) | Traffic control system | |
JP2009075933A (ja) | 分岐路内位置演算装置、分岐路内位置演算方法、および、分岐路内位置演算プログラム | |
EP3626570A1 (en) | Driving assistance method and driving assistance apparatus | |
CN110618676B (zh) | 车辆自动驾驶时安全偏移线的生成方法、生成***及车辆 | |
CN114523968B (zh) | 周围车辆监测装置和周围车辆监测方法 | |
JP7444736B2 (ja) | 交通制御システム | |
JP7386692B2 (ja) | 走行支援方法及び走行支援装置 | |
EP3985641B1 (en) | Travel assistance method and travel assistance device |
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 | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20210518 Address after: 100055 1802, 18 / F, building 3, yard 9, Guang'an Road, Fengtai District, Beijing Applicant after: Momo Zhixing Technology Co.,Ltd. Address before: 071000 No. 2266 Chaoyang South Street, Hebei, Baoding Applicant before: Great Wall Motor Co.,Ltd. |
|
TA01 | Transfer of patent application right | ||
GR01 | Patent grant | ||
GR01 | Patent grant |