修改ROS中使用的全局规路径划算法——将dikstra修改为A*

最新推荐文章于 2023-06-08 18:44:32 发布

一颗大椰子

最新推荐文章于 2023-06-08 18:44:32 发布

阅读量3.9k

点赞数 7

分类专栏：搭建移动机器人文章标签：自动驾驶人工智能机器学习

本文链接：https://blog.csdn.net/xuoeigan/article/details/124557987

版权

搭建移动机器人专栏收录该内容

15 篇文章

订阅专栏

本文介绍了如何在ROS中修改全局路径规划算法，包括在yaml文件中调整参数和直接修改源码。方法一是修改move_base_params.yaml文件中的全局规划器设置；方法二是直接编辑global_planner的planner_core.cpp，将true改为false以避免某些问题；方法三是注释掉Dijkstra部分，启用A*算法。然而，修改源码可能导致路径规划不稳定并出现错误。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

一、方法一：修改调用参数

1.在ROS功能中，找到设置调用全局规划路径算法的yaml文件
2.如图我的机器人中，设置全局路径规划算法的yaml文件是move_base_params.yaml
3.将文件中的base_global_planner: "navfn/NavfnROS"改为base_global_planner: "global_planner/GlobalPlanner"
在这里插入图片描述
4.修改完后需要将编译好的devel文件删除，然后使用catkin_make命令重新编译生成新的devel文件。不然有可能对于全局路径算法的修改不生效。

二、方法二（推荐）：修改源码

1.在navigation元功能包中找到global_planner功能包，进而找到其中planner_core.cpp文件。
2.如图所示红框内的代码，大概在116行左右，将这行代码的true改为false。
在这里插入图片描述
3.修改完后需要将编译好的devel文件删除，然后使用catkin_make命令重新编译生成新的devel文件。不然有可能对于全局路径算法的修改不生效。

4.本人使用此方法时，可能会出现问题：
全局路径有时候可以规划成功，有时候不能规划成功，而且频繁发出警告。
在这里插入图片描述
主要重复的问题代码为

[ERROR] [1614933280.932329604]: NO PATH!
[ERROR] [1614933280.932975937]: Failed to get a plan from potential when a legal potential was found. This shouldn't happen.

5.尝试解决报错
经过网上查找，发现此方法并无作用
在这里插入图片描述

三、方法三（推荐）：修改源码

1.找到planner_core.cpp文件中的initialize函数
2.注释掉使用Dijkstra的部分，就可以使用A*算法了。
具体操作：将②部分红框内if的上半部分代码全部注释掉，剩下绿框内的代码。
3.①部分红框内的代码可以用打印信息验证是否使用的是dikstra全局路径算法，如果不是则使用的是A*算法
在这里插入图片描述
4.修改完后需要将编译好的devel文件删除，然后使用catkin_make命令重新编译生成新的devel文件。不然有可能对于全局路径算法的修改不生效。