1.一种用于固定场景的路径规划方法,其特征在于,包括:获取固定场景的地图,基于地图中的障碍物构建KD树,并且通过路径搜索算法规划移动对象的移动路径;路径搜索算法采用混合A*算法;
基于KD树计算当前路径节点与障碍物之间的最短距离记为风险距离,并且根据风险距离判断移动对象的风险程度;在计算出风险距离后,将风险距离加入到混合A*算法的代价函数中;
根据风险距离判断移动对象的风险程度时,基于移动对象的最大自身尺寸数据确定多个面积不同的扩展区域,不同的扩展区域对应不同的风险程度,并且基于风险距离与扩展区域的拟合关系确定移动对象的风险程度;
根据移动对象的风险程度扩展路径节点;当风险程度达到第一界限时,将混合A*算法的步长调整为预设的最小值、曲率调整为预设的最大值,当风险程度达到第二界限时,基于风险距离对混合A*算法的步长和曲率进行动态调整;
基于风险距离对混合A*算法的步长进行动态调整的方法为:其中,D(x)为风险距离,max_l和min_l分别代表预设的最大步长和最小步长,ε为移动对象的最大自身尺寸数据;
基于风险距离对混合A*算法的曲率进行动态调整的方法为:其中,max_c和min_c分别代表预设的最大曲率和最小曲率;
当扩展到能够直接利用RS曲线连接终点的路径节点时,对该路径节点的角度信息进行规整;
对RS曲线进行平滑处理。
2.如权利要求1所述的一种用于固定场景的路径规划方法,其特征在于,当扩展到能够直接利用RS曲线连接终点的路径节点时,将该路径节点的角度信息规整到
3.如权利要求1所述的一种用于固定场景的路径规划方法,其特征在于,对RS曲线进行平滑处理的方法包括:确定角度发生跳变的路径节点记为角度跳变点;
计算角度跳变点与障碍物之间的最短距离记为修正距离;
基于修正距离计算RS曲线的长度修正数据和曲率修正数据;
根据长度修正数据和曲率修正数据对RS曲线进行修正。
4.如权利要求3所述的一种用于固定场景的路径规划方法,其特征在于,确定角度跳变点的方法为:遍历移动路径上每个路径节点的角度;
计算路径节点的角度与前一个路径节点的角度之间的差值;
当差值大于预设的阈值时确定路径节点的角度发生跳变,该路径节点记为角度跳变点。