1.一种封闭场景下车辆道路能力测试方法,其特征在于,具体步骤为:A、在车辆内安装处理器和姿态及位置获取模块,在车辆同一侧装有两个激光测距传感器,两个激光测距传感器间隔一定距离且处于同一水平面上;在车辆前端装有激光雷达,姿态及位置获取模块、激光雷达和两个激光测距传感器将检测的数据反馈给处理器,处理器对数据分析处理后控制车辆的行驶线速度及行驶角速度,完成车辆的自动驾驶系统的安装,然后处理器采用已知的SLAM开源算法通过激光雷达完成对当前环境地图的构建;
B、选择长圆形跑道作为封闭测试场地,在长圆形跑道中间设有矩形标志物,在矩形标志物中点两侧的长圆形跑道上对称设有第一目标点和第四目标点,在矩形标志物端部的前方及后方的对称长圆形跑道上对称设有第二目标点和第三目标点,且相邻两个目标点之间的直线距离相等;将步骤A完成安装的车辆放置在任意一个目标点处作为起始点,且使装有两个激光测距传感器的车辆一侧朝向矩形标志物;设定测试圈数或测试时间输入到处理器内,其中一圈设定为车辆顺时针或逆时针绕矩形标志物依次经过各个目标点回到起始点;
若设定为测试圈数,则车辆绕矩形标志物达到设定测试圈数时,车辆停止行驶完成测试;若设定为测试时间,则车辆在开始行驶时进行计时,每行驶一圈将当前时间与测试时间进行比对,若当前时间未超过测试时间,则车辆继续下一圈行驶;若当前时间超过测试时间,则车辆停止行驶完成测试;
C、车辆开始行驶测试时,姿态及位置获取模块、激光雷达和两个激光测距传感器实时将检测的数据反馈给处理器,处理器对数据进行分析处理,进而确定最佳速度评价指标,并根据最佳速度评价指标调整从起始点到下一目标点之间的最佳行驶速度及行驶方向,直至车辆到达下一个目标点,所述确定最佳速度评价指标的过程为:根据道路安全要求以及车辆自身性能限制设定车辆最大线速度vmax、车辆最小线速度vmin、车辆最大角速度ωmax和车辆最小角速度ωmin,车辆当前线速度和角速度分别为vcur、ωcur;假定在处理器的一个处理周期Δt内车辆作匀速直线运行,则在当前速度(vcur,ωcur)下所能达到的速度范围为:
vcur‑adec·Δt≤v≤vcur+aacc·Δt (1)ωcur‑aωd·Δt≤ω≤ωcur+aωa·Δt (2)其中adec、aacc、aωd、aωa分别为车辆的最大直线减速度、最大直线加速度、最大角减速度和最大角加速度,则在上述范围内选择不同的v值及不同的ω值进行组合,进而根据各个(v,ω)组合分别计算出在给定预测时间内各自对应的预测轨迹,根据每一条的预测轨迹通过姿态及位置获取模块、激光雷达和两个激光测距传感器反馈的检测数据,处理器选择最优路线,从而得出该最优路线对应的速度(v,ω),具体选择过程为:①对于每一组速度(v,w),有对应的刹车距离diss,刹车距离能根据匀减速直线运动位移公式来估算:
其中,s为匀减速直线运动位移;为了增加测试时的安全运行,设定一个安全系数k=
1.2,则diss=k·s;
②在处理器获取激光雷达的距离信息时,取出离车辆正前方最近的障碍物距离obsfront以及未装有激光测距传感器的车辆一侧45°方向的最近障碍物距离obsleft,根据这两个距离信息避让障碍物,当障碍物距离车辆大于100m或是激光雷达未探测到障碍物,记obsfront =100、obsleft=100;
③当车辆正前方及未装有激光测距传感器的车辆一侧45°方向上都没有障碍物时,即obsfront>2diss且obsleft>2.8diss,此时处理器使车辆以最大速度线速度vmax行驶,车辆角速度ω根据两个激光测距传感器探测到与矩形标志物之间的距离差异进行调整,使车辆始终保持与矩形标志物平行在场地道路上行驶;
④当仅有正前方探测到障碍物时,即obsfront<2diss,首先通过姿态获取模块实时获得车辆的姿态角θ、当前的位置(x,y)以及当前的速度(vcur,ωcur),通过计算得到车辆与下一个目标点方向的夹角α;通过激光雷达获得当前最近的障碍物位置(xobs,yobs);当前速度为(vcur,ωcur)的车辆,由公式(1)、(2)得到车辆所能达到的速度范围(v,ω),对于其中的速度,线速度以5km/h递增,角速度以0.0174rad/s递增,预测5s时间内车辆所能到达的位置,从中选择最佳的速度;假设预测时间内每一速度组合(v,ω)保持不变,每一速度组合在预测时间共预计 次,记 则每一速度组合预测车辆位置(xpre,ypre)以及姿态角θpre表示如下:
故每一速度组合的预测数据有(xpre,ypre,θpre)以及其对应的线速度veli(i=1,2…j),根据当前探测到的最近障碍物位置(xobs,yobs)以及各个预测车辆位置(xpre,ypre),能计算得到各个预测车辆位置与当前最近障碍物的距离obsi(i=1,2…j);根据各个预测姿态角θpre以及目标点姿态角θgoal,计算得到各个预测姿态角与下一目标点的角度diri(i=1,2…j),最后对所有参数进行归一化:
然后按照三个参数相应的权重wobs、wdir、wvel计算得到速度(vi,ωi)的评价分数scorei:scorei=wobs·obsi+wdir·diri+wvel·veli选择其中得分最高的速度组合(vbest,ωbest),处理器按照该速度组合对车辆行驶进行控制,进而车辆完成对正前方障碍物的避让;
⑤当仅有未装有激光测距传感器的车辆一侧45°方向上探测到障碍物时,若obsleft>
2.8diss,当前车辆行驶速度不作调整;当obsleft<2.8diss时,此时调整车速为当前速度的一半继续行驶,若继续行驶过程中探测的障碍物距离进一步减小到obsfront<1.5diss,则调整车速到10km/h继续行驶,若继续行驶过程中探测障碍物距离再一次减小到obsfront<
1.2diss,则进行停车等待,直至激光雷达检测未装有激光测距传感器的车辆一侧45°方向上没有障碍物,车辆再次启动并重复上述调整最佳行驶速度的过程开始向下一目标点继续行驶;
⑥当车辆正前方及未装有激光测距传感器的车辆一侧45°方向上均检测到障碍物时,根据两个激光测距传感器探测到与矩形标志物之间的距离差异对车辆角速度ω进行调整,使车辆始终保持与矩形标志物平行在场地道路上行驶;此时若obsfront<2diss且obsleft<
2.8diss,此时调整车速为当前速度的一半继续行驶,若继续行驶过程中两个方向距离进一步减小到obsfront<1.5diss并且obsleft<2.8diss,则调整车速到10km/h,若继续行驶过程中探测障碍物距离再一次减小到obsfront<1.2diss并且obsleft<2.8diss,则进行停车等待,直至激光雷达检测车辆正前方及未装有激光测距传感器的车辆一侧45°方向上均没有障碍物时,车辆再次启动并重复上述调整最佳行驶速度的过程开始向下一目标点继续行驶;
D、在车辆行进的过程中,处理器实时读取姿态获取模块的定位信息,用来判断车辆是否到达下一目标点,若未到达下一目标点则根据选择的最佳行驶速度控制车辆直至下一目标点,到达当前目标点时,处理器判断是否达到设定测试圈数或设定测试时间,若是则停止运行,如否则车辆继续向下一目标点继续行驶,并重复步骤C确定最佳速度评价指标的步骤,并根据最佳速度评价指标调整从该目标点到下一目标点之间的最佳行驶速度及行驶方向,如此循环,进行车辆道路能力测试,直至达到设定测试圈数或设定测试时间停止测试。
2.根据权利要求1所述的一种封闭场景下车辆道路能力测试方法,其特征在于,所述处理器为工控机。
3.根据权利要求1所述的一种封闭场景下车辆道路能力测试方法,其特征在于,所述激光雷达的通信接口为以太网或者USB;激光测距传感器的通信接口为RS485或RS232接口。
4.根据权利要求1所述的一种封闭场景下车辆道路能力测试方法,其特征在于,所述姿态获取模块由载波相位差分定位装置和惯性测量单元组成。
5.根据权利要求1所述的一种封闭场景下车辆道路能力测试方法,其特征在于,所述激光雷达为16线激光雷达、32线激光雷达和64线激光雷达的其中之一。