globalplanner_py This code works but it is not good. Run the node: rosrun globalplanner_py rrt_simplegoal.py