Problems with local path planner

asked 2023-05-17 14:01:29 -0500

Moloto_off gravatar image

Hi all, The global path is built absolutely fine and the robot follows it, but it does not build the local path. At the same time, the local map works and if the robot sees an obstacle on the global path, it stops in front of it, it does not have a street path to go around. If the obstacle is removed, the robot will continue to move along the global path. Here are the settings for the planner. I can't load an image from rviz, but when specifying a point, the global path is drawn normally, but the local one simply doesn't.

costmap_common.yaml

obstacle_range: 2.5
raytrace_range: 3.0

robot_radius: 0.2
inflation_radius: 0.05

observation_sources: laser_scan_sensor #, point_cloud_sensor

 laser_scan_sensor: {sensor_frame: laser, data_type: LaserScan, topic: scan, marking: true, clearing: true, 
 max_obstacle_height: 5, min_obstacle_height: 0}

costmap_global.yaml

global_costmap:
    global_frame: map
    robot_base_frame: base_link
    update_frequency: 5.0
    static_map: true

costmap_local.yaml

global_frame: map
robot_base_frame: base_link
update_frequency: 3.0
publish_frequency: 2.0

static_map: false
rolling_window: true
width: 3.0
height: 3.0
resolution: 0.05

plugins: 
    - {name: static_layer,            type: "costmap_2d::StaticLayer"}
    - {name: inflation_layer,         type: "costmap_2d::InflationLayer"}
    - {name: obstacle_layer,          type: "costmap_2d::ObstacleLayer"}

static_layer:
    enabled:              true
    map_topic:            "/map"


inflation_layer:
    enabled:              true
    cost_scaling_factor:  5  
    inflation_radius:     0.3

obstacle_layer:
    observation_sources: laser_scan_sensor
    footprint_clearing_enabled: true
    laser_scan_sensor: {data_type: LaserScan, sensor_frame: laser, clearing: true, marking: true, topic: scan, max_obstacle_height: 5, min_obstacle_height: 0}

planner.yaml

TrajectoryPlannerROS:
    max_vel_x: 0.15
    min_vel_x: -0.15
    max_vel_theta: 1.5
    min_in_place_vel_theta: 0.01

    acc_lim_theta: 1
    acc_lim_x: 1
    acc_lim_y: 1

    holonomic_robot: true
edit retag flag offensive close merge delete