动态环境移动机器人NMPC-IRRT*分层路径规划分层路径规划

Hierarchical Path Planning for Mobile Robots in Dynamic Environments Using NMPC-IRRT*

  • 摘要: 针对移动机器人在动态复杂环境下的路径规划问题,提出了一种基于非线性模型预测的控制与启发式RRT*的分层路径规划算法(NMPC-IRRT*)。该算法分为上下两层,上层根据障碍物分布,利用启发式RRT*算法,通过椭圆采样启发式策略生成高质量全局初始轨迹;下层利用非线性模型预测控制(NMPC)局部导航控制器,结合线性运动模型预测动态障碍物未来轨迹,实现对路径的实时跟踪与动态避障。仿真对比显示,在复杂动态环境下,该算法的平均运行时间为51.47 s,较DWA-IRRT*算法缩短了约71.5%,平均路径长度缩短了32.9%;当动态障碍物数量增加至30个的高密度场景时,规划成功率仍能保持在90%以上,且其轨迹曲率方差和角速度变化率均为对比算法中最低。该算法通过全局拓扑引导与局部预测优化的协同,解决了传统采样算法路径质量差及动态避障实时性不足的问题,实现了机器人在复杂未知动态场景下的自主导航。

     

    Abstract: To address the path planning problem of mobile robots in dynamic complex environments, a hierarchical path planning algorithm based on nonlinear model predictive control and informed RRT* (NMPC-IRRT*) is proposed. The algorithm is divided into upper and lower layers: the upper layer utilizes the informed RRT* algorithm based on obstacle distribution to generate a high-quality global initial trajectory through an elliptical sampling heuristic strategy. The lower layer employs an NMPC local navigation controller, combined with a linear motion model to predict the future trajectories of dynamic obstacles, achieving real-time path tracking and dynamic obstacle avoidance. Simulation comparisons show that in complex dynamic environments, the average running time of the algorithm is 51.47 s, which is approximately 71.5% shorter than that of the DWA-IRRT* algorithm, and the average path length is reduced by 32.9%. In high-density scenarios where the number of dynamic obstacles increases to 30, the planning success rate remains above 90%, and its trajectory curvature variance and angular velocity change rate are the lowest among the compared algorithms. Through the synergy of global topological guidance and local predictive optimization, the algorithm addresses the problems of poor path quality and insufficient real-time performance in dynamic obstacle avoidance of traditional sampling algorithms, achieving autonomous navigation for robots in complex unknown dynamic scenes.

     

/

返回文章
返回