一种构建后方车道线的方法转让专利

申请号 : CN202210152859.9

文献号 : CN114510055B

文献日 :

基本信息:

PDF:

法律信息:

相似专利:

发明人 : 史兴领陈辰檀杰陈英箭沈伟江

申请人 : 科大国创合肥智能汽车科技有限公司

摘要 :

本发明公开了一种构建后方车道线的方法,涉及驾驶辅助技术领域,通过利用车辆上的视频采集终端,获取车道信息,从而使得即使车辆无定位信号,依旧能够依靠车辆自身建立离线车道地图,如果是车队,则能够依靠前车建立离线车道地图,方便进行车队管理,通过前车构建的离线车道地图为后方车辆提供车道信息;通过前车能够管理车队后方车辆是否在正确跟踪,便于实时监测;当只有本车时,则可以检测后方其他车辆是否是在跟踪本车,判断是否会发生碰撞等事故,避免发生车辆碰撞的风险,本发明通过一个较低的成本构建后方车道环境,从而实现实时建图,同时调整构建的后方道路的长短,且能够构建各种形状的复杂道路,提高了构建后方复杂环境的能力。

权利要求 :

1.一种构建后方车道线的方法,其特征在于,包括以下步骤:步骤一:通过安装在车辆上的视频采集终端,获取车辆所在环境的道路信息,并对所获得的道路信息进行存储;

步骤二:根据所获取到的道路信息,建立后方车道线,并对后方车道线进行拼接;

步骤三:根据车辆在后方车道线上的位姿进行坐标转换,并更新后方车道线的环境;

步骤四:将构建好的后方车道线与环境进行匹配,并对后方车辆做出路径规划;

视频采集终端安装在车辆的前方,实时获取车辆前方的道路信息,所述视频采集终端获取车辆前方的道路信息的过程包括:通过视频采集终端实时获取车辆前方的视频,并按照车辆所行驶的里程距离,周期性的将所获取到的车辆前方的视频进行保存;并根据视频采集终端上传的视频,构建车辆的后方车道线;

所述后方车道线的构建过程包括:

以车辆所在位置为原点,构建平面坐标系,平面坐标系的横轴为x轴,纵轴为y轴;

根据所获得的视频,获得车辆前方的车道的曲率和曲率变化率,并将曲率和曲率变化率分别标记为c1和c2;曲率和曲率变化率为常规量,即不会随着坐标系而发生变化;

实时获取车辆在行驶过程中的航向角以及车辆在车道内的横向偏移量,并分别将车辆在行驶过程中的航向角以及车辆在车道内的横向偏移量标记为C和D;

根据所获得的视频,对视频中的车道进行识别,并将车辆所在的车道进行标记,根据所标记的车道,生成车辆的后方车道线;

3 2

则所形成的后方车道线的方程为y=A*x+B*x+C*x+D;

其中A=c2/6;

B=0.5*c1;

随着车辆的移动,每隔一段时间,则获得一段新的视频,从而对后方车道线的曲率和曲率变化率进行不断更新,进而获得新的A和B,并将所获得的新的A和B的值代入至后方车道线的方程内,再结合实时获取的车辆在行驶过程中的航向角以及车辆在车道内的横向偏移量,并生成新的后方车道线,获得新的后方车道线方程;

将获得的每段后方车道线进行拼接,并对拼接处做光滑处理,具体过程包括:将生成的多段后方车道线的连接点进行标记,并通过旋转和平移的方法将多段后方车道线进行拼接:设连接点的坐标为(x1,y1);

在连接点处的车辆的航向角以及车辆在车道内的横向偏移量分别为C和D;

且根据连接点处的车道线的曲率以及曲率变化率获得A1和B1;

则获得后方车道线的连接点处的方程满足:

3 2

y=A*x+B*x+C*x+D;

3 2

y=A1*x+B1*x+C*x+D;

对后方车道线方程进行求导,则获得求导后的后方车道线方程为:2

y=3A*x+2B*x+C

2

y=3A1*x+2B1*x+C;

将连接点处的坐标(x1,y1)代入至上述方程,即可获得C的值,再将C和连接点坐标(x1,

3 2

y1)代入至y=A1*x+B1*x+C*x+D,获得D的值,完成连接点处的光滑处理,从而获得完整的后方车道线;

在获得完整的后方车道线后,则根据车辆在车道线内的位姿,获得车辆前方的环境数据,所述环境数据包括位于车道线内的静态目标位置和动态目标位置;将静态目标位置和动态目标位置的坐标进行标记;

根据所获得的静态目标位置和动态目标位置,对后方车道线内的环境进行更新,并根据更新后的后方车道线内的环境进行路径规划;

所述路径规划的过程包括:

将所获得的静态目标位置和动态目标位置在平面坐标系内进行标记;

根据平面坐标系中静态目标位置和动态目标位置,对车辆的行驶路径进行调整,使得车辆对静态目标位置和动态目标位置进行规避。

说明书 :

一种构建后方车道线的方法

技术领域

[0001] 本发明涉及驾驶辅助技术领域,具体是一种构建后方车道线的方法。

背景技术

[0002] 摄像机的标定在机器视觉领域是必不可少的技术。尤其在车载领域高级驾驶辅助系统,包括车辆检测、行人检测、盲区检测、车道线检测等都需要标定才能实现;
[0003] 现有技术方案大都是在车辆的后玻璃上粘贴一个额外的摄像头来检测后方车道线,这样的解决方案首先是成本比较高,同时检测的距离有限,且性能还容易受到天气质量以及被后方车辆遮挡的影响,不足以弥补远距离车道线检测的缺陷,例如:车队管理以及后方场景环境的构建,为此,现提供一种构建后方车道线的方法。

发明内容

[0004] 本发明的目的在于提供一种构建后方车道线的方法。
[0005] 本发明的目的可以通过以下技术方案实现:一种构建后方车道线的方法,包括以下步骤:
[0006] 步骤一:通过安装在车辆上的视频采集终端,获取车辆所在环境的道路信息,并对所获得的道路信息进行存储;
[0007] 步骤二:根据所获取到的道路信息,建立后方车道线,并对后方车道线进行拼接;
[0008] 步骤三:根据车辆在后方车道线上的位姿进行坐标转换,并更新后方车道线的环境;
[0009] 步骤四:将构建好的后方车道线与环境进行匹配,并对后方车辆做出路径规划。
[0010] 进一步的,视频采集终端安装在车辆的前方,实时获取车辆前方的道路信息,所述视频采集终端获取车辆前方的道路信息的过程包括:
[0011] 通过视频采集终端实时获取车辆前方的视频,并按照车辆所行驶的里程距离,周期性的将所获取到的车辆前方的视频进行保存;并根据视频采集终端上传的视频,构建车辆的后方车道线。
[0012] 进一步的,所述后方车道线的构建过程包括:
[0013] 以车辆所在位置为原点,构建平面坐标系;
[0014] 根据所获得的视频,对视频中的车道进行识别,将车辆所在的车道进行标记,根据所标记的车道,获得车道的曲率和曲率变化率,实时获取车辆在行驶过程中的航向角以及车辆在车道内的横向偏移量,获得后方车道线的方程,并获得在平面坐标系内生成车辆的后方车道线。
[0015] 进一步的,车道的曲率和曲率变化率为常规量,即不会随着坐标系而发生变化。
[0016] 进一步的,随着车辆的移动,每隔一段时间,则获得一段新的视频,从而对车道的曲率和曲率变化率进行不断更新,再结合实时获取的车辆在行驶过程中的航向角以及车辆在车道内的横向偏移量,并生成新的后方车道线,获得新的后方车道线方程。
[0017] 进一步的,将获得的新的每段后方车道线进行拼接,并对拼接处做光滑处理,包括:
[0018] 将生成的多段后方车道线的连接点进行标记,获得连接点的坐标以及在连接点处的车辆的航向角以及车辆在车道内的横向偏移量;
[0019] 根据连接点处的车道线的曲率以及曲率变化率获得A1和B1;
[0020] 获得满足后方车道线的连接点处的方程,然后对后方车道线方程进行求导,则获得求导后的后方车道线方程;
[0021] 将连接点处的坐标代入至求导后的后方车道线方程,即可获得车辆的航向角以及车辆在车道内的横向偏移量,完成连接点处的光滑处理,并获得完整的后方车道线。
[0022] 进一步的,在获得完整的后方车道线后,则根据车辆在车道线内的位姿,获得车辆前方的环境数据,所述环境数据包括位于车道线内的静态目标位置和动态目标位置;将静态目标位置和动态目标位置的坐标进行标记;
[0023] 根据所获得的静态目标位置和动态目标位置,对后方车道线内的环境进行更新,并根据更新后的后方车道线内的环境进行路径规划。
[0024] 进一步的,所述路径规划的过程包括:
[0025] 将所获得的静态目标位置和动态目标位置在平面坐标系内进行标记;
[0026] 根据平面坐标系中静态目标位置和动态目标位置,对车辆的行驶路径进行调整,使得车辆对静态目标位置和动态目标位置进行规避。
[0027] 与现有技术相比,本发明的有益效果是:通过利用车辆上的视频采集终端,获取车道信息,从而使得即使车辆无定位信号,依旧能够依靠车辆自身建立离线车道地图,如果是车队,则能够依靠前车建立离线车道地图,方便进行车队管理,通过前车构建的离线车道地图为后方车辆提供车道信息;通过前车能够管理车队后方车辆是否在正确跟踪,便于实时监测;当只有本车时,则可以检测后方其他车辆是否是在跟踪本车,判断是否会发生碰撞等事故,避免发生车辆碰撞的风险,本发明通过一个较低的成本构建后方车道环境,从而实现实时建图,同时调整构建的后方道路的长短,且能够构建各种形状的复杂道路,提高了构建后方复杂环境的能力,同时本发明可以依据每个解决方案的不同自主选择构建不同距离的后方车道线,理论上是可以无线延伸。

附图说明

[0028] 图1为本发明的流程图。

具体实施方式

[0029] 如图1所示,一种构建后方车道线的方法,包括以下步骤:
[0030] 步骤一:通过安装在车辆上的视频采集终端,获取车辆所在环境的道路信息,并对所获得的道路信息进行存储;
[0031] 步骤二:根据所获取到的道路信息,建立后方车道线,并对后方车道线进行拼接;
[0032] 步骤三:根据车辆在后方车道线上的位姿进行坐标转换,并更新后方车道线的环境;
[0033] 步骤四:将构建好的后方车道线与环境进行匹配,并对后方车辆做出路径规划。
[0034] 在具体实施过程中,视频采集终端安装在车辆的前方,实时获取车辆前方的道路信息,所述视频采集终端获取车辆前方的道路信息的具体过程包括:
[0035] 通过视频采集终端实时获取车辆前方的视频,并按照车辆所行驶的里程距离,周期性的将所获取到的车辆前方的视频进行保存;需要进一步说明的是,在具体实施过程,车辆每行驶一段距离,则将所获取到的车辆前方的视频进行上传,并保存,从而保证视频采集终端的内存空间不被占用;
[0036] 举例说明:车辆在车道上行驶时,通过车辆的里程表记录车辆的行驶距离,车辆每行驶50米距离,则将视频采集终端所获取的车辆行驶的这50米距离内的视频数据进行上传,然后获取新的视频,以此类推。
[0037] 根据视频采集终端上传的视频,构建车辆的后方车道线,所述后方车道线的构建过程具体包括:
[0038] 以车辆所在位置为原点,构建平面坐标系,平面坐标系的横轴为x轴,纵轴为y轴;
[0039] 根据所获得的视频,获得车辆前方的车道的曲率和曲率变化率,并将曲率和曲率变化率分别标记为c1和c2;需要进一步说明的是,在具体实施过程中,曲率和曲率变化率为常规量,即不会随着坐标系而发生变化;
[0040] 实时获取车辆在行驶过程中的航向角以及车辆在车道内的横向偏移量,并分别将车辆在行驶过程中的航向角以及车辆在车道内的横向偏移量标记为C和D;
[0041] 根据所获得的视频,对视频中的车道进行识别,并将车辆所在的车道进行标记,根据所标记的车道,生成车辆的后方车道线;
[0042] 则所形成的后方车道线的方程为y=A*x3+B*x2+C*x+D;
[0043] 其中A=c2/6;
[0044] B=0.5*c1;
[0045] 需要进一步说明的是,在具体实施过程中,随着车辆的移动,每隔一段时间,则获得一段新的视频,从而对后方车道线的曲率和曲率变化率进行不断更新,进而获得新的A和B,并将所获得的新的A和B的值代入至后方车道线的方程内,再结合实时获取的车辆在行驶过程中的航向角以及车辆在车道内的横向偏移量,并生成新的后方车道线,获得新的后方车道线方程;
[0046] 需要进一步说明的是,在具体实施过程中,通过车辆在行驶过程中的航向角以及车辆在车道内的横向偏移量,从而能够使得车辆在不同形状的车道内,均能构建出相应的后方车道线,如“S”弯道路。
[0047] 需要进一步说明的是,在具体实施过程中,将获得的每段后方车道线进行拼接,并对拼接处做光滑处理,具体过程包括:
[0048] 将生成的多段后方车道线的连接点进行标记,并通过旋转和平移的方法将多段后方车道线进行拼接:
[0049] 设连接点的坐标为(x1,y1);
[0050] 在连接点处的车辆的航向角以及车辆在车道内的横向偏移量分别为C和D;
[0051] 且根据连接点处的车道线的曲率以及曲率变化率获得A1和B1;
[0052] 则获得后方车道线的连接点处的方程满足:
[0053] y=A*x3+B*x2+C*x+D;
[0054] y=A1*x3+B1*x2+C*x+D;
[0055] 对后方车道线方程进行求导,则获得求导后的后方车道线方程为:
[0056] y=3A*x2+2B*x+C
[0057] y=3A1*x2+2B1*x+C;
[0058] 将连接点处的坐标(x1,y1)代入至上述方程,即可获得C的值,再将C和连接点坐标3 2
(x1,y1)代入至y=A1*x+B1*x+C*x+D,获得D的值,完成连接点处的光滑处理,从而获得完整的后方车道线。
[0059] 需要进一步说明的是,在具体实施过程中,通过利用前车上的视频采集终端,获取车辆前方的车道信息,从而使得即使车辆无定位信号,依旧能够依靠前车建立离线车道地图,在具体实施过程中,如果是车队,则能够方便进行车队管理,通过前车构建的离线车道地图为后方车辆提供车道信息;
[0060] 通过前车能够根据,管理车队后方车辆是否在正确跟踪,便于实时监测;
[0061] 如果只有一个车辆,则可以检测后方其他车辆是否是在跟踪本车,判断是否会发生碰撞等事故,避免发生车辆碰撞的风险;
[0062] 需要进一步说明的是,在具体实施过程中,在获得完整的后方车道线后,则根据车辆在车道线内的位姿,获得车辆前方的环境数据,所述环境数据包括位于车道线内的静态目标位置和动态目标位置;将静态目标位置和动态目标位置的坐标进行标记;
[0063] 根据所获得的静态目标位置和动态目标位置,对后方车道线内的环境进行更新,并根据更新后的后方车道线内的环境进行路径规划;
[0064] 所述路径规划的过程具体包括:
[0065] 将所获得的静态目标位置和动态目标位置在平面坐标系内进行标记;
[0066] 根据平面坐标系中静态目标位置和动态目标位置,对车辆的行驶路径进行调整,使得车辆对静态目标位置和动态目标位置进行规避;
[0067] 需要进一步说明的是,在具体实施过程中,静态目标包括位于车道上的相对于道路静止的障碍物,如石头、路障、栏杆等;所述动态目标包括位于车道上的相当于道路在移动的障碍物,如行人、车辆等;
[0068] 需要进一步说明的是,在具体实施过程中,对车辆的行驶路径的调整方式包括临时变换车道、减速以及停车等。
[0069] 以上实施例仅用以说明本发明的技术方法而非限制,尽管参照较佳实施例对本发明进行了详细说明,本领域的普通技术人员应当理解,可以对本发明的技术方法进行修改或等同替换,而不脱离本发明技术方法的精神和范围。