TebLocalPlannerROS: trajectory is not feasible. Resetting planner...

asked 2021-10-18 06:25:12 -0500

Delbina gravatar image

updated 2021-10-18 10:00:59 -0500

hi

I want to use teb local planner for my warthog robot: Does teb_local planner applicale on a differential robot? I have tried to use it, but i receive the following error:

TebLocalPlannerROS: trajectory is not feasible. Resetting planner...
[ WARN] [1634556143.294942845]: TebLocalPlannerROS: trajectory is not feasible. Resetting planner...
[ WARN] [1634556143.417332012]: Clearing costmap to unstuck robot (3.000000m).
[ WARN] [1634556143.670586985]: TebLocalPlannerROS: trajectory is not feasible. Resetting planner...
[ WARN] [1634556143.792276239]: Rotate recovery behavior started.


TebLocalPlannerROS:

 odom_topic: icp_odom

 # Trajectory

 teb_autosize: True
 dt_ref: 0.3
 dt_hysteresis: 0.1
 global_plan_overwrite_orientation: True
 allow_init_with_backwards_motion: False
 max_global_plan_lookahead_dist: 3.0
 feasibility_check_no_poses: 5

 # Robot

 max_vel_x: 2.0
 max_vel_x_backwards: 2.2
 max_vel_y: 0.0
 max_vel_theta: 2.0
 acc_lim_x: 2.5
 acc_lim_theta: 2.5
 min_turning_radius: 0.0 # diff-drive robot (can turn on place!)

 footprint_model:
   type: "point"

 # GoalTolerance

 xy_goal_tolerance: 0.2
 yaw_goal_tolerance: 0.1
 free_goal_vel: False

 # Obstacles

 min_obstacle_dist: 0.75 # This value must also include our robot radius, since footprint_model is set to "point".
 include_costmap_obstacles: True
 costmap_obstacles_behind_robot_dist: 1.5
 obstacle_poses_affected: 30
 costmap_converter_plugin: ""
 costmap_converter_spin_thread: True
 costmap_converter_rate: 5

 # Optimization

 no_inner_iterations: 5
 no_outer_iterations: 4
 optimization_activate: True
 optimization_verbose: False
 penalty_epsilon: 0.1
 weight_max_vel_x: 2
 weight_max_vel_theta: 1
 weight_acc_lim_x: 1
 weight_acc_lim_theta: 1
 weight_kinematics_nh: 1000
 weight_kinematics_forward_drive: 1
 weight_kinematics_turning_radius: 1
 weight_optimaltime: 1
 weight_obstacle: 50
 weight_dynamic_obstacle: 10 # not in use yet
 weight_adapt_factor: 2

 # Homotopy Class Planner

 enable_homotopy_class_planning: True
 enable_multithreading: True
 simple_exploration: False
 max_number_classes: 4
 selection_cost_hysteresis: 1.0
 selection_obst_cost_scale: 1.0
 selection_alternative_time_cost: False

 roadmap_graph_no_samples: 15
 roadmap_graph_area_width: 5
 h_signature_prescaler: 0.5
 h_signature_threshold: 0.1
 obstacle_keypoint_offset: 0.1
 obstacle_heading_threshold: 0.45
 visualize_hc_graph: False

what is the solution?

edit retag flag offensive close merge delete

Comments

@croesmann would you please help me to resolve this issue? I have searched a lot but could not find any proper answer.

Delbina gravatar image Delbina  ( 2021-10-19 06:40:37 -0500 )edit