1.一种路径规划方法,其特征在于,包括:
获取车辆的起始位置、目标位置、车辆几何参数和最小离地间隙参数以及非铺装道路的路面几何特征参数和路面不平度特征参数;
对所述非铺装道路进行离散采样,得到多个路面采样点;
根据所述路面几何特征参数和所述路面不平度特征参数,构建道路不平度风险势场模型和道路边界风险势场模型;
历遍各所述路面采样点,确定自所述起始位置至所述目标位置的综合代价最低的目标路径;所述综合代价由平滑度代价和安全度代价拟合得到,所述平滑度代价表征路径的弯曲程度,所述安全度代价表征路径的安全程度,所述安全度代价为基于所述车辆几何参数和所述最小离地间隙参数,采用所述道路不平度风险势场模型和所述道路边界风险势场模型对所述车辆的质心和车角进行安全度风险评估得到;
所述道路不平度风险势场模型为:
,
其中,n=1,2,...,nobs,k=1,2,...,kmax,nobs为路面不平度特征的总数,kmax为目标样本点的总数,目标样本点为路面采样点、质心采样点或车角采样点,为第n个路面不平度特征在第k个目标样本点的高度,为各路面不平度特征叠加后在第k个目标样本点的高度,为第k个目标样本点的道路不平度风险势场值,An为第n个路面不平度特征的特征辨识参数,、、和分别为第n个路面不平度特征以参考点为原点沿x轴正方向、x轴负方向、y轴正方向和y轴负方向的分布因子,和分别为第k个目标样本点的x轴坐标和y轴坐标,和分别为第n个路面不平度特征的参考点的x轴坐标和y轴坐标,Cn为第n个路面不平度特征的下降系数,x轴与非铺装道路的路长方向相平行,y轴与非铺装道路的路宽方向相平行;
所述道路边界风险势场模型为:
,
其中,m=1,2,...,nroad,nroad为道路边界的总数,为第m个道路边界在第k个目标样本点的道路边界风险势场值,为第k个目标样本点的道路边界风险势场值,为第m个道路边界风险势场值的峰值系数,为第m个道路边界的y轴坐标,为第m个道路边界风险势场值的分布因子,为第m个道路边界风险势场值的下降系数。
2.根据权利要求1所述的路径规划方法,其特征在于,所述对所述非铺装道路进行离散采样,得到多个路面采样点,包括:以所述非铺装道路的路面边缘、所述起始位置和所述目标位置为边界,对所述非铺装道路的路面空间内进行连续的离散采样,得到多个路面采样点;所述路面采样点分布于多个采样区域内,各所述采样区域内分布有多个所述路面采样点,各所述采样区域沿所述非铺装道路的路长方向排列。
3.根据权利要求1所述的路径规划方法,其特征在于,所述路面采样点分布于多个采样区域内,各所述采样区域内分布有多个所述路面采样点,各所述采样区域沿所述非铺装道路的路长方向排列,所述历遍各所述路面采样点,确定自所述起始位置至所述目标位置的综合代价最低的目标路径,包括:基于多项式曲线拟合原理,生成候选路径;所述候选路径包括从所述起始位置到第一个所述采样区域内的任一所述路面采样点的路径、从前一个所述采样区域内的任一所述路面采样点到后一个所述采样区域内的任一所述路面采样点的路径和从最后一个所述采样区域内的任一所述路面采样点到所述目标位置的路径;
对所述候选路径进行平滑度风险评估,得到所述候选路径的平滑度代价;
采用所述道路不平度风险势场模型和所述道路边界风险势场模型,对所述候选路径上的所述车辆的质心和车角进行安全度风险评估,得到所述候选路径的安全度代价;
对所述候选路径的平滑度代价和所述候选路径的安全度代价进行加权求和,得到所述候选路径的综合代价;
根据所述候选路径的综合代价,自所述目标位置至所述起始位置进行路径逆向发现,得到所述目标路径。
4.根据权利要求3所述的路径规划方法,其特征在于,所述对所述候选路径进行平滑度风险评估,得到所述候选路径的平滑度代价,包括:对所述候选路径进行连续采样,得到多个候选路径采样点;
根据所述候选路径在各所述候选路径采样点上的曲率,确定所述候选路径的整体曲率,以得到所述候选路径的平滑度代价。
5.根据权利要求3所述的路径规划方法,其特征在于,所述采用所述道路不平度风险势场模型和所述道路边界风险势场模型,对所述候选路径上的所述车辆的质心和车角进行安全度风险评估,得到所述候选路径的安全度代价,包括:根据所述车辆几何参数,对所述候选路径上的所述车辆的质心和车角两者的位置进行连续采样,得到多个质心采样点和多个车角采样点;
将所述质心采样点和所述车角采样点分别输入所述道路不平度风险势场模型和所述道路边界风险势场模型,得到所述质心和所述车角两者的道路不平度风险势场值和道路边界风险势场值;
根据所述车角的道路不平度风险势场值和道路边界风险势场值,计算所述车角的安全度代价,根据所述最小离地间隙参数以及所述质心的道路不平度风险势场值和道路边界风险势场值,计算所述质心的安全度代价;
根据所述车角的安全度代价和所述质心的安全度代价,计算所述候选路径的安全度代价。
6.根据权利要求3所述的路径规划方法,其特征在于,所述根据所述候选路径的综合代价,自所述目标位置至所述起始位置进行路径逆向发现,得到所述目标路径,包括:根据所述候选路径的综合代价,历遍各目标路径点,确定从所述起始位置到达各所述目标路径点的最优代价;所述目标路径点包含第二个至最后一个所述采样区域内的任一所述路面采样点和所述目标位置,所述最优代价为从所述起始位置经若干所述候选路径并到达所述目标路径点的最小综合代价;
根据所述最优代价,确定所述目标路径点对应的最优路径点;所述最优路径点为所述最优代价对应的路径到达所述目标路径点之前经过的最后一个所述路面采样点;
根据所述目标路径点对应的最优路径点,进行从所述目标位置至所述起始位置的路径逆向回溯,得到所述目标路径。
7.一种路径规划装置,其特征在于,包括:
第一模块,用于获取车辆的起始位置、目标位置、车辆几何参数和最小离地间隙参数以及非铺装道路的路面几何特征参数和路面不平度特征参数;
第二模块,用于对所述非铺装道路进行离散采样,得到多个路面采样点;
第三模块,用于根据所述路面几何特征参数和所述路面不平度特征参数,构建道路不平度风险势场模型和道路边界风险势场模型;
第四模块,用于历遍各所述路面采样点,确定自所述起始位置至所述目标位置的综合代价最低的目标路径;所述综合代价由平滑度代价和安全度代价拟合得到,所述平滑度代价表征路径的弯曲程度,所述安全度代价表征路径的安全程度,所述安全度代价为基于所述车辆几何参数和所述最小离地间隙参数,采用所述道路不平度风险势场模型和所述道路边界风险势场模型对所述车辆的质心和车角进行安全度风险评估得到;
所述道路不平度风险势场模型为:
,
其中,n=1,2,...,nobs,k=1,2,...,kmax,nobs为路面不平度特征的总数,kmax为目标样本点的总数,目标样本点为路面采样点、质心采样点或车角采样点,为第n个路面不平度特征在第k个目标样本点的高度,为各路面不平度特征叠加后在第k个目标样本点的高度,为第k个目标样本点的道路不平度风险势场值,An为第n个路面不平度特征的特征辨识参数,、、和分别为第n个路面不平度特征以参考点为原点沿x轴正方向、x轴负方向、y轴正方向和y轴负方向的分布因子,和分别为第k个目标样本点的x轴坐标和y轴坐标,和分别为第n个路面不平度特征的参考点的x轴坐标和y轴坐标,Cn为第n个路面不平度特征的下降系数,x轴与非铺装道路的路长方向相平行,y轴与非铺装道路的路宽方向相平行;
所述道路边界风险势场模型为:
,
其中,m=1,2,...,nroad,nroad为道路边界的总数,为第m个道路边界在第k个目标样本点的道路边界风险势场值,为第k个目标样本点的道路边界风险势场值,为第m个道路边界风险势场值的峰值系数,为第m个道路边界的y轴坐标,为第m个道路边界风险势场值的分布因子,为第m个道路边界风险势场值的下降系数。
8.一种电子设备,其特征在于,所述电子设备包括存储器和处理器,所述存储器存储有计算机程序,所述处理器执行所述计算机程序时实现权利要求1至6任一项所述的路径规划方法。
9.一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1至6中任一项所述的路径规划方法。