[发明专利]一种无人驾驶汽车局部路径规划性能评价方法

摘要

本发明的目的是提供一种无人驾驶汽车局部路径规划性能评价方法，它能够对现有的基于图搜索的无人驾驶汽车局部路径规划算法性能进行定量评价，衡量各算法的优劣，评选出最优的算法用于无人驾驶汽车领域应用，或者帮助调试和优化路径规划算法的参数，从而提升路径规划算法的性能，促进无人驾驶车辆的自主导航能力。

主权项

1.一种无人驾驶汽车局部路径规划性能评价方法，其特征在于包括如下步骤：/n步骤一：依据需求确定测试条件，获取测试所需的数据信息；/n步骤二：设置评价方法初始化参数，设置曲率所对应的虚拟速度映射关系表；/n步骤三：对待评价的N种路径规划算法在步骤一中确定的测试条件下进行计算，得到N个路径规划结果；/n步骤四：对该N个路径规划结果进行初步判断，剔除不满足测试条件的路径规划结果；/n步骤五：对剩余的M条规划路径(M≤N)进行性能评价，获取时间评价值T；具体包括如下步骤：/nS1、对每一条路径规划结果所得的路径序列点P的个数进行统计，计算出规划路径的相邻两点距离L_i(i∈P的个数范围内)，L_i＝dis(P_i-1,P_i)，其中P_i为路径序列点P的第i个路径点,函数dis(a,b)表示a和b两点之间的直线距离；/nS2、对每一条路径规划结果所得的路径序列点P，计算出每个点的折角θ_i(i∈P的个数范围内)，θ_i＝Ψ(line(P_i,P_i-1),line(P_i+1,P_i))，其中，函数line(a,b)表示点a和点b之间的直线，函数Ψ(A,B)表示A和B两条直线之间的折角；/nS3、根据各个点的折角θ_i的大小，参照步骤二所得的映射关系表，赋予通过该点的速度；/n进一步的，折角越大，车辆从该点经过的速度v_i应该越小，当折角θ_i大于车辆转弯性能时，车辆的速度v_i变为0，即无法经过这个点。/nS4、根据公式T＝L÷v，得到车辆经过每个点所需要耗费的时间T_i＝dis_i/v_i，这里经过第i个节点的距离计算方法为dis_i＝L_i/2+(L_i+1)/2；/nS5、得到总时间即为时间评价值T,T＝ΣT_i,总距离L＝ΣL_i；/nS6、输出时间评价值T；/n其中，步骤S1-S5中所述的距离和速度均为虚拟值；/n步骤六：对比时间评价值T，T越小则车辆通过该段路径所需耗时越短其规划路径更优。/n