一种自动驾驶车辆的坠物规避控制方法技术

本发明专利技术提供自动驾驶车辆的坠物规避控制方法，通过识别货箱区域，构建落物检测空间，当检测有物体入侵检测空间时后，计算货物的跌落轨迹和本车行驶轨迹，并根据货物的跌落轨迹与本车行驶轨迹的关系根据预设规避策略控制本车。本发明专利技术实现了自动驾驶车辆对货车坠物的自动规避，提高了驾驶安全性。提高了驾驶安全性。提高了驾驶安全性。

【技术实现步骤摘要】
一种自动驾驶车辆的坠物规避控制方法


[0001]本专利技术涉及自动驾驶
，尤其涉及一种自动驾驶车辆的坠物规避控制方法。

技术介绍

[0002]货箱顶部没有封顶的货车在高速行驶时，当货物超出货箱顶部后，货物坠落的概率较大，货车上货物坠落的方向包括侧向坠落和后方坠落。坠落的货物具备很强的动能，如果被坠落的货物砸中，会导致严重的交通事故。
[0003]随着自动驾驶技术的不断进步，人工干预的日趋减少，无法通过驾驶员的观察来躲避前方货车坠落的货物，因此，亟需一种适用于自动驾驶车辆的坠落物体规避方法，以提高自动驾驶车辆的安全性。

技术实现思路

[0004]本专利技术提供一种自动驾驶车辆的坠物规避控制方法，旨在解决现有技术中的缺陷，实现自动驾驶车辆对货车坠物的自动规避，提高驾驶安全性。
[0005]为达到上述目的，本专利技术所采取的技术方案为：
[0006]本专利技术提供一种自动驾驶车辆的坠物规避控制方法，包括：
[0007]步骤1、对本车前方的车辆进行识别，当判断存在货车后进入下一步；
[0008]步骤2、识别货箱区域，并用预设的目标框标注所述货箱区域；
[0009]步骤3、构建落物检测空间，所述检测空间包括第一检测空间、第二检测空间；
[0010]步骤4、检测是否有物体入侵第一检测空间，是则进入下一步，否则重复执行本步骤；
[0011]步骤5、检测是否有物体入侵第二检测空间，是则判断有货物坠落并进入下一步，否则返回步骤4；
[0012]步骤6、计算货物的跌落轨迹和本车行驶轨迹；
[0013]步骤7、判断所述货物的跌落轨迹与所述本车行驶轨迹是否存在交点，是则进入步骤9，否则进入下一步；
[0014]步骤8、根据所述货物的跌落轨迹计算货物落地点，并判断所述货物落地点是否在本车行驶路径上，是则进入下一步，否则返回步骤4；
[0015]步骤9、根据预设规避策略控制本车。
[0016]具体地，所述计算货物的跌落轨迹包括：
[0017]以本车的车头中心为原点，车辆前进的方向为x轴正向，车辆横向向左为y轴正向，垂直向上为z轴正向，建立坐标系，确定货物跌落的轨迹方程为：
[0018][0019]其中，t为货物跌落的运动时间，以货物开始跌落时作为计时起始点；v
x
为货物跌落时的x向速度，等同于货车车速；v
y
为货物跌落时的y向速度；D为货物跌落时与本车的x向距离；H为货物跌落时距离本车的垂直高度；g为重力加速度。
[0020]具体地，所述步骤3包括：
[0021]步骤301、在本车与所述目标框的相邻面建立至少一检测线组，所述检测线组包括第一检测线、第二检测线，所述第一检测线、第二检测线水平横贯所述相邻面，所述第一检测线设置在货箱顶部下方，所述第二检测线设置在第一检测线下方，所述第一检测线与所述货箱顶部的间距为第一像素，所述第一检测线、第二检测线的间距为第二像素，所述第一检测线、第二检测线的长度与货车所在车道的宽度相同，两端端点的垂直投影位于货车所在车道的车道线上；
[0022]步骤302、以所述第一检测线与货箱顶部轮廓线的延长线构成第一检测空间，所述第一检测线、第二检测线构成第二检测空间。
[0023]具体地，所述步骤4中检测是否有物体入侵第一检测空间、所述步骤5中检测是否有物体入侵第二检测空间中的至少一个包括：
[0024]步骤A、使用高帧率模式获取货箱图像；
[0025]步骤B、检测所述货箱图像中是否出现目标物体，是则进入下一步，否则重复执行本步骤；
[0026]步骤C、判断目标物体是否入侵检测空间。
[0027]具体地，所述步骤B包括：通过预设方法对比两帧所述货箱图像间的变化值来检测所述货箱图像中是否出现目标物体。
[0028]具体地，所述预设方法包括背景减除法、帧差分法、光流法等。
[0029]具体地，所述步骤C包括：
[0030]步骤C1、识别所述目标物体的最高点的实时坐标和最低点的实时坐标；
[0031]步骤C2、计算第一等式、第二等式；
[0032]步骤C3、计算所述第一等式与所述第二等式的叉乘结果；
[0033]步骤C4、若所述叉乘结果小于0，则判断所述目标物体已入侵检测空间，否则判断所述目标物体未入侵检测空间；
[0034]所述第一等式为：K
p1
＝[(x
2n
‑1‑
x
2n
)/(y
2n
‑1‑
y
2n
)]‑
[(x
p1
‑
x
2n
)/(y
p1
‑
y
2n
)]，
[0035]所述第二等式为：K
p2
＝[(x
2n
‑1‑
x
2n
)/(y
2n
‑1‑
y
2n
)]‑
[(x
p2
‑
x
2n
)/(y
p2
‑
y
2n
)]。
[0036]其中，(x
2n
‑1,y
2n
‑1)检测线L
n
的左端点坐标值，(x
2n
,y
2n
)表示检测线L
n
的右端点坐标值，(x
p1
,y
p1
)表示目标物体的最高点的实时坐标，(x
p2
,y
p2
)表示目标物体的最低点的实时坐标。
[0037]具体地，所述步骤9包括：
[0038]步骤901、实时监控并判断相邻车道是否满足正常变道条件，是则控制本车执行变道，否则进入下一步；
[0039]步骤902、判断本车以最大加速度进行减速，是否会与落物发生碰撞，是则进入下一步，否则控制本车以所述最大加速度减速；
[0040]步骤903、计算本车在以所述最大加速度制动并与碰撞货物时的碰撞速度，判断所述碰撞速度是否小于本车的最大碰撞安全速度，是则控制车辆以所述最大加速度减速，否
则执行下一步；
[0041]步骤904、控制开启本车双闪灯和转向灯，监测本车后方车辆是否减速，是则返回步骤901，否则控制车辆以最大加速度减速。
[0042]具体地，所述碰撞速度
[0043]其中，v1为本车制动前的速度；a
m
为制动时的最大加速度；v
x
为货物跌落时的x向速度；D为货物跌落时与本车的x向距离；H为货物跌落时距离本车的垂直高度；g为重力加速度。
[0044]本专利技术的有益效果在于：本专利技术通过识别货箱区域，构建落物检测空间，当检测有物体入侵检测空间时后，计算货物的跌落轨迹和本车行驶轨本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种自动驾驶车辆的坠物规避控制方法，其特征在于，包括：步骤1、对本车前方的车辆进行识别，当判断存在货车后进入下一步；步骤2、识别货箱区域，并用预设的目标框标注所述货箱区域；步骤3、构建落物检测空间，所述检测空间包括第一检测空间、第二检测空间；步骤4、检测是否有物体入侵第一检测空间，是则进入下一步，否则重复执行本步骤；步骤5、检测是否有物体入侵第二检测空间，是则判断有货物坠落并进入下一步，否则返回步骤4；步骤6、计算货物的跌落轨迹和本车行驶轨迹；步骤7、判断所述货物的跌落轨迹与所述本车行驶轨迹是否存在交点，是则进入步骤9，否则进入下一步；步骤8、根据所述货物的跌落轨迹计算货物落地点，并判断所述货物落地点是否在本车行驶路径上，是则进入下一步，否则返回步骤4；步骤9、根据预设规避策略控制本车。2.根据权利要求1所述的自动驾驶车辆的坠物规避控制方法，其特征在于，所述步骤3包括：步骤301、在本车与所述目标框的相邻面建立至少一检测线组，所述检测线组包括第一检测线、第二检测线，所述第一检测线、第二检测线水平横贯所述相邻面，所述第一检测线设置在货箱顶部下方，所述第二检测线设置在第一检测线下方，所述第一检测线与所述货箱顶部的间距为第一像素，所述第一检测线、第二检测线的间距为第二像素，所述第一检测线、第二检测线的长度与货车所在车道的宽度相同，两端端点的垂直投影位于货车所在车道的车道线上；步骤302、以所述第一检测线与货箱顶部轮廓线的延长线构成第一检测空间，所述第一检测线、第二检测线构成第二检测空间。3.根据权利要求1所述的自动驾驶车辆的坠物规避控制方法，其特征在于，所述步骤4中检测是否有物体入侵第一检测空间、所述步骤5中检测是否有物体入侵第二检测空间中的至少一个包括：步骤A、使用高帧率模式获取货箱图像；步骤B、检测所述货箱图像中是否出现目标物体，是则进入下一步，否则重复执行本步骤；步骤C、判断目标物体是否入侵检测空间。4.根据权利要求3所述的自动驾驶车辆的坠物规避控制方法，其特征在于，所述步骤B包括：通过预设方法对比两帧所述货箱图像间的变化值来检测所述货箱图像中是否出现目标物体。5.根据权利要求4所述的自动驾驶车辆的坠物规避控制方法，其特征在于，所述预设方法包括背景减除法、帧差分法或光流法。6.根据权利要求3所述的自动驾驶车辆的坠物规避控制方法，其特征在于，所述步骤C包括：步骤C1、识别所述目标物体的最高点的实时坐标和最低点的实时坐标；步骤C2、计算第一等式、第二等式；
步骤C3、计算所述第一等式与所述第二等式的叉乘结果；步骤C4、若所述叉乘结果小于0，则判断所述目标物体已入侵检测空间，否则判断所述目标物体未入侵检测空间；所述第一等式为：K
p1
＝[(x
2n
‑1‑
x
2n
)/(y
2n
‑1‑
y
2n
)]
‑

【专利技术属性】
技术研发人员：蒋才科，林泽蓬，刘凌云，
申请(专利权)人：惠州华阳通用智慧车载系统开发有限公司，
类型：发明
国别省市：