一种动态窗口局部路径规划方法

本发明提供一种动态窗口局部路径规划方法，包括：基于运动学模型计算机器人未来预测轨迹；根据空中障碍物信息拟合空中障碍物的预测轨迹点序列；对空中障碍物与机器人进行碰撞预测，输出预测碰撞坐标和预测碰撞时间th；以空中障碍物的预计碰撞时间th为时间窗口，计算所有安全实现的结果速度空间Vr；从结果速度空间Vr中离散采样机器人的线速度v和角速度ω的组合，模拟出多条可达轨迹；基于多目标评价函数计算每一条可达轨迹的评价值；从多条可达轨迹中选择评价值最高的可达轨迹，完成局部避障轨迹规划。本发明在规划机器人的路径时，对突发空中障碍物及地面障碍物的避障需求，规划出安全可行的轨迹，提升机器人在多变环境下的避障效率与安全性。