TebLocalPlanner stalling out on Jetson Xavier

edit

I am running the Teb Local Planner on my navigation stack. When I run it on our computers (mostly intel based laptops) it works fine, however when i run it on the robot, which has a Jetson Xavier ARM processor, movebase maxes out a core and gets a load avg of 12 and it instantly stalls and does not move. I tried to swap out planners and used the Trajectory planner, and it ran fine, however our robot has ackerman steering so we really need to use Teb Local Planner.

I went through the Teb Local Planner tutorial and changed all of the optimization params including the multi-threading ones. I also ran the teb local planner tutorial on the xavier and it seemed to work fine.

Here is the config for the local planner

TebLocalPlannerROS:

 odom_topic: odom
 map_frame: /map

 # Trajectory

 teb_autosize: True
 dt_ref: .9
 dt_hysteresis: 0.1
 global_plan_overwrite_orientation: True
 max_global_plan_lookahead_dist: 3.0
 feasibility_check_no_poses: 5

 # Robot

 max_vel_x: 2.2
 max_vel_x_backwards: 0.8
 max_vel_theta: 6.28
 acc_lim_x: 5.0
 acc_lim_theta: 12.56
 min_turning_radius: 0.8
 footprint_model: # types: "point", "circular", "two_circles", "line", "polygon"
   type: "two_circles"
   front_offset: 0.5 # for type "two_circles"
   front_radius: 1.2 # for type "two_circles"
   rear_offset: -0.2 # for type "two_circles"
   rear_radius: 0.5 # for type "two_circles"
   #vertices: [ [0.25, -0.05], [0.18, -0.05], [0.18, -0.18], [-0.19, -0.18], [-0.25, 0], [-0.19, 0.18], [0.18, 0.18], [0.18, 0.05], [0.25, 0.05] ] # for type "polygon"

 # GoalTolerance

 xy_goal_tolerance: 1.0
 yaw_goal_tolerance: 1.0
 free_goal_vel: False

 # Obstacles

 min_obstacle_dist: 0.4
 include_costmap_obstacles: False
 costmap_obstacles_behind_robot_dist: 1.0
 obstacle_poses_affected: 1
 costmap_converter_plugin: ""
 costmap_converter_spin_thread: True
 costmap_converter_rate: 5

 # Optimization

 no_inner_iterations: 1
 no_outer_iterations: 1
 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: 10
 weight_kinematics_turning_radius: 1
 weight_optimaltime: 1
 weight_obstacle: 50
 weight_dynamic_obstacle: 10 # not in use yet
 selection_alternative_time_cost: False # not in use yet

 # Homotopy Class Planner

 enable_homotopy_class_planning: False
 enable_multithreading: False
 simple_exploration: False
 max_number_classes: 4
 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

Here is an image link of the top (sorry i don't have enough points to upload an image) - https://ibb.co/g980BVv

any ideas of what could be causing it to stall completely? thank you in advance !