基于地图定位能力的路径规划方法

摘要

本发明提供了一种基于地图定位能力的路径规划方法，通过将地图定位能力加入路径节点代价函数，以达到优化规划路径的目的。本发明的规划方法包括以下部分：首先计算概率栅格地图各点的定位能力，其次将概率栅格地图各点加入路径节点代价函数，最后通过路径规划算法进行搜索，计算出从初始点至目标点的移动路径。应用本发明所提出的路径规划方法具有提高移动单位在环境中的定位能力、避免移动单位定位失败等特点，适用于民用、工业、军事等各个领域。