一种自动驾驶车辆画龙判断控制方法技术

本发明专利技术属于自动驾驶技术领域，具体公开了一种自动驾驶车辆画龙判断控制方法，包括：实时获取所述车辆行驶中的数据，计算车辆航向与自动驾驶路径的关键点航向的偏差角；根据所述偏差角判断车辆是否发生画龙，若否则返回S1，若是则进行S3；根据所述车辆与关键点的横向偏差对所述画龙进行分级并报警，基于分级的结果对所述车辆的速度进行控制；在画龙消失后，根据分级的结果指示车辆继续行驶或停车，具有以下优点：能够快速准确的识别出自动驾驶车辆是否画龙；进一步结合车辆实际横向偏差，区分画龙等级；根据不同的画龙等级，在纵向控制中做出不同的安全限速限停策略，减少矿用车辆冲撞挡墙或偏向另一车道的风险。挡墙或偏向另一车道的风险。挡墙或偏向另一车道的风险。

【技术实现步骤摘要】
一种自动驾驶车辆画龙判断控制方法


[0001]本专利技术涉及自动驾驶
，具体而言，涉及一种自动驾驶车辆画龙判断控制方法。

技术介绍

[0002]矿区自动驾驶车辆往往面临行驶的道路边界局部狭窄的场景和矿区车辆转向机构会运行在低温颠坡路面环境的特点，会造成转向执行系统偶发的跟随效果变差以及响应卡滞等现象。进一步，横向控制算法会来回纠正车辆行驶轨迹造成矿卡车辆开始在跟随目标路径左右横摆及画龙，画龙程度剧烈会造成车辆不受控和增加冲撞路径两侧挡墙的风险。因此，车辆横向性能的实时监测和风险预防尤其重要。
[0003]当前自动驾驶控制中，关注重点在横纵向控制性能的提升，缺少对车辆横向的控制性能的实时监控以及当车辆横向行车性能变差后的安全预防策略。对于自动驾驶车辆尤其是矿区自动驾驶矿卡，车辆画龙造成的风险极大，需要能快速准确的识别出车辆画龙现象以及实施车辆画龙后的安全防护措施。
[0004]为此提出一种自动驾驶车辆画龙判断控制方法，以解决上述提出的问题。

技术实现思路

[0005]本专利技术旨在提供一种自动驾驶车辆画龙判断控制方法，以解决或改善上述提出的对矿区自动驾驶车辆横向画龙现象的风险预防较弱，矿用车辆冲撞挡墙或偏向另一车道的问题。
[0006]有鉴于此，本专利技术的第一方面在于提供一种自动驾驶车辆画龙判断控制方法。
[0007]本专利技术的第一方面提供了一种自动驾驶车辆画龙判断控制方法，包括如下步骤：S1，实时获取所述车辆行驶中的数据，计算车辆航向与自动驾驶路径的关键点航向的偏差角；S2，根据所述偏差角判断车辆是否发生画龙，若否则返回S1，若是则进行S3；S3，根据所述车辆与关键点的横向偏差对所述画龙进行分级并报警，基于分级的结果对所述车辆的速度进行控制；S4，根据分级的结果指示车辆继续行驶或停车。
[0008]本专利技术提供的一种自动驾驶车辆画龙判断控制方法，通过对车辆实时行驶中的数据进行判断，能够快速准确的识别出自动驾驶车辆是否画龙，弥补自动驾驶车辆针对画龙现象识别策略的缺失；
[0009]在识别出车辆画龙后，能够进一步结合车辆实际横向偏差，区分画龙等级，不同画龙等级的警示信息通过上传平台给安全员报警信息，降低车辆横向性能指标进一步恶化的风险；
[0010]区分出不同的画龙等级后，在纵向控制中，做出不同的安全限速限停策略，能够降低车速或停车，减少矿用车辆冲撞挡墙或偏向另一车道的风险；
[0011]提高了对矿区自动驾驶车辆横向画龙现象的风险预防，减少矿用车辆冲撞挡墙或偏向另一车道的风险，通过自动驾驶车辆横向偏差和与目标路径的航向偏差信息，能够实
时准确的识别出画龙现象，且通过限速限停车辆，降低车辆发生横向碰撞的风险。
[0012]另外，根据本专利技术的实施例提供的技术方案还可以具有如下附加技术特征：
[0013]上述任一技术方案中，所述S1的步骤，具体包括：S11，以固定频率，连续实时获取并更新预设时间内所述车辆与关键点航向的偏差角；S12，根据车辆航向与关键点航向的指向关系，对所述偏差角进行正或负的赋值；S13，以偏差角为纵坐标和以时间为横坐标，绘制所述预设时间内的变化曲线。
[0014]在该技术方案中，采用固定的频率对车辆的信息进行采样，且以车辆行驶的当前时刻为终点，采集一段时间内的行驶数据，能够对车辆进行连续的短时间监控，以便在车辆出现画龙时能够快速检测出，保证后续控制步骤的时效性，在计算偏差角时考虑车辆航向与关键点航向之间的指向关系，通过不同的指向关系对偏差角进行正或负的赋值，将画龙时车辆的反复摆动进行考虑，能够降低车辆正常转弯动作对画龙判断的干扰，提高判断的准确率；
[0015]由于车辆出现画龙时左右摆动的幅度呈现逐渐增的情况，因此以偏差角为纵坐标和以时间为横坐标绘制变化曲线，以便对画龙发生的状况进行分析和后续计算。
[0016]上述任一技术方案中，所述固定频率为20HZ，和/或所述预设时间为5s。
[0017]在该技术方案中，设定固定的采集频率能够保证车辆在连续的行驶中数据点位的均匀获取，能够对画龙发生时的车辆摆动极端点及其附近点位进行采集，能够增加对出车辆真实行驶轨迹获取的准确性；将预设时间设定为5s能够车辆在出现画龙时的初始轨迹被记录下来，同时在5s内进行不断的更新数据避免了车辆的数据对计算的负担过大，也避免了车辆在连续的S型弯道中被误判为画龙现象。
[0018]上述任一技术方案中，以所述关键点航向为正方向，以及所述S12包括：当车辆航向的指向偏右时，所述偏差角为正值；当车辆航向的指向偏左时，所述偏差角为负值。
[0019]在该技术方案中，由于车辆在画龙时会出现摆动的情况，且行驶的轨迹为S型，因此将关键点航向作为参考的正方向，将车辆航线指向相对于正方向的左向或右向，对偏差角进行正负的赋值，使得偏差角的数据考虑了车辆相对于关键点航向的偏向，在后续的计算处理中对车辆的状态考虑更加的贴合实际。
[0020]上述任一技术方案中，所述S2的步骤，具体包括：S21，获取所述变化曲线所有的波峰和波谷，计算相邻所述波峰和波谷的差值；S22，判断多个连续所述差值是否均小于阈值，若否则返回S1，若是则判定车辆发生画龙。
[0021]在该技术方案中，通过计算波谷和波峰之间的差值能够了解车辆在到此摆动中的摇摆角度，并设置用于判断摇摆角度是否过大的阈值，在车辆数值采集判断时间之内，当出现多个连续大于阈值的差值时，车辆即出现画龙的状况。
[0022]上述任一技术方案中，所述S22中差值的个数为3次，以及所述阈值为5
°
。
[0023]在该技术方案中，设定连续出现三个大于阈值的差值时，车辆发生画龙，由于画龙发生的过程中车辆会发生摆动逐渐增大且具有连续性，设置阈值为5
°
能够从车辆摆动的角度大小对是否发生画龙进行判定，通过从车辆摆动大小、连续摆动的次数以及在是否在规定时间内发生的多种条件下进行判定，避免了车辆在矿区内转弯时发生误判，以及车辆在真实出现画龙时无法判定出的问题。
[0024]上述任一技术方案中，所述横向偏差为所述车辆的中心与关键点航向线的距离，
以及所述S3的步骤包括：S31，判断横向偏差是否小于0.5m，若否则进行S32，若是则判定所述画龙为三级画龙，报警并控制车辆；S32，判断横向偏差是否小于或等于1.0m，若否则进行S33，若是则判定所述画龙为二级画龙，报警并控制车辆；S33，判断横向偏差是否大于1.0m，若否则进行S33，若是则判定所述画龙为一级画龙，报警并控制车辆。
[0025]在该技术方案中，在发生画龙后，采用车辆中心点与关键点航向线之间的距离，对车辆画龙的程度进行判定，能够对车辆的状态进行进一步细分，以便在后续的控制时进行更加精细的判断，以及针对不同的画龙程度进行不同的控制策略，能够覆盖能更多的车辆画龙轨迹和摆动程度。
[0026]上述任一技术方案中，当所述画龙为三级画龙时，控制车辆匀减速至60％当前路径期望车速；当本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种自动驾驶车辆画龙判断控制方法，其特征在于，包括如下步骤：S1，实时获取所述车辆行驶中的数据，计算车辆航向与自动驾驶路径的关键点航向的偏差角；S2，根据所述偏差角判断车辆是否发生画龙，若否则返回S1，若是则进行S3；S3，根据所述车辆与关键点的横向偏差对所述画龙进行分级并报警，基于分级的结果对所述车辆的速度进行控制；S4，根据分级的结果指示车辆继续行驶或停车。2.根据权利要求1所述的一种自动驾驶车辆画龙判断控制方法，其特征在于，所述S1的步骤，具体包括：S11，以固定频率，连续实时获取并更新预设时间内所述车辆与关键点航向的偏差角；S12，根据车辆航向与关键点航向的指向关系，对所述偏差角进行正或负的赋值；S13，以偏差角为纵坐标和以时间为横坐标，绘制所述预设时间内的变化曲线。3.根据权利要求2所述的一种自动驾驶车辆画龙判断控制方法，其特征在于，所述固定频率为20HZ，和/或所述预设时间为5s。4.根据权利要求2所述的一种自动驾驶车辆画龙判断控制方法，其特征在于，以所述关键点航向为正方向，以及所述S12包括：当车辆航向的指向偏右时，所述偏差角为正值；当车辆航向的指向偏左时，所述偏差角为负值。5.根据权利要求2所述的一种自动驾驶车辆画龙判断控制方法，其特征在于，所述S2的步骤，具体包括：S21，获取所述变化曲线所有的波峰和波谷，计算相邻所述波峰和波谷的差值；S22，判断多个连续所述差值是否均小于阈值，若否则返回S1，若是则判定车辆发生画龙。...

【专利技术属性】
技术研发人员：陈江松，夏启，王文飞，邬海杰，胡瑞，
申请(专利权)人：北京踏歌智行科技有限公司，
类型：发明
国别省市：