此为更快速的slam+自定义bt

src/gc_navigation2_slamtoolbox/params/gc_navigation_slam.yaml

@@ -8,7 +8,7 @@ bt_navigator:
     global_frame: map
     robot_base_frame: base_footprint
     odom_topic: /odom
-    bt_loop_duration: 20
+    bt_loop_duration: 50
     default_server_timeout: 20
     # 阿克曼底盘专用 BT：移除 Spin，恢复行为 = 清代价地图 → 后退 → 等待
     default_nav_to_pose_bt_xml: /home/guoch/test_ws/install/gc_navigation2_slamtoolbox/share/gc_navigation2_slamtoolbox/config/nav_to_pose_ackermann.xml
@@ -64,12 +64,12 @@ bt_navigator_rclcpp_node:
 controller_server:
   ros__parameters:
     use_sim_time: True
-    controller_frequency: 30.0
+    controller_frequency: 20.0
     FollowPath:
       plugin: "nav2_mppi_controller::MPPIController"
-      time_steps: 56
+      time_steps: 36
       model_dt: 0.05
-      batch_size: 2000
+      batch_size: 1000
       vx_std: 0.2
       vy_std: 0.0
       wz_std: 0.4
@@ -313,7 +313,8 @@ behavior_server:
       plugin: "nav2_behaviors/Spin"    # 需保留以匹配默认 BT XML
     backup:
       plugin: "nav2_behaviors/BackUp"
-      backup_dist: 0.5
+      backup_dist: 0.8
+      backup_speed: 0.18
     wait:
       plugin: "nav2_behaviors/Wait"
       wait_duration: 0.5