Azimut3 config: updated move_base parameters

launch/azimut3/config/base_local_planner_params.yaml

@@ -12,7 +12,7 @@ TrajectoryPlannerROS:
   max_vel_theta: 0.5
   min_vel_theta: -0.5
   min_in_place_vel_theta: 0.25
-  holonomic_robot: true
+  holonomic_robot: false
 
   xy_goal_tolerance:  0.25
   yaw_goal_tolerance: 0.25
@@ -27,8 +27,8 @@ TrajectoryPlannerROS:
 
   meter_scoring: true
 
-  pdist_scale: 0.95 # The higher will follow more the global path.
+  pdist_scale: 0.8 # The higher will follow more the global path.
-  gdist_scale: 0.2
+  gdist_scale: 0.8
   occdist_scale: 0.01
   publish_cost_grid_pc: false
 

launch/azimut3/config/costmap_common_params_2d.yaml

@@ -0,0 +1,45 @@
+footprint: [[ 0.3,  0.3], [-0.3,  0.3], [-0.3, -0.3], [ 0.3, -0.3]]
+footprint_padding: 0.02
+#robot_radius: 0.38
+#robot_radius: ir_of_robot
+inflation_layer:
+  inflation_radius: 0.6 # 2xfootprint, it helps to keep the global planned path farther from obstacles
+transform_tolerance: 2
+
+obstacle_layer:
+  obstacle_range: 2.5
+  raytrace_range: 3
+  max_obstacle_height: 0.4
+  track_unknown_space: true
+
+  observation_sources: laser_scan_sensor point_cloud_sensorA point_cloud_sensorB
+
+  laser_scan_sensor: {
+    data_type: LaserScan,
+    topic: base_scan,
+    expected_update_rate: 0.2,
+    marking: true,
+    clearing: true
+  }
+
+  point_cloud_sensorA: {
+    sensor_frame: base_footprint,
+    data_type: PointCloud2,
+    topic: obstacles_cloud,
+    expected_update_rate: 0.5,
+    marking: true,
+    clearing: true,
+    min_obstacle_height: 0.04
+  }
+
+  point_cloud_sensorB: {
+    sensor_frame: base_footprint,
+    data_type: PointCloud2,
+    topic: ground_cloud,
+    expected_update_rate: 0.5,
+    marking: false,
+    clearing: true,
+    min_obstacle_height: -1.0 # make usre the ground is not filtered
+  }
+
+

launch/azimut3/config/global_costmap_params.yaml

@@ -6,5 +6,6 @@ publish_frequency: 2
 always_send_full_costmap: false
 plugins:
    - {name: static_layer, type: "rtabmap_ros::StaticLayer"}
+   - {name: obstacle_layer, type: "costmap_2d:ObstacleLayer"}
    - {name: inflation_layer, type: "costmap_2d::InflationLayer"}
 

launch/azimut3/config/local_costmap_params.yaml

@@ -0,0 +1,14 @@
+global_frame: odom
+robot_base_frame: base_footprint
+update_frequency: 2
+publish_frequency: 1
+rolling_window: true
+width: 3.0
+height: 3.0
+resolution: 0.025
+origin_x: 0
+origin_y: 0
+
+plugins:
+  - {name: obstacle_layer,   type: "costmap_2d::ObstacleLayer"}
+  - {name: inflation_layer,  type: "costmap_2d::InflationLayer"}

launch/azimut3/config/local_costmap_params_2d.yaml

@@ -1,4 +1,4 @@
-global_frame: map
+global_frame: odom
 robot_base_frame: base_footprint
 update_frequency: 2.0
 publish_frequency: 2.0

launch/azimut3/config/local_costmap_params_3d.yaml

@@ -1,5 +1,5 @@
 local_costmap:
-  global_frame: map
+  global_frame: odom
   robot_base_frame: base_footprint
   update_frequency: 2.0
   publish_frequency: 2.0