一种基于多传感器融合的自动紧急制动方法技术

本发明专利技术提供一种基于多传感器融合的自动紧急制动方法，通过环境感知传感器和整车CAN网络实时通讯，获取障碍物相对于自车的坐标位置和相对速度；将环境感知传感器获取的目标进行筛选，保留自车行驶轨迹内的障碍物目标；获取自车行驶轨迹内的障碍物目标相对于自车的坐标位置和相对速度，计算自车与前方障碍物的碰撞时间，并与预先设定的预警时间阈值比较，若碰撞时间小于预警时间阈值，则通过报警装置发出报警提示；障碍物逼近认定，在紧急情况下进行主动刹车。本发明专利技术对障碍物目标进行筛选，使报警更加准确，通过毫米波雷达和超声波雷达进行融合，对毫米波雷达出现的短距盲区进行弥补，保持障碍物距离探测的连续性，刹车制动更加安全。

An Automatic Emergency Braking Method Based on Multi-sensor Fusion

【技术实现步骤摘要】
一种基于多传感器融合的自动紧急制动方法
本专利技术属于电动汽车
，具体涉及一种基于多传感器融合的自动紧急制动方法。
技术介绍
随着车辆智能化的高速发展和对汽车安全性能要求的不断提高，各种针对车辆行驶时的主动安全技术迅猛发展。自动紧急制动系统作为高级驾驶辅助系统的一部分，可有效避免碰撞事故的发生。但是目前市场自动紧急制动系统大多基于单一毫米波雷达进行研发，在制动末期由于毫米波雷达盲区的存在，可能会使得障碍物数据丢失，导致制动解除，无法规避碰撞，存在安全隐患。
技术实现思路
为解决上述技术问题，本专利技术提供了一种基于多传感器融合的自动紧急制动方法。本专利技术采用如下技术方案：一种基于多传感器融合的自动紧急制动方法，包括如下步骤：S1、通过环境感知传感器和整车CAN网络实时通讯，获取障碍物相对于自车的坐标位置和相对速度；S2、根据获取的障碍物坐标位置，对障碍物目标进行筛选，保留自车行驶轨迹内的障碍物目标；S3、根据获取的自车行驶轨迹内的障碍物目标相对于自车的坐标位置和相对速度，计算自车与前方障碍物的碰撞时间，并与预先设定的预警时间阈值比较，若碰撞时间小于预警时间阈值，则通过报警装置发出报警提示；S4、障碍物逼近认定，在紧急情况下进行主动刹车。优选的，步骤S1中，利用毫米波雷达做远距障碍物探测，利用超声波雷达做近距补偿，通过远距毫米波雷达与超声波雷达融合实现目标持续跟踪探测，获取障碍物相对于自车的横向距离、纵向距离以及运动速度。优选的，所述步骤S2中，具体包括如下步骤：通过毫米波雷达获取障碍物相对整车中轴线的横向距离为Dis_X；设置disx为目标过滤参数，比较Dis_X与disx值的大小；若-disx≤Dis_X≤disx，则目标在筛选范围之内，则判断障碍物为自车行驶轨迹内的障碍物目标。优选的，步骤S3中，获取自车行驶轨迹内的障碍物目标相对于自车的纵向距离为D，障碍物运动速度为V1；通过整车CAN网络获取自车行驶速度为V0，通过以下公式计算自车与前方障碍物的碰撞时间TTC：优选的，步骤S3中，实时获取自车与前方障碍物的碰撞时间，并通过显示装置显示碰撞时间和预警时间阈值，对驾驶人员进行预警提示；当碰撞时间小于预警时间阈值时，则通过声音警报装置对驾驶人员进行报警提示。优选的，步骤S4中，由毫米波雷达探测远处障碍物，在障碍物逼近过程中，自车与前方障碍物之间的相对距离不断减小，直至超声波雷达探测范围内，获取超声波雷达探测范围内的障碍物相对整车中轴线的横向距离Dis_x；比较Dis_x与disx值的大小，若-disx≤Dis_x≤disx，则判断障碍物为自车行驶轨迹内的障碍物目标；同时，比较Dis_X与Dis_x值的大小，若|Dis_X-Dis_x|<0.2m，则判断为同一障碍物，持续做障碍物逼近认定。优选的，所述步骤S4的具体方法包括：比较碰撞时间与预先设定的紧急制动阈值的大小，若碰撞时间大于紧急制动阈值，则控制系统不会做制动处理；若碰撞时间小于紧急制动阈值，则判断驾驶人员是否作出有效的避免碰撞操作，若驾驶人员作出有效的避免碰撞操作，则控制系统不会做制动处理；若驾驶人员没有作出有效的避免碰撞操作，则控制系统对自车作出紧急制动处理。优选的，判断驾驶人员是否作出有效的避免碰撞操作的具体方法是：在碰撞时间小于紧急制动阈值时，判断是否存在转向灯信号，若存在转向灯信号，则控制系统不会做制动处理；若不存在转向灯信号，则判断是否存在方向盘转角，若存在方向盘转角，则控制系统不会做制动处理；若不存在方向盘转角，则控制系统对自车作出紧急制动处理。优选的，步骤S4还包括判定车速的高低，在自车处于高速行驶状态，且碰撞时间大于紧急制动阈值时，控制系统还进行安全距离的判定，判断前方障碍物相对自车的距离是否超过预设的安全距离阈值，若相对距离超过预设的安全距离阈值，则控制系统不会做制动处理；若相对距离未超过预设的安全距离阈值，则控制系统对自车作出轻微制动处理。本专利技术的有益效果：(1)本专利技术通过多传感器的融合算法，对毫米波雷达出现的短距盲区进行弥补，保持障碍物距离探测和制动算法的连续性，避免了制动末期由于不同制动模式导致的制动阶跃现象发生；(2)本专利技术方法对障碍物目标进行筛选，只保留自车行驶轨迹内的障碍物目标，排除无效障碍物，使报警乃至制动更加准确；(3)本专利技术方法可以计算自车与前方有效障碍物的碰撞时间，对驾驶人员发出报警提示，在紧急情况下能够进行主动刹车，保证人员以及车辆的安全。附图说明附图用来提供对本专利技术的优选的理解，并且构成说明书的一部分，与本专利技术的实施例一起用于解释本专利技术，并不构成对本专利技术的限制。在附图中：图1为本专利技术中毫米波雷达和超声波雷达的探测范围示意图；图2为本专利技术中毫米波雷达和超声波雷达的安装位置示意图；图3为本专利技术中目标过滤示意图；图4为本专利技术的整体流程图。具体实施方式下面结合附图描述本专利技术的具体实施方式。本实施例主要通过实现对气刹制动的电动公交车行驶过程中与前方障碍物的前碰撞预警功能和紧急制动功能，来具体描述本专利技术的一种基于多传感器融合的自动紧急制动方法，包括如下步骤：步骤一：环境感知，通过环境感知传感器和整车CAN网络实时通讯，获取障碍物相对于自车的坐标位置和相对速度；如图1所示，利用77GHZ毫米波雷达1做远距障碍物探测，毫米波雷达1安装在车辆前保险杠中部，图1中d2所示为毫米波雷达探测范围，由于毫米波雷达1在近距0-3m左右存在盲区或检测性能低的情况，利用超声波雷达2做近距补偿，图1中d1所示为超声波雷达探测范围，超声波雷达2分布在毫米波雷达1的两侧，本实施例采用四个超声波雷达2，毫米波雷达1的一侧安装有两个，如图2所示；通过远距毫米波雷达1与近距超声波雷达2融合实现目标持续跟踪探测，其中，障碍物相对于自车的坐标位置包括障碍物相对于自车的横向距离和纵向距离。步骤二：目标过滤，根据获取的障碍物坐标位置，对障碍物目标进行筛选，保留自车行驶轨迹内的障碍物目标；通过毫米波雷达获取障碍物相对整车中轴线的横向距离为Dis_X；设置disx为目标过滤参数，比较Dis_X与disx值的大小；若-disx≤Dis_X≤disx，则目标在筛选范围之内，则判断障碍物为自车行驶轨迹内的障碍物目标。如图3所示，disx为目标过滤参数，Dis_X1为过滤范围内目标横向距离，Dis_X2为过滤范围外目标横向距离，由于|Dis_X2|>|disx|，则认定Dis_X2为过滤范围外目标横向距离，目标在筛选范围之外，控制系统忽略此信息且不会做预警或制动处理；由于|Dis_X1|≤|disx|，则认定Dis_X1为过滤范围内目标横向距离，目标在筛选范围之内，控制系统融合整车信息进行相应控制。步骤三：前碰撞预警，根据获取的自车行驶轨迹内的障碍物目标相对于自车的坐标位置和相对速度，计算自车与前方障碍物的碰撞时间，并与预先设定的预警时间阈值(国标2.7s)比较，若碰撞时间小于预警时间阈值，则通过报警装置发出报警提示；获取自车行驶轨迹内的障碍物目标相对于自车的纵向距离为D，障碍物运动速度为V1；通过整车CAN网络获取自车行驶速度为V0，通过以下公式计算自车与前方障碍物的碰撞时间TTC：实时获取自车与前方障碍物的碰撞时间，并通过显示装置显示碰撞时间和预本文档来自技高网...

【技术保护点】
1.一种基于多传感器融合的自动紧急制动方法，其特征在于，包括如下步骤：S1、通过环境感知传感器和整车CAN网络实时通讯，获取障碍物相对于自车的坐标位置和相对速度；S2、将环境感知传感器获取的目标进行筛选，保留自车行驶轨迹内的障碍物目标；S3、获取自车行驶轨迹内的障碍物目标相对于自车的坐标位置和相对速度，计算自车与前方障碍物的碰撞时间，并与预先设定的预警时间阈值比较，若碰撞时间小于预警时间阈值，则通过报警装置发出报警提示；S4、障碍物逼近认定，在紧急情况下进行主动刹车。

【技术特征摘要】
1.一种基于多传感器融合的自动紧急制动方法，其特征在于，包括如下步骤：S1、通过环境感知传感器和整车CAN网络实时通讯，获取障碍物相对于自车的坐标位置和相对速度；S2、将环境感知传感器获取的目标进行筛选，保留自车行驶轨迹内的障碍物目标；S3、获取自车行驶轨迹内的障碍物目标相对于自车的坐标位置和相对速度，计算自车与前方障碍物的碰撞时间，并与预先设定的预警时间阈值比较，若碰撞时间小于预警时间阈值，则通过报警装置发出报警提示；S4、障碍物逼近认定，在紧急情况下进行主动刹车。2.根据权利要求1所述的一种基于多传感器融合的自动紧急制动方法，其特征在于，步骤S1中，利用毫米波雷达做远距障碍物探测，利用超声波雷达做近距补偿，通过远距毫米波雷达与超声波雷达融合实现目标持续跟踪探测，获取障碍物相对于自车的横向距离、纵向距离以及运动速度。3.根据权利要求2所述的一种基于多传感器融合的自动紧急制动方法，其特征在于，所述步骤S2中，具体包括如下步骤：通过毫米波雷达获取障碍物相对整车中轴线的横向距离为Dis_X；设置disx为目标过滤参数，比较Dis_X与disx值的大小；若-disx≤Dis_X≤disx，目标在筛选范围之内，则判断障碍物为自车行驶轨迹内的障碍物目标。4.根据权利要求3所述的一种基于多传感器融合的自动紧急制动方法，其特征在于，步骤S3中，获取自车行驶轨迹内的障碍物目标相对于自车的纵向距离为D，障碍物运动速度为V1；通过整车CAN网络获取自车行驶速度为V0，通过以下公式计算自车与前方障碍物的碰撞时间TTC：5.根据权利要求4所述的一种基于多传感器融合的自动紧急制动方法，其特征在于，步骤S3中，实时获取自车与前方障碍物的碰撞时间，并通过显示装置显示碰撞时间和预警时间阈值，对驾驶人员进行预警提示；当碰撞时间小于预警时间阈值时，则通过声音警报装置对驾驶人员进行报警提示。6.根据权利要求3至5中任一项所述的一种基于多传感器融合的...

【专利技术属性】
技术研发人员：宋金行，张新中，袁朝春，黄福良，孙彦军，魏悦，陈丽，
申请(专利权)人：国唐汽车有限公司，
类型：发明
国别省市：江苏,32