System.ArgumentOutOfRangeException: 索引和长度必须引用该字符串内的位置。 参数名: length 在 System.String.Substring(Int32 startIndex, Int32 length) 在 zhuanliShow.Bind()
【技术实现步骤摘要】
本专利技术涉及自适应巡航功能,具体涉及一种旁车道切入车辆的识别方法及系统。
技术介绍
1、现有自适应巡航功能主要是通过传感器和感知融合系统给出的最近在径车辆来实现对目标的距离保持和跟停等功能,但是现有的自适应巡航功能普遍缺少对旁车道切入车辆的关注,若旁车道车辆切入本车道后再选为最近在径车辆,就会导致自车控制不及时,进而引发制动晚和强制动等情况,车辆舒适性较差和安全性较差。
技术实现思路
1、有鉴于此,本专利技术实施例提供一种旁车道切入车辆的识别方法及系统,以解决自适应巡航功能普遍缺少对旁车道切入车辆的关注而导致的车辆舒适性较差和安全性较差等问题。
2、为实现上述目的,本专利技术实施例提供如下技术方案:
3、本专利技术实施例第一方面公开一种旁车道切入车辆的识别方法,所述方法包括:
4、采集控制车辆的第一运动状态信息和其他车辆的第二运动状态信息,所述第一运动状态信息至少包含速度和偏航角速度,所述第二运动状态信息至少包含相对横向位置、相对纵向位置、航向角和道线信息;
5、根据所述第一运动状态信息和所述第二运动状态信息,从所述其他车辆中确定待识别车辆;
6、基于所述待识别车辆在特定坐标系下的位置坐标点,确定所述待识别车辆的历史运动状态信息,所述特定坐标系为以所述控制车辆为原点的坐标系;
7、通过所述历史运动状态信息,确定所述待识别车辆的第一驾驶意图,所述第一驾驶意图为向左变道、向右变道或保持车道;
8、对所
9、预测所述待识别车辆的预测行车轨迹,并基于所述预测行车轨迹确定所述第一驾驶意图或所述第二驾驶意图为最终驾驶意图;
10、根据所述控制车辆的最近在径车辆信息、所述待识别车辆的所述第二运动状态信息和所述最终驾驶意图,从所述待识别车辆中识别出旁车道切入车辆。
11、优选的,所述根据所述第一运动状态信息和所述第二运动状态信息,从所述其他车辆中确定待识别车辆,包括:
12、根据所述第一运动状态信息和所述第二运动状态信息,确定所述其他车辆的绝对速度,及确定所述其他车辆与所述控制车辆的相对横向距离和相对纵向距离;
13、若所述其他车辆的绝对速度不为0,且,若所述其他车辆与所述控制车辆的相对横向距离小于横向距离阈值,且,若所述其他车辆与所述控制车辆的相对纵向距离小于纵向距离阈值,确定所述其他车辆为待识别车辆;
14、若所述其他车辆的绝对速度为0,和/或,若所述其他车辆与所述控制车辆的相对横向距离大于等于所述横向距离阈值,和/或,若所述其他车辆与所述控制车辆的相对纵向距离大于等于所述纵向距离阈值,确定所述其他车辆不是待识别车辆。
15、优选的,所述基于所述待识别车辆在特定坐标系下的位置坐标点,确定所述待识别车辆的历史运动状态信息,包括:
16、获取所述待识别车辆的历史行车轨迹,所述历史行车轨迹至少包含:所述待识别车辆在当前时刻和其他时刻下的位置坐标点和航向角;
17、计算所述控制车辆在单位采样时间内行驶的横向距离、纵向距离和航向角变化;
18、基于所述控制车辆在单位采样时间内行驶的横向距离、纵向距离和航向角变化,将所述历史行车轨迹中其他时刻的位置坐标点和航向角转换到特定坐标系下;
19、利用转换到所述特定坐标系下的所述历史行车轨迹中的其他时刻的位置坐标点和航向角,确定所述待识别车辆的历史运动状态信息,所述历史运动状态信息至少包含历史纵向位置、历史横向位置和历史航向角。
20、优选的,所述通过所述历史运动状态信息,确定所述待识别车辆的第一驾驶意图,包括:
21、获取所述待识别车辆所在车道的车道中心线方程y=c0+c1*x+c2*x2+c3*x3,c0为所述控制车辆到所述待识别车辆所在车道的车道中心线的横向距离,c1为斜率,c2为曲率,c3为曲率变化率;
22、基于所述车道中心线方程和所述历史运动状态信息,结合dθt=1:n=headinghist-atan(y't=1:n)和dyt=1:n=yhist-yt=1:n,计算识别分量,yhist和headinghist分别为所述待识别车辆的历史横向位置和历史航向角,t=1表示当前时刻,t=n表示所述历史运动状态信息的末尾时刻,所述识别分量包含:所述待识别车辆的航向角与道线角度的航向角偏差dθt=1:n,及所述待识别车辆与所述待识别车辆所在车道的车道中心线的横向距离偏差dyt=1:n;
23、对所述识别分量进行归一化处理;
24、计算归一化处理后的所述识别分量与左变道边界椭圆的两个焦点的距离之和,得到第一值;以及计算归一化处理后的所述识别分量与右变道边界椭圆的两个焦点的距离之和,得到第二值;
25、若所述第一值大于指定阈值,确定所述待识别车辆的第一驾驶意图为向左变道;
26、若所述第二值大于所述指定阈值,确定所述待识别车辆的第一驾驶意图为向右变道;
27、若所述第一值和所述第二值不大于所述指定阈值,确定所述待识别车辆的第一驾驶意图为保持车道。
28、优选的,所述对所述第一驾驶意图进行修正以得到所述待识别车辆的第二驾驶意图,包括:
29、对于所述待识别车辆与所述待识别车辆所在车道的车道中心线的横向距离偏差,将所述横向距离偏差按照时间顺序分为m段;
30、当所述第一驾驶意图为向左变道时,若m段所述横向距离偏差依序递减,则确定所述待识别车辆的第二驾驶意图为向左变道;若m段所述横向距离偏差未依序递减,则确定所述第二驾驶意图为保持车道;
31、当所述第一驾驶意图为向右变道时,若m段所述横向距离偏差依序递增,则确定所述待识别车辆的第二驾驶意图为向右变道;若m段所述横向距离偏差未依序递增,则确定所述第二驾驶意图为保持车道。
32、优选的,所述对于所述待识别车辆与所述待识别车辆所在车道的车道中心线的横向距离偏差,将所述横向距离偏差按照时间顺序分为m段,包括:
33、对于所述待识别车辆与所述待识别车辆所在车道的车道中心线的横向距离偏差dyt=1:n,通过将所述横向距离偏差按照时间顺序分为m段,每一段横向距离偏差包含n/m个点。
34、优选的,所述预测所述待识别车辆的预测行车轨迹,并基于所述预测行车轨迹确定所述第一驾驶意图或所述第二驾驶意图为最终驾驶意图,包括:
35、对所述待识别车辆的横向位置采用匀速运动模型递推,及对所述待识别车辆的纵向位置采用匀加速运动模型递推,得到所述待识别车辆的预测行车轨迹,所述预测行车轨迹包含多个未来轨迹点;
36、计算所述预测行车轨迹中最后一个未来轨迹点与所述控制车辆所在车道的道线的横向距离;
37、若所述最后一个未来轨迹点在所述控制车辆所在车道内,且若所述最后一个本文档来自技高网...
【技术保护点】
1.一种旁车道切入车辆的识别方法,其特征在于,所述方法包括:
2.根据权利要求1所述的旁车道切入车辆的识别方法,其特征在于,所述根据所述第一运动状态信息和所述第二运动状态信息,从所述其他车辆中确定待识别车辆,包括:
3.根据权利要求1所述的旁车道切入车辆的识别方法,其特征在于,所述基于所述待识别车辆在特定坐标系下的位置坐标点,确定所述待识别车辆的历史运动状态信息,包括:
4.根据权利要求1-3中任一所述的旁车道切入车辆的识别方法,其特征在于,所述通过所述历史运动状态信息,确定所述待识别车辆的第一驾驶意图,包括:
5.根据权利要求4所述的旁车道切入车辆的识别方法,其特征在于,所述对所述第一驾驶意图进行修正以得到所述待识别车辆的第二驾驶意图,包括:
6.根据权利要求5所述的旁车道切入车辆的识别方法,其特征在于,所述对于所述待识别车辆与所述待识别车辆所在车道的车道中心线的横向距离偏差,将所述横向距离偏差按照时间顺序分为m段,包括:
7.根据权利要求1-3中任一所述的旁车道切入车辆的识别方法,其特征在于,所述预测所述
8.根据权利要求1-3中任一所述的旁车道切入车辆的识别方法,其特征在于,所述根据所述控制车辆的最近在径车辆信息、所述待识别车辆的所述第二运动状态信息和所述最终驾驶意图,从所述待识别车辆中识别出旁车道切入车辆,包括:
9.根据权利要求1-3中任一所述的旁车道切入车辆的识别方法,其特征在于,所述从所述待识别车辆中识别出旁车道切入车辆之后,还包括:
10.一种旁车道切入车辆的识别系统,其特征在于,所述系统包括:
...【技术特征摘要】
1.一种旁车道切入车辆的识别方法,其特征在于,所述方法包括:
2.根据权利要求1所述的旁车道切入车辆的识别方法,其特征在于,所述根据所述第一运动状态信息和所述第二运动状态信息,从所述其他车辆中确定待识别车辆,包括:
3.根据权利要求1所述的旁车道切入车辆的识别方法,其特征在于,所述基于所述待识别车辆在特定坐标系下的位置坐标点,确定所述待识别车辆的历史运动状态信息,包括:
4.根据权利要求1-3中任一所述的旁车道切入车辆的识别方法,其特征在于,所述通过所述历史运动状态信息,确定所述待识别车辆的第一驾驶意图,包括:
5.根据权利要求4所述的旁车道切入车辆的识别方法,其特征在于,所述对所述第一驾驶意图进行修正以得到所述待识别车辆的第二驾驶意图,包括:
6.根据权利要求5所述的旁车道切入车辆的识别方法,其特征在于...
【专利技术属性】
技术研发人员:张洪伟,葛彦悟,刘祥,万国强,
申请(专利权)人:北京经纬恒润科技股份有限公司,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。