CN116811898A - 一种基于车道线的弯道自动驾驶路网生成方法与装置 - Google Patents
一种基于车道线的弯道自动驾驶路网生成方法与装置 Download PDFInfo
- Publication number
- CN116811898A CN116811898A CN202310792347.3A CN202310792347A CN116811898A CN 116811898 A CN116811898 A CN 116811898A CN 202310792347 A CN202310792347 A CN 202310792347A CN 116811898 A CN116811898 A CN 116811898A
- Authority
- CN
- China
- Prior art keywords
- curve
- point
- information
- track
- pose information
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 41
- 238000005070 sampling Methods 0.000 claims abstract description 69
- 230000000452 restraining effect Effects 0.000 claims abstract description 19
- 230000006870 function Effects 0.000 claims description 37
- 238000004590 computer program Methods 0.000 claims description 24
- 238000004422 calculation algorithm Methods 0.000 claims description 17
- 230000001133 acceleration Effects 0.000 claims description 16
- 238000003860 storage Methods 0.000 claims description 13
- 230000008859 change Effects 0.000 claims description 6
- 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 claims description 4
- 230000001419 dependent effect Effects 0.000 claims description 4
- 238000010586 diagram Methods 0.000 description 9
- 230000008569 process Effects 0.000 description 8
- 238000013507 mapping Methods 0.000 description 3
- 230000007547 defect Effects 0.000 description 2
- 230000007774 longterm Effects 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000003491 array Methods 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000001413 cellular effect Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 230000036461 convulsion Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000001960 triggered effect Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
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
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
-
- 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/02—Control of vehicle driving stability
- B60W30/04—Control of vehicle driving stability related to roll-over prevention
-
- 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
- B60W30/0953—Predicting travel path or likelihood of collision the prediction being responsive to vehicle dynamic parameters
-
- 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
- B60W30/0956—Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters
-
- 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
-
- 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
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0019—Control system elements or transfer functions
- B60W2050/0028—Mathematical models, e.g. for simulation
- B60W2050/0031—Mathematical model of the 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
- B60W2552/00—Input parameters relating to infrastructure
- B60W2552/30—Road curve radius
-
- 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/50—Barriers
-
- 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
- B60W2556/00—Input parameters relating to data
- B60W2556/40—High definition maps
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明公开了一种基于车道线的弯道自动驾驶路网生成方法与装置,涉及自动驾驶系统技术领域,一种自动驾驶轨迹拼接和路网生成方法,包括以下步骤:获取车辆当前位姿信息、障碍物在地图上的位姿信息与弯道信息;对所述车辆当前位姿信息以及障碍物在地图上的位姿信息进行分层采样,获取采样点信息;根据所述采样点信息与弯道信息在不同层的任意两点间生成轨迹曲线,通过障碍物位姿信息与轨迹约束点对生成的轨迹曲线进行约束;将所述约束后的多条轨迹曲线拼接成路网。本发明中的基于车道线的弯道自动驾驶路网生成方法,其可以考虑转弯时复杂路况,更合理地生成路网。
Description
技术领域
本发明涉及自动驾驶系统技术领域,具体涉及一种基于车道线的弯道自动驾驶路网生成方法与装置。
背景技术
路径规划模块作为决策规划子系统的重要功能,直接影响到下游控制层的执行优劣,不适当的换道、跟车、超车轨迹曲线会超出车辆运动的极限工况,且影响到驾乘人员的安全性和舒适性体验。
路径规划的目标是计算出安全、舒适的轨迹供无人驾驶车辆完成预定的行驶任务。安全意味着车辆在行驶过程中与障碍物保持适当的距离,避免碰撞;舒适意味着给乘客提供舒适的乘坐体验,比如避免过急的加减速度,在弯道时适当减速避免过大的向心加速度等。
路径规划是一个复杂的问题,由于车辆是非和谐系统,具有特殊的运动学约束条件。车辆不能独立的横向移动,需要纵向移动的同时才能获得横向偏移。躲避障碍物,特别是高速动态障碍物,也是一个比较困难的问题。对于搭载乘客的无人驾驶车辆来说,非常重要的一个要求是舒适性,规划出的轨迹必须做到平滑,将影响乘客舒适度的因素,比如加速度,向心加速度等,保持在能够容忍的范围。
首先,目前行业内主流是基于高精度地图的全局路径规划,当实际高速行驶过程中,货运干线物流场景会出现信号丢失,定位精度不足等问题。高精度地图成本高,制作周期长,不利于辅助驾驶的加速普及。根据《智能网联汽车高精地图白皮书》显示,采用传统测绘车方式,分米级地图的测绘效率约为每天每车500公里道路,成本为每公里10元左右,而厘米级地图的测绘效率约为每天每车100公里道路,成本可能达每公里千元。同时,高精地图后续的持续更新,意味着高精地图对于车企来说是一项长期的成本投入,长远来看,成本压力可能会更大。而且,对于卡车司机用户而言,成本是重要考虑因素。
同时,目前基于相机车道线在直线道路识别较为稳定,但在高速弯道上车道线会出现偏差,可视距离很短,甚至会出现畸变。当自动驾驶卡车在高速行驶中,大概率会出现跑偏和画龙现象。因此需要更精准、更合理、成本更低廉的弯道路网生成方法。
发明内容
针对现有技术中存在的缺陷,本申请提供一种基于车道线的弯道自动驾驶路网生成方法、装置、设备和存储介质,其可以考虑转弯时复杂路况,更合理地生成路网。
为达到以上目的,本发明采取的技术方案是:
第一方面,提供一种基于车道线的弯道自动驾驶路网生成方法,包括以下步骤:
获取车辆当前位姿信息、障碍物在地图上的位姿信息与弯道信息;
对所述车辆当前位姿信息以及障碍物在地图上的位姿信息进行分层采样,获取采样点信息;
根据所述采样点信息与弯道信息在不同层的任意两点间生成轨迹曲线,通过障碍物位姿信息与轨迹约束点对生成的轨迹曲线进行约束;
将所述约束后的多条轨迹曲线拼接成路网。
一些实施例中,所述车辆当前位姿信息包括坐标、航向角、曲率,弯道信息包括车道线信息与道路曲率半径。
一些实施例中,所述对所述车辆当前位姿信息以及障碍物在地图上的位姿信息进行分层采样,获取采样点信息,包括:
将所述位姿信息在以图为特征的状态空间中,进行横纵向的分层撒点;
先进行纵向分层采集,再进行横向等间隔采集,获取采样点;
获取每个采样点的坐标。
一些实施例中,所述根据所述采样点信息与弯道信息在不同层的任意两点间生成轨迹曲线,包括以下步骤:
获得车辆当前A点的坐标(xA,yA)、航向角θA和曲率kA;
根据第一算法得到A点曲率kA,所述第一算法包括:
其中RA为A点所在位置的弯道曲率半径,且A为轨迹起始点,A点的航向角θA=0,A点的位姿信息lA=0,lA、=0,lA、、=0,其中lA表示A点的横向距离,lA、表示A点的横向速度,lA、、表示A点的横向加速度。
一些实施例中,所述根据所述采样点信息与弯道信息在不同层的任意两点间生成轨迹曲线,还包括以下步骤:
获得采样点B点的坐标(xB,yB);
根据第二算法得到车道线函数y,所述第二算法包括:
y=bO+b1x+b2x2+b3x3
其中b0,b1,b2,b3为车道线的拟合系数,x表示车道线函数的自变量,y表示车道线函数的因变量;
得到A点到B点曲率半径变化量lB 0,B点横向速度lB 、,B点的横向加速度lB、、,其中RB为B点所在位置的弯道曲率半径,RA为A点所在位置的弯道曲率半径,y'表示车道线函数对x的一阶导数,y”表示车道线函数对x的二阶导数;
根据公式:
得到轨迹曲线的系数αi0,αi1,αi2,αi3,αi4,αi5,其中XA为A点横坐标,XB为B点横坐标;
根据公式:
li=αi0+αi1xi+αi2xi 2+αi3xi 3+αi4xi 4+αi5xi 5
得到A点到B点之间的轨迹曲线li。
一些实施例中,所述通过障碍物位姿信息与轨迹约束点对生成的轨迹曲线进行约束,包括以下步骤:
根据车道线函数,获取A点横坐标对应符合B点所在车道线函数上的控制点D,获取B点横坐标对应符合A点所在车道线函数上的控制点C;
保留处于ABCD四点形成的包围框中的轨迹曲线。
一些实施例中,所述通过障碍物位姿信息与轨迹约束点对生成的轨迹曲线进行约束,还包括:
根据所述障碍物位姿信息,排除与其冲突的轨迹曲线,形成约束后的轨迹曲线。
第二方面,提供一种基于车道线的弯道自动驾驶路网生成装置,包括:
收集单元,用于获取车辆当前位姿信息、障碍物在地图上的位姿信息与弯道信息;
采样单元,用于对所述车辆当前位姿信息以及障碍物在地图上的位姿信息进行分层采样,获取采样点信息;
生成单元,用于根据所述采样点信息与弯道信息在不同层的任意两点间生成轨迹曲线,通过障碍物位姿信息与轨迹约束点对生成的轨迹曲线进行约束,并将约束后的多条轨迹曲线拼接成路网。
第三方面,一种计算机设备包括:处理器、存储器、以及存储在所述存储器上并可被所述处理器执行的计算机程序,其中所述计算机程序被所述处理器执行时,实现第一方面任意一项所述的方法。
第四方面,提供一种计算机可读存储介质,所述计算机可读存储介质上存储有计算机程序,其中所述计算机程序被处理器执行时,实现第一方面任意一项所述的方法。
本发明中,获取车辆当前位姿信息、障碍物在地图上的位姿信息与弯道信息;对所述车辆当前位姿信息以及障碍物在地图上的位姿信息进行分层采样,获取采样点信息;根据所述采样点信息与弯道信息在不同层的任意两点间生成轨迹曲线,通过障碍物位姿信息与轨迹约束点对生成的轨迹曲线进行约束;将所述约束后的多条轨迹曲线拼接成路网。在路网生成的过程中考虑了弯道的情况与道路上障碍物的信息,因此可以生成更加合理的路网。
附图说明
图1为本发明实施例中一种基于车道线的弯道自动驾驶路网生成方法的流程示意图;
图2为本发明实施例中采样点采集示意图;
图3为本发明实施例中约束轨迹曲线示意图;
图4为本发明实施例中一种基于车道线的弯道自动驾驶路网生成装置的示意图;
图5为本发明实施例中一种计算机设备的结构示意图。
具体实施方式
为使本申请实施例的目的、技术方案和优点更加清楚,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本申请的一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例,都属于本申请保护的范围。
参见图1,图1为本发明实施例提供的一种基于车道线的弯道自动驾驶路网生成方法的流程示意图。如图1所示,该方法包括但不限于以下步骤:
S1.获取车辆当前位姿信息、障碍物在地图上的位姿信息与弯道信息;
S2.对所述车辆当前位姿信息以及障碍物在地图上的位姿信息进行分层采样,获取采样点信息;
S3.根据所述采样点信息与弯道信息在不同层的任意两点间生成轨迹曲线,通过障碍物位姿信息与轨迹约束点对生成的轨迹曲线进行约束;
S4.将所述约束后的多条轨迹曲线拼接成路网。
本发明中提供的基于车道线的弯道自动驾驶路网生成方法,通过步骤S1~S4,在路网形成的起始阶段考虑车辆自身信息以及障碍物信息的同时,还考虑了弯道的道路信息,这样可以很好的考虑在弯道驾驶时的车辆向心加速度,在保证安全行驶的同时,提高了车内人员的乘坐舒适度;在步骤S2中采用的分层采样方法,可以很好的选取多个采样点,使得规划的路径更加平滑;通过步骤S3中障碍物位姿信息与轨迹约束点对生成的轨迹曲线进行约束,避免了生成轨迹出现横向偏离的情况出现,提高舒适性与安全性。
具体实现时,在步骤S1中,获取车辆当前位姿信息主要是获取坐标、航向角、曲率,所述障碍物可以为正在行驶的车辆,静止车辆或其他障碍物;所述弯道信息包括弯道路段的车道线信息与道路曲率半径。
值得说明的是,获取所述位姿信息后,将位姿信息在以图为特征的状态空间中,进行横纵向的分层撒点;先进行纵向分层采集,再进行横向等间隔采集,获取采样点;获取每个采样点的坐标。
其中,获得的车道线信息需要根据实际情况进行校准,具体可以通过前车行驶轨迹进行校偏补偿,根据前车的历史轨迹进行预测,将轨迹通过采样点进行拉伸和压缩。如果前车靠左边线行驶,轨迹拼接后的车道线路网结构是往外侧拉伸。反之,往内侧压缩。即通过前车与车道边线的横向距离和行驶轨迹进行实时纠正,以弥补最大视野的不足。
值得说明的是,对于搭载自动驾驶的长途车辆而言,舒适性是驾驶员驾驶体验的重要衡量标准,规划出的轨迹必须做到平滑,将影响乘客舒适度的因素,比如加速度,向心加速度等,保持在能够容忍的范围。实际的道路曲率半径在不停的变化,会对纵向速度有影响,如果横向加速度超过限制范围,会触发侧翻。因此,在满足最大横向加速度前提下,保证曲率尽可能平滑。
具体实现时,在步骤S2中,如图2所示,所述对所述车辆当前位姿信息以及障碍物在地图上的位姿信息进行分层采样,获取采样点信息,包括:
将所述位姿信息在以图为特征的状态空间中,进行横纵向的分层撒点;先进行纵向分层采集,再进行横向等间隔采集,获取采样点;获取每个采样点的坐标。
具体的,在以图为特征的状态空间中,延车辆行驶方向,将纵向采样点分为五层,每层纵向分层,再分为横向中间左右五层采样。对自动驾驶车辆可能经过的位置采样,采样层次更清晰,避免因随机采样会导致采样点稀疏不均,采样距离过长或者过短,生成的路径随机性强的问题。
具体实现时,在步骤S3中,所述根据所述采样点信息与弯道信息在不同层的任意两点间生成轨迹曲线,包括以下步骤:
获得车辆当前A点的坐标(xA,yA)、航向角θA和曲率kA;
根据第一算法得到A点曲率kA,所述第一算法包括:
其中RA为A点所在位置的弯道曲率半径,且A为轨迹起始点,A点的航向角θA=0,A点的位姿信息lA=0,lA、=0,lA、、=0,其中lA表示A点的横向距离,lA、表示A点的横向速度,lA、、表示A点的横向加速度。
一些实施例中,所述根据所述采样点信息与弯道信息在不同层的任意两点间生成轨迹曲线,还包括以下步骤:
获得采样点B点的坐标(xB,yB);
根据第二算法得到车道线函数y,所述第二算法包括:
y=b0+b1x+b2x2+b3x3
其中b0,b1,b2,b3为车道线的拟合系数,x表示车道线函数的自变量,y表示车道线函数的因变量;其中,x代表的是车身相机坐标点为原点的纵向距离;y代表的是以车身相机坐标点为原点的横向距离。
得到A点到B点曲率半径变化量lB 0,B点横向速度lB、,B点的横向加速度lB、、,其中RB为B点所在位置的弯道曲率半径,RA为A点所在位置的弯道曲率半径,y'表示车道线函数对x的一阶导数,y”表示车道线函数对x的二阶导数;
根据公式:
得到轨迹曲线的系数αi0,αi1,αi2,αi3,αi4,αi5,其中XA为A点横坐标,XB为B点横坐标;
根据公式:
li=αi0+αi1xi+αi2xi 2+αi3xi 3+αi4xi 4+αi5xi 5
得到A点到B点之间的轨迹曲线li。
值得说明的是,在车辆起始点与所述分层采样点之间,所处不同分层的任意两点都可以按照此方式生成轨迹曲线,生成的若干轨迹曲线需要通过约束后再进行后续的路网拼接。
具体实现时,在步骤S3中,如图3所示,所述通过障碍物位姿信息与轨迹约束点对生成的轨迹曲线进行约束,包括以下步骤:
根据车道线函数,获取A点横坐标对应符合B点所在车道线函数上的控制点D,获取B点横坐标对应符合A点所在车道线函数上的控制点C;保留处于ABCD四点形成的包围框中的轨迹曲线。
具体的,遍历AB曲线上所有的点P1(xi,li),然后以该点作为判断点,开始在360°任意方向作一条射线,计算该射线与包围框每条边的交点个数。如果交点个数为奇数,则点位于扇形内如P1(xi,li),偶数则在扇形外如P2(xi,li)。该算法对于复合多边形也能正确判断。
控制点会对生成的轨迹进行检查,通过控制点的约束限制,防止生成的路网轨迹超出弯道区域限制,并进行剔除,防止占用过多的计算算力。
一些实施例中,所述通过障碍物位姿信息与轨迹约束点对生成的轨迹曲线进行约束,还包括:
根据所述障碍物位姿信息,排除与其冲突的轨迹曲线,形成约束后的轨迹曲线。其中,部分生成的轨迹曲线经过障碍物的坐标,说明如果车辆使用该轨迹行驶会与障碍物发生碰撞,因此,经过障碍物坐标的轨迹曲线也需要进行排除,将排除后的轨迹曲线进行路网拼接。
因此,基于车道线的弯道自动驾驶路网生成方法,保证路径在连接点处切线连续与曲率连续,以及在换道、跟车、超车的路径曲线需要考虑是否超出车辆运动的极限工况。同时,在保证路径连续和平滑的同时,保证轨迹点的可控性。另外,考虑到障碍物与车辆规划路径之间的碰撞几何关系,从而使得自动驾驶卡车在连续弯道上能低成本、安全和舒适的行驶,做出合理的决策,帮助司机做出最优的判断。
参见图4本发明实施例还提供了一种基于车道线的弯道自动驾驶路网生成装置,包括:
收集单元,用于获取车辆当前位姿信息、障碍物在地图上的位姿信息与弯道信息;
采样单元,用于对所述车辆当前位姿信息以及障碍物在地图上的位姿信息进行分层采样,获取采样点信息;
生成单元,用于根据所述采样点信息与弯道信息在不同层的任意两点间生成轨迹曲线,通过障碍物位姿信息与轨迹约束点对生成的轨迹曲线进行约束,并将约束后的多条轨迹曲线拼接成路网。
一些实施例中,收集单元用于获取车辆当前位姿信息、障碍物在地图上的位姿信息与弯道信息,其中车辆当前位姿信息包括坐标、航向角、曲率,弯道信息包括车道线信息与道路曲率半径。
一些实施例中,采样单元用于对所述车辆当前位姿信息以及障碍物在地图上的位姿信息进行分层采样,获取采样点信息,包括:
将所述位姿信息在以图为特征的状态空间中,进行横纵向的分层撒点;先进行纵向分层采集,再进行横向等间隔采集,获取采样点;获取每个采样点的坐标。
一些实施例中,生成单元用于根据所述采样点信息与弯道信息在不同层的任意两点间生成轨迹曲线,包括以下步骤:
获得车辆当前A点的坐标(xA,yA)、航向角θA和曲率kA;
根据第一算法得到A点曲率kA,所述第一算法包括:
其中RA为A点所在位置的弯道曲率半径,且A为轨迹起始点,A点的航向角θA=0,A点的位姿信息lA=0,lA、=0,lA、、=0,其中lA表示A点的横向距离,lA、表示A点的横向速度,lA、、表示A点的横向加速度。
一些实施例中,生成单元还用于根据所述采样点信息与弯道信息在不同层的任意两点间生成轨迹曲线,还包括以下步骤:
获得采样点B点的坐标(xB,yB);
根据第二算法得到车道线函数y,所述第二算法包括:
y=b0+b1x+b2x2+b3x3
其中b0,b1,b2,b3为车道线的拟合系数,x表示车道线函数的自变量,y表示车道线函数的因变量;
得到A点到B点曲率半径变化量lB 0,B点横向速度lB、,B点的横向加速度lB、、,其中RB为B点所在位置的弯道曲率半径,RA为A点所在位置的弯道曲率半径,y'表示车道线函数对x的一阶导数,y″表示车道线函数对x的二阶导数;
根据公式:
得到轨迹曲线的系数αi0,αi1,αi2,αi3,αi4,αi5,其中XA为A点横坐标,XB为B点横坐标;
根据公式:
li=αi0+αi1xi+αi2xi 2+αi3xi 3+αi4xi 4+αi5xi 5
得到A点到B点之间的轨迹曲线li。
一些实施例中,生成单元还用于通过障碍物位姿信息与轨迹约束点对生成的轨迹曲线进行约束,包括以下步骤:
根据车道线函数,获取A点横坐标对应符合B点所在车道线函数上的控制点D,获取B点横坐标对应符合A点所在车道线函数上的控制点C;保留处于ABCD四点形成的包围框中的轨迹曲线。
一些实施例中,生成单元还用于通过障碍物位姿信息与轨迹约束点对生成的轨迹曲线进行约束,包括:根据所述障碍物位姿信息,排除与其冲突的轨迹曲线,形成约束后的轨迹曲线。
本发明中的基于车道线的弯道自动驾驶路网生成装置,用于:获取车辆当前位姿信息、障碍物在地图上的位姿信息与弯道信息;对所述车辆当前位姿信息以及障碍物在地图上的位姿信息进行分层采样,获取采样点信息;根据所述采样点信息与弯道信息在不同层的任意两点间生成轨迹曲线,通过障碍物位姿信息与轨迹约束点对生成的轨迹曲线进行约束;将所述约束后的多条轨迹曲线拼接成路网。在路网生成的过程中考虑了弯道的情况与道路上障碍物的信息,因此可以生成更加合理的路网。
需要说明的是,本申请实施例中的各步骤的步骤标号,其并不限制本申请技术方案中各操作的前后顺序。
需要说明的是,所属本领域的技术人员可以清楚地了解到,为了描述的方便和简洁,上述描述的装置和各单元的具体工作过程,可以参考前述基于车道线的弯道自动驾驶路网生成方法实施例中的对应过程,在此不再赘述。
上述实施例提供的装置可以实现为一种计算机程序的形式,该计算机程序可以在如图5所示的计算机设备上运行。
本申请实施例还提供了一种计算机设备,包括:通过系统总线连接的存储器、处理器和网络接口,存储器中存储有至少一条指令,至少一条指令由处理器加载并执行,以实现前述的基于车道线的弯道自动驾驶路网生成方法的全部步骤或部分步骤。
其中,网络接口用于进行网络通信,如发送分配的任务等。本领域技术人员可以理解,图5中示出的结构,仅仅是与本申请方案相关的部分结构的框图,并不构成对本申请方案所应用于其上的计算机设备的限定,具体的计算机设备可以包括比图中所示更多或更少的部件,或者组合某些部件,或者具有不同的部件布置。
处理器可以是CPU,还可以是其他通用处理器、DSP(Digital Signal Processor,数字信号处理器)、ASIC(Application Specific Integrated Circuit,专用集成电路)、FPGA(Field Programmable Gate Array,现场可编程逻辑门阵列)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件分立硬件组件等。通用处理器可以是微处理器,或者该处理器也可以是任何常规的处理器等,处理器是计算机装置的控制中心,利用各种接口和线路连接整个计算机装置的各个部分。
存储器可用于存储计算机程序和/或模块,处理器通过运行或执行存储在存储器内的计算机程序和/或模块,以及调用存储在存储器内的数据,实现计算机装置的各种功能。存储器可主要包括存储程序区和存储数据区,其中,存储程序区可存储操作系统、至少一个功能所需的应用程序(比如视频播放功能、图像播放功能等)等;存储数据区可存储根据手机的使用所创建的数据(比如视频数据、图像数据等)等。此外,存储器可以包括高速随存取存储器,还可以包括非易失性存储器,例如硬盘、内存、插接式硬盘、SMC(Smart MediaCard,智能存储卡)、SD(Secure digital,安全数字)卡、闪存卡(Flash Card)、至少一个磁盘存储器件、闪存器件或其他易失性固态存储器件。
本申请实施例还提供了一种计算机可读存储介质,其上存储有计算机程序,计算机程序被处理器执行时,实现前述的基于车道线的弯道自动驾驶路网生成的全部步骤或部分步骤。
本申请实施例实现前述的全部或部分流程,也可以通过计算机程序来指令相关的硬件来完成,计算机程序可存储于计算机可读存储介质中,该计算机程序在被处理器执行时,可实现上述各个方法的步骤。其中,计算机程序包括计算机程序代码,计算机程序代码可以为源代码形式、对象代码形式、可执行文件或某些中间形式等。计算机可读介质可以包括:能够携带计算机程序代码的任何实体或装置、记录介质、U盘、移动硬盘、磁碟、光盘、计算机存储器、ROM(Read-Only memory,只读存储器)、RAM(Random Access memory,随机存取存储器)、电载波信号、电信信号以及软件分发介质等。需要说明的是,计算机可读介质包含的内容可以根据司法管辖区内立法和专利实践的要求进行适当的增减,例如在某些司法管辖区,根据立法和专利实践,计算机可读介质不包括电载波信号和电信信号。
本领域内的技术人员应明白,本申请的实施例可提供为方法、系统、服务器或计算机程序产品。因此,本申请可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器和光学存储器等)上实施的计算机程序产品的形式。
本申请是参照根据本申请实施例的方法、设备(系统)和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
需要说明的是,在本文中,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者系统不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者系统所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括该要素的过程、方法、物品或者系统中还存在另外的相同要素。
以上所述仅是本申请的具体实施方式,使本领域技术人员能够理解或实现本申请。对这些实施例的多种修改对本领域的技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本申请的精神或范围的情况下,在其它实施例中实现。因此,本申请将不会被限制于本文所示的这些实施例,而是要符合与本文所申请的原理和新颖特点相一致的最宽的范围。
Claims (10)
1.一种基于车道线的弯道自动驾驶路网生成方法,其特征在于,该方法包括以下步骤:
获取车辆当前位姿信息、障碍物在地图上的位姿信息与弯道信息;
对所述车辆当前位姿信息以及障碍物在地图上的位姿信息进行分层采样,获取采样点信息;
根据所述采样点信息与弯道信息在不同层的任意两点间生成轨迹曲线,通过障碍物位姿信息与轨迹约束点对生成的轨迹曲线进行约束;
将所述约束后的多条轨迹曲线拼接成路网。
2.如权利要求1所述的一种基于车道线的弯道自动驾驶路网生成方法,其特征在于,所述车辆当前位姿信息包括坐标、航向角、曲率,弯道信息包括车道线信息与道路曲率半径。
3.如权利要求2所述的一种基于车道线的弯道自动驾驶路网生成方法,其特征在于,所述对所述车辆当前位姿信息以及障碍物在地图上的位姿信息进行分层采样,获取采样点信息,包括:
将所述位姿信息在以图为特征的状态空间中,进行横纵向的分层撒点;
先进行纵向分层采集,再进行横向等间隔采集,获取采样点;
获取每个采样点的坐标。
4.如权利要求3所述的一种基于车道线的弯道自动驾驶路网生成方法,其特征在于,所述根据所述采样点信息与弯道信息在不同层的任意两点间生成轨迹曲线,包括以下步骤:
获得车辆当前A点的坐标(xA,yA)、航向角θA和曲率kA;
根据第一算法得到A点曲率kA,所述第一算法包括:
其中RA为A点所在位置的弯道曲率半径,且A为轨迹起始点,A点的航向角θA=0,A点的位姿信息lA=0,lA`=0,lA``=0,其中lA表示A点的横向距离,lA`表示A点的横向速度,lA``表示A点的横向加速度。
5.如权利要求4所述的一种基于车道线的弯道自动驾驶路网生成方法,其特征在于,所述根据所述采样点信息与弯道信息在不同层的任意两点间生成轨迹曲线,还包括以下步骤:
获得采样点B点的坐标(xB,yB);
根据第二算法得到车道线函数y,所述第二算法包括:
y=b0+b1x+b2x2+b3x3
其中b0,b1,b2,b3为车道线的拟合系数,x表示车道线函数的自变量,y表示车道线函数的因变量;
得到A点到B点曲率半径变化量lB 0,B点横向速度lB`,B点的横向加速度lB``,其中RB为B点所在位置的弯道曲率半径,RA为A点所在位置的弯道曲率半径,y'表示车道线函数对x的一阶导数,y”表示车道线函数对x的二阶导数;
根据公式:
得到轨迹曲线的系数αi0,αi1,αi2,αi3,αi4,αi5,其中XA为A点横坐标,XB为B点横坐标;
根据公式:
li=αi0+αi1xi+αi2xi 2+αi3xi 3+αi4xi 4+αi5xi 5
得到A点到B点之间的轨迹曲线li。
6.如权利要求5所述的一种基于车道线的弯道自动驾驶路网生成方法,其特征在于,所述通过障碍物位姿信息与轨迹约束点对生成的轨迹曲线进行约束,包括以下步骤:
根据车道线函数,获取A点横坐标对应符合B点所在车道线函数上的控制点D,获取B点横坐标对应符合A点所在车道线函数上的控制点C;
保留处于ABCD四点形成的包围框中的轨迹曲线。
7.如权利要求5所述的一种基于车道线的弯道自动驾驶路网生成方法,其特征在于,所述通过障碍物位姿信息与轨迹约束点对生成的轨迹曲线进行约束,还包括:
根据所述障碍物位姿信息,排除与其冲突的轨迹曲线,形成约束后的轨迹曲线。
8.一种基于车道线的弯道自动驾驶路网生成装置,其特征在于,包括:
收集单元,用于获取车辆当前位姿信息、障碍物在地图上的位姿信息与弯道信息;
采样单元,用于对所述车辆当前位姿信息以及障碍物在地图上的位姿信息进行分层采样,获取采样点信息;
生成单元,用于根据所述采样点信息与弯道信息在不同层的任意两点间生成轨迹曲线,通过障碍物位姿信息与轨迹约束点对生成的轨迹曲线进行约束,并将约束后的多条轨迹曲线拼接成路网。
9.一种计算机设备,其特征在于,所述计算机设备包括处理器、存储器、以及存储在所述存储器上并可被所述处理器执行的计算机程序,其中所述计算机程序被所述处理器执行时,实现如权利要求1至7中任一项所述的步骤。
10.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质上存储有计算机程序,其中所述计算机程序被处理器执行时,实现如权利要求1至7中任一项所述的方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310792347.3A CN116811898A (zh) | 2023-06-29 | 2023-06-29 | 一种基于车道线的弯道自动驾驶路网生成方法与装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310792347.3A CN116811898A (zh) | 2023-06-29 | 2023-06-29 | 一种基于车道线的弯道自动驾驶路网生成方法与装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN116811898A true CN116811898A (zh) | 2023-09-29 |
Family
ID=88121719
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310792347.3A Pending CN116811898A (zh) | 2023-06-29 | 2023-06-29 | 一种基于车道线的弯道自动驾驶路网生成方法与装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116811898A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117496476A (zh) * | 2024-01-02 | 2024-02-02 | 安徽蔚来智驾科技有限公司 | 路网生成方法、可读存储介质及智能设备 |
-
2023
- 2023-06-29 CN CN202310792347.3A patent/CN116811898A/zh active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117496476A (zh) * | 2024-01-02 | 2024-02-02 | 安徽蔚来智驾科技有限公司 | 路网生成方法、可读存储介质及智能设备 |
CN117496476B (zh) * | 2024-01-02 | 2024-03-26 | 安徽蔚来智驾科技有限公司 | 路网生成方法、可读存储介质及智能设备 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
DE102018122459B4 (de) | Fahrzeugsystem, entferntes fahrzeugassistenzsystem und comuterimplementiertes verfahren zum bereitstellen von fernunterstützung | |
CN110481551B (zh) | 一种自动换道的控制方法、装置及车辆 | |
CN110136222B (zh) | 虚拟车道线生成方法、装置及系统 | |
DE102019102939A1 (de) | Systeme und Verfahren für Bewegungsplanung von autonomen Fahrzeugen | |
DE102017126021A1 (de) | Prozessor-implementierte systeme und verfahren zum automatisierten fahren | |
CN107310554A (zh) | 车辆行驶控制装置 | |
DE102018215668A1 (de) | Vorrichtung, Verfahren und System für autonomes Fahren | |
JP7172287B2 (ja) | 自動運転システム | |
US20170108870A1 (en) | Determining variance factors for complex road segments | |
DE112012007183T5 (de) | Fahrunterstützungsvorrichtung und Fahrunterstützungsverfahren | |
DE102011002275A1 (de) | Verfahren zur Prognose des Fahrverhaltens eines vorausfahrenden Fahrzeugs | |
CN116811898A (zh) | 一种基于车道线的弯道自动驾驶路网生成方法与装置 | |
CN112783149B (zh) | 具有分布式传感器架构以及嵌入式处理的智能车辆 | |
CN110109449A (zh) | 速度规划方法、装置、计算机设备和存储介质 | |
DE102020105657A1 (de) | Verfahren und Systeme für die Kartierung und Lokalisierung eines Fahrzeuges | |
DE102020202662A1 (de) | Platooning-steuerung zum durchführen einer bremssteuerung auf der grundlage eines winkels der anhängerkupplung, system mit derselben und verfahren davon | |
CN112542061B (zh) | 基于车联网的借道超车控制方法、装置、系统及存储介质 | |
CN115903854B (zh) | 一种动态结构化道路的自动驾驶实时轨迹规划方法 | |
CN114291092B (zh) | 车辆换道控制方法、装置、电子控制单元及存储介质 | |
CN112622924A (zh) | 一种驾驶规划方法及装置、车辆 | |
US10969231B2 (en) | Map data update system and non-transitory computer-readable storage medium | |
JP7085973B2 (ja) | 運転支援装置、車両、運転支援装置の制御方法および運転支援プログラム | |
CN115195743B (zh) | 基于无人驾驶的车辆自动变道方法、装置、设备及介质 | |
CN115675454B (zh) | 车辆碰撞识别方法、车载终端、车辆及存储介质 | |
US11981328B2 (en) | Vehicle object avoidance |
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 |