Nav2 kind of works with slam IRL

Ensmasteel · May 15, 2024 · 031dc6b · 031dc6b
1 parent 8ac7030
commit 031dc6b
Show file tree

Hide file tree

Showing 2 changed files with 9 additions and 8 deletions.
diff --git a/src/ezbot_robot/config/nav2_params.yaml b/src/ezbot_robot/config/nav2_params.yaml
@@ -110,7 +110,7 @@ controller_server:
       transform_tolerance: 0.1
       temperature: 0.3
       gamma: 0.015
-      motion_model: "DiffDrive"
+      motion_model: "Omni"
       visualize: true
       regenerate_noises: true
       TrajectoryVisualizer:
@@ -274,7 +274,7 @@ planner_server:
     planner_plugins: ["GridBased"]
     GridBased:
       plugin: "nav2_navfn_planner/NavfnPlanner"
-      tolerance: 0.5
+      tolerance: 0.05
       use_astar: false
       allow_unknown: true
 
@@ -330,10 +330,10 @@ velocity_smoother:
     smoothing_frequency: 20.0
     scale_velocities: False
     feedback: "OPEN_LOOP"
-    max_velocity: [0.5, 0.0, 2.0]
-    min_velocity: [-0.5, 0.0, -2.0]
-    max_accel: [2.5, 0.0, 3.2]
-    max_decel: [-2.5, 0.0, -3.2]
+    max_velocity: [0.5, 0.5, 2.0]
+    min_velocity: [-0.5, -0.5, -2.0]
+    max_accel: [2.5, 2.5, 3.2]
+    max_decel: [-2.5, -2.5, -3.2]
     odom_topic: "/omnidirectional_controller/odom"
     odom_duration: 0.1
     deadband_velocity: [0.0, 0.0, 0.0]
@@ -360,7 +360,7 @@ collision_monitor:
       time_before_collision: 1.2
       simulation_time_step: 0.1
       min_points: 6
-      visualize: False
+      visualize: True
       enabled: True
     observation_sources: ["scan"]
     scan:

diff --git a/src/ezbot_simulation/launch/launch_sim.launch.py b/src/ezbot_simulation/launch/launch_sim.launch.py
@@ -74,7 +74,8 @@ def generate_launch_description():
         DeclareLaunchArgument(
             'world',
             #default_value=[os.path.join('ezbot_simulation','worlds','table2024.world'), ''],
-            default_value=[os.path.join(get_package_share_directory("ezbot_simulation"), 'worlds', 'table_with_panneaux.world'), ''],
+            #default_value=[os.path.join(get_package_share_directory("ezbot_simulation"), 'worlds', 'table_with_panneaux.world'), ''],
+            default_value=[os.path.join(get_package_share_directory("ezbot_simulation"), 'worlds', 'table2024Poteaux.world'), ''],
             description='SDF world file'),
         rsp,
         spawn_entity,