具有复杂地形可通过性判断的移动机器人路径规划方法

摘要

本发明提供一种具有复杂地形通过性判断的移动机器人路径规划方法，其包括以下步骤：S1、为保证约束条件，定义三个约束参数c1、c2、c3，并得到最终约束参数；S2、对地形可通过性进行评估；S3、基于A*算法，将路径点分为起点、多个中间点和终点，并将评估结果加入至基于A*算法的启发式搜索中。本发明为克服A*算法的路径搜索过于保守的缺点，在搜索过程中加入了基于核密度估计的可通过性评估，该方法很好地解决了复杂地形下无法找到最优路径或者只找到次优路径的问题，有效提高了机器人的作业效率。