How to show the path generated by 'NavfnPlanner.'

I try to build a minimal system that can show the path planned by the NavfnPlanner. However, no paths are shown on the RVIZ after I push the Navigation2 Goal. I have added the ‘/Plan/Path’ for the Gazebo.


Here is my config file.

map_server:
ros__parameters:
use_sim_time: True
yaml_filename: “turtlebot3_world.yaml”

map_saver:
ros__parameters:
use_sim_time: True
save_map_timeout: 5.0
free_thresh_default: 0.25
occupied_thresh_default: 0.65
map_subscribe_transient_local: True

planner_server:
ros__parameters:
expected_planner_frequency: 20.0
use_sim_time: True
planner_plugins: [“GridBased”]
GridBased:
plugin: “nav2_navfn_planner/NavfnPlanner”
tolerance: 0.5
use_astar: false
allow_unknown: true

planner_server_rclcpp_node:
ros__parameters:
use_sim_time: True

global_costmap:
global_costmap:
ros__parameters:
update_frequency: 1.0
publish_frequency: 1.0
global_frame: map
robot_base_frame: base_link
#robot_base_frame: base_footprint
use_sim_time: True
robot_radius: 0.3
resolution: 0.05
track_unknown_space: true
plugins: [“static_layer”, “obstacle_layer”, “inflation_layer”]
# plugins: [“static_layer”, “inflation_layer”]
obstacle_layer:
plugin: “nav2_costmap_2d::ObstacleLayer”
enabled: True
observation_sources: scan
scan:
topic: /scan
max_obstacle_height: 2.0
clearing: True
marking: True
data_type: “LaserScan”
raytrace_max_range: 3.0
raytrace_min_range: 0.0
obstacle_max_range: 2.5
obstacle_min_range: 0.0
static_layer:
plugin: “nav2_costmap_2d::StaticLayer”
map_subscribe_transient_local: True
inflation_layer:
plugin: “nav2_costmap_2d::InflationLayer”
cost_scaling_factor: 3.0
inflation_radius: 0.05
always_send_full_costmap: True
global_costmap_client:
ros__parameters:
use_sim_time: True
global_costmap_rclcpp_node:
ros__parameters:
use_sim_time: True

Hi @bluebird we will try to give you some hints on this next week,

Cheers,

Roberto

1 Like