一种弯道超速预警及主动限速方法和系统与流程

本发明属于自动驾驶系统等相关领域，具体涉及一种弯道超速预警及主动限速方法。

背景技术：

近年来，互联网技术、高精度地图和人工智能的迅速发展和广泛应用促进了自动驾驶技术的发展。相关报道表明，自动驾驶技术可减少90％交通事故，降低70％出行成本，以及有望成为下一代计算平台。

自动驾驶技术主要包括感知、决策和执行三大环节。首先通过摄像头、激光雷达或毫米波雷达等传感器设备，采集与处理环境信息和车内信息；然后依据获取的信息和驾驶员意图进行决策判断，制定相应的控制策略；最后由执行系统对车辆机械能控制，反馈到底层模块执行任务，包括线控加减速、线控制动和线控转向等。

弯道高速行驶是引发交通事故的很大原因，由于车辆在弯道行驶时离心力的作用，易发生侧滑或倾斜，使车辆变得难以驾驭，从而造成失控、侧滑甚至翻倾等事故。因此本发明提出一种弯道超速预警及主动限速的智能系统，该系统可进行弯道超速预警，及根据前方道路弯道的缓急主动限速，保证车辆安全及其舒适性。

技术实现要素：
：

为了克服上述背景技术的缺陷，本发明提供一种弯道超速预警及主动限速方法，能配合自动驾驶功能，将车速控制在安全速度范围内，并在驶出弯道时自动恢复到预期车速。

为了解决上述技术问题本发明的所采用的技术方案为：

一种弯道超速预警及主动限速方法，包括：

步骤1，检测车道信息，获取道路曲率序列，获取曲率最大值，及对应的相对纵向距离d；

步骤2，获取与道路曲率序列对应的允许车速序列v及允许车速最小值vmin；

步骤3，获取当前车速，判断当前车速入弯是否存在偏离车道风险，若是，则进入步骤4，若否，则将输出系统允许最大车速值输出至驱动制动系统，并步骤6；

步骤4，结合当前车速、相对纵向距离d和允许车速vmin，获取到达弯最急点所需的时间ttcp；

步骤5，在允许车速序列v中查找与到达弯最急点所需的时间ttcp对应的限速值vlimit，将限速值vlimit输出至驱动制动系统，并进入步骤6；

步骤6，根据驱动制动系统执行接收到的速度值。

较佳地，步骤1检测车道信息包括：获取车道线信息车道线位置c0、航向角c1、车道线曲率c2和车道线曲率随z的变化率c3。

较佳地，步骤1获取道路曲率序列的方法包括：根据传感器获取到的范围内道路的车道线信息通过以下公式计算曲率序列

较佳地，获取与道路曲率序列对应的允许车速序列v的方法包括：

依据曲率序列ρ结合公式即得到对应的允许车速序列v。

较佳地，步骤3获取当前车速，判断当前车速入弯是否存在偏离车道风险的具体方法包括：

获取当前车速，判断当前车速是否大于允许车速最小值vmin，若是，则存在偏离车道风险，若否，则不存在偏离车道风险。

较佳地，步骤4，结合当前车速vcur、相对纵向距离d和允许车速vmin，获取到达弯最急点所需的时间ttcp的具体方法包括：

较佳地，步骤4还包括通过仪表和生意发出提醒的步骤。

本发明还提供一种弯道超速预警及主动限速系统，包括传感设备、弯道超速处理模块、弯道超速预警模块和主动限速模块。

较佳地，传感设备用于检测车道信息，获取道路曲率序列，获取曲率最大值，及对应的相对纵向距离d；

弯道超速处理模块用于获取与道路曲率序列对应的允许车速序列v及允许车速最小值vmin，获取当前车速，判断当前车速入弯是否存在偏离车道风险，若是，则结合当前车速、相对纵向距离d和允许车速vmin，获取到达弯最急点所需的时间ttcp，在允许车速序列v中查找与到达弯最急点所需的时间ttcp对应的限速值vlimit，将限速值vlimit输出至驱动制动系统；

主动限速模块用于驱动制动系统执行接收到的速度值。

较佳地，弯道超速预警模块用于发出仪表和声音报警。

本发明的有益效果在于：本发明根据传感设备检测到的车道线信息、车辆运动状态及弯道中安全/舒适的侧向加速度要求等，判断以当前车速入弯是否存在偏离车道的风险，如果存在风险，通过仪表或扬声器等设备提示驾驶员；在搭载有定速巡航/自适应巡航等自动驾驶功能的车辆上，能配合自动驾驶功能，将车速控制在安全速度范围内，并在驶出弯道时自动恢复到预期车速。

附图说明

图1为本发明实施例方法所适用的场景示意图；

图2为本发明实施例一的方法流程图；

图3为本发明实施例二的系统结构示意图；

图4为本发明实施例二中摄像头在坐标系中的位置示意图。

具体实施方式

下面结合附图和实施例对本发明做进一步的说明。

实施例一

一种弯道超速预警及主动限速的智能方法，其场景示意图如图1所示，本实施例主要包括以下步骤：

根据传感设备检测到的车道信息，计算车道曲率值ρ并搜索曲率最大值ρmax

步骤1，根据传感设备输出的车道线信息c0，c1，c2，c3，通过下式

计算曲率ρ；

在传感设备的感知范围内，获取道路曲率序列ρ，并搜索曲率最大值ρmax，其对应道路弯最急点，并得到弯最急点与本车的相对纵向距离d；

如图4所示，测量原点是摄像头；前进方向为z+、右侧向为x+、竖直向上为y+。左手坐标系。航向角(绕y的角度)向右为正

摄像头坐标系下的车道线方程如下：

x＝c3*z³+c2*z²+c1*z+c0

z——车辆前进方向上的点距离摄像头的纵向距离

x——随z变化的车道线相对于摄像头的偏移距离

c0——车道线位置

c1——航向角

c2——车道线曲率

c3——车道线曲率随z的变化率。

步骤2，根据车辆运动状态获取弯道中安全/舒适的侧向加速度a，并结合曲率序列ρ得到其对应的允许车速序列v，及允许车速最小值vmin(即弯最急点对应的允许车速值)，

步骤3，比较本车当前车速及允许车速最小值vmin，判断以当前车速入弯是否存在偏离车道风险。当不存在偏离车道风险时，将系统允许最大车速值作为最终输出的弯道限速值，即不需要限速(系统允许最大车速值取道路限速牌(若支持)、驾驶员设定车速及系统预设最大值中的较大值)；当存在偏离车道风险时，进入步骤4；

步骤4，根据当前车速、纵向距离d、弯最急点对应的允许车速vmin，判断在当前情况下到达弯最急点所需的时间ttcp，ttcp值的大小代表了入弯的风险程度，根据ttcp在允许车速序列v中查表得到最终的弯道限速值vlimit；

ttcp计算方法如下：

d——距弯最急点的纵向距离，

vcur——当前车速，

vmin——弯最急点对应的允许车速，

步骤5，根据ttcp及设定阈值，ttcp达到阈值后系统会通过仪表或扬声器等设备提示驾驶员。

步骤6，根据最终输出的弯道限速值，通过驱动/制动系统，使车辆以安全舒适的速度过弯，并在驶出弯道后自动恢复至期望车速。

实施例二

一种弯道超速预警及主动限速系统，包括传感设备、弯道超速处理模块、弯道超速预警模块和主动限速模块。

传感设备用于检测车道信息，获取道路曲率序列，获取曲率最大值，及对应的相对纵向距离d，本实施例地传感设备包括摄像头；

弯道超速处理模块用于获取与道路曲率序列对应的允许车速序列v及允许车速最小值vmin，获取当前车速，判断当前车速入弯是否存在偏离车道风险，若是，则结合当前车速、相对纵向距离d和允许车速vmin，获取到达弯最急点所需的时间ttcp，在允许车速序列v中查找与到达弯最急点所需的时间ttcp对应的限速值vlimit，将限速值vlimit输出至驱动制动系统；

主动限速模块用于驱动制动系统执行接收到的速度值。

弯道超速预警模块用于发出仪表和声音报警。

本发明当车辆在直道行驶；或前方有弯道，以当前车速过弯不存在偏离风险时，弯道超速预警及限速功能处于待机状态；

当前方出现弯道，以当前车速过弯存在偏离风险时，弯道超速预警及限速功能激活，辅助驾驶员安全过弯；

限速功能激活时，ttcp越小，即存在较大的偏离车道风险，限速功能会越早将弯道最急点对应的限速值作为限速值输出，即越早将本车车速降低，安全入弯；

限速功能激活时，若ttcp较大，即偏离车道的风险较小，限速功能在限速值序列中选择较大的限速值输出，保证入弯的舒适性。

应当理解的是，对本领域普通技术人员来说，可以根据上述说明加以改进或变换，而所有这些改进和变换都应属于本发明所附权利要求的保护范围。