diff --git a/src/carla_slam_gmapping/carla_navigation.launch b/src/carla_slam_gmapping/carla_navigation.launch
new file mode 100644
index 0000000000..50e1b10ea2
--- /dev/null
+++ b/src/carla_slam_gmapping/carla_navigation.launch
@@ -0,0 +1,231 @@
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
diff --git a/src/carla_slam_gmapping/carla_slam_navigation.launch b/src/carla_slam_gmapping/carla_slam_navigation.launch
new file mode 100644
index 0000000000..158c263aeb
--- /dev/null
+++ b/src/carla_slam_gmapping/carla_slam_navigation.launch
@@ -0,0 +1,185 @@
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
diff --git a/src/carla_slam_gmapping/costmap_common_params.yaml b/src/carla_slam_gmapping/costmap_common_params.yaml
new file mode 100644
index 0000000000..d339aff288
--- /dev/null
+++ b/src/carla_slam_gmapping/costmap_common_params.yaml
@@ -0,0 +1,24 @@
+# Common costmap parameters for both global and local costmaps
+
+# Obstacle marking parameters
+obstacle_range: 50.0
+raytrace_range: 100.0
+
+# Robot footprint (Tesla Model3 approximate dimensions)
+footprint: [[-2.0, -1.0], [-2.0, 1.0], [2.5, 1.0], [2.5, -1.0]]
+inflation_radius: 1.5
+cost_scaling_factor: 10.0
+
+# Observation sources
+observation_sources: laser_scan_sensor
+
+laser_scan_sensor:
+ sensor_frame: ego_vehicle/lidar
+ data_type: LaserScan
+ topic: /carla/ego_vehicle/scan
+ marking: true
+ clearing: true
+ min_obstacle_height: -0.5
+ max_obstacle_height: 2.0
+ obstacle_range: 50.0
+ raytrace_range: 100.0
diff --git a/src/carla_slam_gmapping/dwa_local_planner_params.yaml b/src/carla_slam_gmapping/dwa_local_planner_params.yaml
new file mode 100644
index 0000000000..6b7407b833
--- /dev/null
+++ b/src/carla_slam_gmapping/dwa_local_planner_params.yaml
@@ -0,0 +1,52 @@
+# DWA Local Planner parameters
+
+DWAPlannerROS:
+ # Robot configuration (Tesla Model3 specs)
+ max_vel_x: 10.0
+ min_vel_x: -2.0
+ max_vel_y: 0.0
+ min_vel_y: 0.0
+
+ max_trans_vel: 10.0
+ min_trans_vel: 0.5
+ trans_stopped_vel: 0.1
+
+ max_rot_vel: 1.0
+ min_rot_vel: 0.2
+ rot_stopped_vel: 0.1
+
+ # Acceleration limits
+ acc_lim_x: 2.5
+ acc_lim_y: 0.0
+ acc_lim_theta: 3.0
+ decel_lim_x: -2.5
+ decel_lim_theta: -3.0
+
+ # Goal tolerance
+ xy_goal_tolerance: 0.5
+ yaw_goal_tolerance: 0.1
+ latch_xy_goal_tolerance: false
+
+ # Forward simulation
+ sim_time: 2.0
+ sim_granularity: 0.025
+ vx_samples: 20
+ vy_samples: 0
+ vtheta_samples: 40
+
+ # Trajectory scoring
+ path_distance_bias: 32.0
+ goal_distance_bias: 20.0
+ occdist_scale: 0.02
+ forward_point_distance: 0.325
+ stop_time_buffer: 0.2
+ scaling_speed: 0.25
+ max_scaling_factor: 0.2
+
+ # Oscillation prevention
+ oscillation_reset_dist: 0.05
+ oscillation_reset_angle: 0.2
+
+ # Debugging
+ publish_traj_pc: true
+ publish_cost_grid_pc: true
diff --git a/src/carla_slam_gmapping/global_costmap_params.yaml b/src/carla_slam_gmapping/global_costmap_params.yaml
new file mode 100644
index 0000000000..1a4fb93ece
--- /dev/null
+++ b/src/carla_slam_gmapping/global_costmap_params.yaml
@@ -0,0 +1,19 @@
+# Global costmap parameters
+
+global_costmap:
+ global_frame: map
+ robot_base_frame: ego_vehicle
+ update_frequency: 2.0
+ publish_frequency: 1.0
+ static_map: true
+
+ # Use rolling window for exploration mode
+ rolling_window: false
+ width: 200.0
+ height: 200.0
+ resolution: 0.05
+
+ plugins:
+ - {name: static_layer, type: "costmap_2d::StaticLayer"}
+ - {name: obstacle_layer, type: "costmap_2d::ObstacleLayer"}
+ - {name: inflation_layer, type: "costmap_2d::InflationLayer"}
diff --git a/src/carla_slam_gmapping/local_costmap_params.yaml b/src/carla_slam_gmapping/local_costmap_params.yaml
new file mode 100644
index 0000000000..9226cd29ba
--- /dev/null
+++ b/src/carla_slam_gmapping/local_costmap_params.yaml
@@ -0,0 +1,17 @@
+# Local costmap parameters
+
+local_costmap:
+ global_frame: odom
+ robot_base_frame: ego_vehicle
+ update_frequency: 5.0
+ publish_frequency: 2.0
+ static_map: false
+ rolling_window: true
+
+ width: 20.0
+ height: 20.0
+ resolution: 0.05
+
+ plugins:
+ - {name: obstacle_layer, type: "costmap_2d::ObstacleLayer"}
+ - {name: inflation_layer, type: "costmap_2d::InflationLayer"}
diff --git a/src/carla_slam_gmapping/move_base_params.yaml b/src/carla_slam_gmapping/move_base_params.yaml
new file mode 100644
index 0000000000..109571fa59
--- /dev/null
+++ b/src/carla_slam_gmapping/move_base_params.yaml
@@ -0,0 +1,29 @@
+# Move base parameters
+
+# Controller frequency
+controller_frequency: 10.0
+controller_patience: 15.0
+
+# Planner frequency
+planner_frequency: 5.0
+planner_patience: 5.0
+
+# Oscillation parameters
+oscillation_timeout: 10.0
+oscillation_distance: 0.2
+
+# Recovery behaviors
+recovery_behavior_enabled: true
+clearing_rotation_allowed: true
+
+recovery_behaviors:
+ - name: 'conservative_reset'
+ type: 'clear_costmap_recovery/ClearCostmapRecovery'
+ - name: 'aggressive_reset'
+ type: 'clear_costmap_recovery/ClearCostmapRecovery'
+
+conservative_reset:
+ reset_distance: 3.0
+
+aggressive_reset:
+ reset_distance: 5.0