一种改进型D*Lite车辆动态路径规划方法

摘要

本发明公开了一种改进型D*Lite车辆动态路径规划方法，包括以下步骤：1)获取车辆当前状态及目标状态，并获取当前环境地图信息，再使用形态学操作对当前环境地图中的障碍物进行膨胀；2)构建车辆运行学模型；3)基于车辆运动学模型的限制，使用D*Lite算法在膨胀后的环境地图上搜索路径；4)根据Reeds‑Shepp曲线对到达终点时车辆的朝向角进行调整；5)根据步骤3)生成的最短路径及步骤4)中的Reeds‑Shepp曲线构建最终路径，然后使用能量函数及梯度下降法对最终路径进行平滑，完成改进型D*Lite车辆动态路径规划，该方法能够在动态的环境下实现路径的规划。