Teb local planner on pi4

asked 2023-02-27 08:43:34 -0500

chm007 gravatar image

updated 2023-03-01 07:40:54 -0500

Good Morning All,

Has anyone had any luck running TEB local planner on Pi4 for holomonic robot. I have gone through the tutorials successfully but can't seem to get move_base running with TEB. If anyone had success please share some tips.

#config
odom_topic: /odometry/filtered
map_frame: /map

# Robot
acc_lim_theta: 0.5
acc_lim_x: 1.0
acc_lim_y: 1.0
max_vel_theta: 0.2
max_vel_x: 0.17
max_vel_x_backwards: 0.17
max_vel_y: 0.17
min_turning_radius: 0.0

# Footprint Configuration
footprint_model:
   type: "point"

# GoalTolerance
xy_goal_tolerance: 0.2
yaw_goal_tolerance: 0.1
free_goal_vel: false

# Obstacles
min_obstacle_dist: 0.15
include_costmap_obstacles: true
costmap_obstacles_behind_robot_dist: 1.0
obstacle_poses_affected: 5
legacy_obstacle_association: false

# Optimization
no_inner_iterations: 5
no_outer_iterations: 4
optimization_activate: true
optimization_verbose: false
penalty_epsilon: 0.05
weight_max_vel_x: 1.5
weight_max_vel_y: 1.5
weight_max_vel_theta: 0.5
weight_acc_lim_x: 0.5
weight_acc_lim_y: 0.7
weight_acc_lim_theta: 0.3
weight_kinematics_forward_drive: 1.0
weight_kinematics_nh: 1.0
weight_kinematics_turning_radius: 1.0
weight_obstacle: 10.0
weight_optimaltime: 1.0
weight_inflation: 0.1
weight_viapoint: 1.0
weight_adapt_factor: 2.0

# Homotopy Class Planner
enable_homotopy_class_planning: false
enable_multithreading: true
roadmap_graph_no_samples: 5
roadmap_graph_area_width: 1.5
h_signature_prescaler: 1.0
h_signature_threshold: 0.1
obstacle_heading_threshold: 0.45
obstacle_association_force_inclusion_factor: 1.5
obstacle_association_cutoff_factor: 1.0
max_number_classes: 3
wheelbase: 0.175
selection_alternative_time_cost: false


#Trajectory 
allow_init_with_backwards_motion: true
max_global_plan_lookahead_dist: 2.0
min_samples: 3
dt_hysteresis: 0.1
dt_ref: 0.3
exact_arc_length: false
cmd_angle_instead_rotvel: false
global_plan_overwrite_orientation: true
include_dynamic_obstacles: false
feasibility_check_no_poses: 5
force_reinit_new_goal_dist: 1.0
global_plan_viapoint_sep: -0.1
is_footprint_dynamic: false
inflation_dist: 0.3

#Other
publish_feedback: false
selection_cost_hysteresis: 1.0
selection_obst_cost_scale: 2.0
selection_prefer_initial_plan: 0.95
selection_viapoint_cost_scale: 1.0
shrink_horizon_backup: true
switching_blocking_period: 0.0
visualize_hc_graph: false
edit retag flag offensive close merge delete

Comments

Can you show the configuration for the TEB local planner

bribri123 gravatar image bribri123  ( 2023-02-28 22:28:17 -0500 )edit

Have you had luck using DWA local plannner?

bribri123 gravatar image bribri123  ( 2023-02-28 22:28:45 -0500 )edit

I have added the TEB config file above. I did try DWA with some success. The issue with DWA is that my robot is a 3 wheel omni-wheel, omni-directional robot, basically a holonomic robot . DWA has very curved trajectories resulting in less that optimum navigation especially in smaller areas. What are your thought on my TEB config?

chm007 gravatar image chm007  ( 2023-03-01 07:46:50 -0500 )edit