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