一种基于轨迹分析的行驶区域估计方法与流程

摘要: 本发明属于高级驾驶辅助系统,具体涉及一种基于轨迹分析的行驶区域估计方法。背景技术:1、驾驶辅助系统是利用安装在车辆上的传感、通信、决策及执行等装置,监测驾驶员、...
一种基于轨迹分析的行驶区域估计方法与流程

本发明属于高级驾驶辅助系统,具体涉及一种基于轨迹分析的行驶区域估计方法。

背景技术:

1、驾驶辅助系统是利用安装在车辆上的传感、通信、 决策及执行等装置,监测驾驶员、车辆及其行驶环境并通过影像、灯光、 声音、触觉提示/警告或控制等方式辅助驾驶员执行驾驶任务或主动避免/减轻碰撞危害的各类系统的总称。智能摄像头是通过软件算法实现前方车道线和车辆、行人的位置、速度等信息探测功能的车载摄像头。轮速传感器是用来测量车轮转速的传感器,结合轮胎周长可测量出车速。esc(电子稳定性控制)是实时监控车辆运行状态,根据需要调节制动力和车辆的驱动扭矩以改变车辆横摆力矩,使车辆按驾驶员意图行驶的主动安全系统。

2、现有驾驶辅助系统采用的一种方案,如图1所示,智能摄像头通过传感器采集前方道路图像,对图像进行去畸变等图像处理,提取图像中的车道线信息并进行透视变换,将图像数据转换为鸟瞰图视角下的图像,然后对车道线进行识别与曲线拟合,获取前方车道线曲线参数信息,作为车辆的预计行驶区域,此方案在车道线清晰、光线状态良好的情况下识别较稳定,并且能够直观地获取前方道路信息。该方案受限于摄像头传感器的感知条件,导致在夜晚、逆光、车道线不清晰等摄像头感知识别效果较差的工况下车道线检测不准确或无法检测;该方案受限于图像识别工作原理,该方案在大半径、曲率较小的弯道工况下车道线检测参数有误差,可能会将大半径、曲率较小的弯道识别为直道;前方车道线识别不准确导致车辆预计行驶状态不准确,从而导致预计行驶区域判断错误。

3、现有驾驶辅助系统采用的另一种方案,如图2所示,通过轮速传感器与esc模块检测本车车速与横摆角速度信息,依据车速、横摆角速度与车辆转弯半径的计算关系,实时估算车辆当前行驶的转弯半径,依据车辆宽度经验值和转弯半径参数估算车辆预计行驶区域。此方案不受车道线清晰度、光线条件影响,适应性较强。此方案采用车速与横摆角速度估算行驶区域,可解决在无车道线、光线较暗工况摄像头识别车道线困难,行驶区域预估无法估计的问题,但由于车辆在行驶过程中若驾驶员主动进行方向盘微调或经过减速带、石子、侧倾路面时车速、横摆角速度可能存在跳变,从而导致行驶区域估算不准确。因此,需要设计一种基于轨迹分析的行驶区域估计方法,以解决辅助驾驶车辆在行驶区域估计时受道路车道线标记情况、光照条件、驾驶员主动进行方向盘微调等诸多影响,导致估计精度不准确或无法估计的问题,从而影响acc、智能避让等功能使用预计行驶区域识别潜在碰撞风险目标的准确性,横纵向控制效果不稳定且存在一定的碰撞风险。

技术实现思路

1、本发明目的在于提供一种基于轨迹分析的行驶区域估计方法,旨在解决辅助车辆行驶区域估计不稳定导致的横纵向控制效果不稳定、存在碰撞风险的问题。本方法通过存储车辆历史车速信息、横摆角速度信息,生成车辆历史轨迹点,对轨迹点进行一次拟合、二次拟合,获取和方差sse、决定系数r2等拟合参数,根据曲线拟合参数及拟合效果判断当前车辆行驶工况为直线行驶或弯道行驶,然后依据车宽、车速及预瞄时间即可确定车辆预计行驶区域。

2、为了解决现有技术存在的上述问题,本发明所采用的技术方案为:一种基于轨迹分析的行驶区域估计方法,包括以下步骤:

3、s1、车辆历史轨迹点计算与更新:驾驶辅助系统实时接收车辆行驶信息,并存储至车辆历史轨迹中,对存储历史轨迹进行更新维护;

4、s2、轨迹点坐标转换:驾驶辅助系统将车辆轨迹进行坐标旋转处理,使得历史轨迹点在xy坐标系中形成平行于y轴的直线或开口向下的抛物线;

5、s3、轨迹点一次、二次多项式线性拟合:步骤s2处理后的车辆历史轨迹点进行拟合,获取拟合多项式系数,并计算和方差sse、确定系数r2的拟合评估参数;

6、s4、车辆行驶状态判断:驾驶辅助系统根据历史轨迹一次、二次多项式拟合后的评估参数,判断轨迹与一次、二次函数曲线的拟合度,明确车辆当前行驶工况为直线行驶或弯道行驶;

7、s5、车辆行驶区域边界参数确定:驾驶辅助系统依据车辆当前行驶工况完成轨迹拟合后,直道工况下使用一次拟合多项式系数估计车辆预计行驶路径,弯道工况下使用二次拟合多项式系数估计车辆预计行驶路径,并依据车辆宽度、车速、预瞄时间界定车辆预计行驶区域。

8、优选的是,所述步骤s1中车辆行驶信息包括横摆角速度和当前车速信号,当车速大于40km/h后进行轨迹点计算,初始点坐标为(0,0),当前轨迹点与下一轨迹点的计算方法为:

9、;

10、;

11、;

12、式中θ表示轨迹点处车辆行驶方向与初始点车辆行驶方向的夹角,yawrate表示车辆当前横摆角速度,t表示相邻两个轨迹点之间的时间差,pathx、pathy表示各轨迹点在笛卡尔坐标系下的位置,v表示各轨迹点处的车辆速度。

13、优选的是,所述步骤s2中驾驶辅助系统获取到车辆历史轨迹后,对车辆轨迹使用最小二乘法进行一次线性拟合,得到拟合直线斜率系数,转换成角度后对所有轨迹点进行旋转坐标转换。

14、优选的是,所述步骤s3中车辆历史轨迹点的拟合使用最小二乘法对车辆历史轨迹分别进行一次拟合、二次拟合,分别计算拟合后的和方差sse、确定系数r2。

15、优选的是,所述步骤s4中车辆当前行驶工况依据一次拟合、二次拟合的和方差sse、确定系数r2进行判断,当车辆轨迹点的一次拟合与二次拟合的和方差均较小时,表明车辆轨迹点近似一条直线,判断车辆在直线行驶路段;当车辆轨迹非直线行驶时,若二次拟合的和方差较小,且确定系数r2较大,表明车辆轨迹点近似一条抛物线,判断车辆在弯道行驶路段。

16、优选的是,所述步骤s5中驾驶辅助系统判断车辆行驶在直道或弯道工况时,车辆运动姿态稳定,使用轨迹拟合得到的曲线参数作为车辆预计行驶轨迹;当车辆行驶在弯道工况时,使用二次曲线的二次项系数作为当前车辆行驶路径的曲线参数,当行驶在直道工况时则认为车辆预计行驶路径为车辆正前方,则无需参考拟合参数。

17、优选的是,所述驾驶辅助系统依据预计行驶路径的车辆宽度、车速、预瞄时间界定车辆预计行驶区域,具体公式为:

18、;

19、;

20、;

21、式中xp表示预瞄纵向距离,v代表本车车速,t代表预瞄时间,yl[x]、yr[x]表示纵向距离x处的预计行驶区域左右边界,a表示弯道工况时曲线拟合的二次项系数,直道工况时a为0,w表示车辆宽度,公式表示预瞄纵向距离x、预计行驶区域左右边界yl[x]、yr[x]共同明确车辆预计行驶区域的完整边界,使用此区域判断预计行驶区域内的潜在碰撞风险目标。

22、本发明的有益效果为:

23、本发明设计的基于轨迹分析的行驶区域估计方法,通过存储车辆历史车速信息、横摆角速度信息,计算车辆历史轨迹点,对轨迹点进行线性拟合,根据轨迹拟合程度判断当前车辆行驶工况为直线行驶或弯道行驶,通过分析轨迹拟合参数确定车辆行驶工况,进行车辆行驶区域预估,可在无车道线、小曲率弯道工况下计算出稳定的、精度较高的车辆预计行驶区域,从而依据预计行驶区域选择出更准确的跟随目标、潜在碰撞风险目标,防止由于行驶区域估计不稳定从而导致横纵向控制效果不稳定及碰撞风险。