Merge remote-tracking branch 'origin' into feat/ekf_localizer/ignore_…

…dead_band_of_velocity_sensor

autoware_launch/config/localization/localization_error_monitor.param.yaml

@@ -4,4 +4,4 @@
     error_ellipse_size: 1.0
     warn_ellipse_size: 0.8
     error_ellipse_size_lateral_direction: 0.3
-    warn_ellipse_size_lateral_direction: 0.2
+    warn_ellipse_size_lateral_direction: 0.25

autoware_launch/config/perception/object_recognition/detection/clustering/voxel_grid_based_euclidean_cluster.param.yaml

@@ -7,9 +7,11 @@
     max_cluster_size: 3000
     use_height: false
     input_frame: "base_link"
-    max_x: 70.0
-    min_x: -70.0
-    max_y: 70.0
-    min_y: -70.0
-    max_z: 4.5
-    min_z: -4.5
+
+    # low height crop box filter param
+    max_x: 200.0
+    min_x: -200.0
+    max_y: 200.0
+    min_y: -200.0
+    max_z: 2.0
+    min_z: -10.0

autoware_launch/config/perception/object_recognition/detection/object_filter/radar_lanelet_filter.param.yaml

@@ -0,0 +1,11 @@
+/**:
+  ros__parameters:
+    filter_target_label:
+      UNKNOWN : true
+      CAR : true
+      TRUCK : true
+      BUS : true
+      TRAILER : true
+      MOTORCYCLE : true
+      BICYCLE : true
+      PEDESTRIAN : true

autoware_launch/config/perception/object_recognition/detection/pointcloud_filter/pointcloud_map_filter.param.yaml

@@ -1,7 +1,5 @@
 /**:
   ros__parameters:
-    # use downsample filter before compare map
-    use_down_sample_filter: False
 
     # voxel size for downsample filter
     down_sample_voxel_size: 0.1

autoware_launch/config/planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/goal_planner/goal_planner.param.yaml

@@ -21,8 +21,9 @@
 
       # occupancy grid map
       occupancy_grid:
-        use_occupancy_grid: true
-        use_occupancy_grid_for_longitudinal_margin: false
+        use_occupancy_grid_for_goal_search: true
+        use_occupancy_grid_for_goal_longitudinal_margin: false
+        use_occupancy_grid_for_path_collision_check: false
         occupancy_grid_collision_check_margin: 0.0
         theta_size: 360
         obstacle_threshold: 60
@@ -111,20 +112,21 @@
       path_safety_check:
         # EgoPredictedPath
         ego_predicted_path:
+          min_velocity: 0.0
           acceleration: 1.0
-          time_horizon: 10.0
+          max_velocity: 1.0
+          time_horizon_for_front_object: 10.0
+          time_horizon_for_rear_object: 10.0
           time_resolution: 0.5
-          min_slow_speed: 0.0
           delay_until_departure: 1.0
-          target_velocity: 1.0
         # For target object filtering
         target_filtering:
           safety_check_time_horizon: 5.0
           safety_check_time_resolution: 1.0
           # detection range
           object_check_forward_distance: 10.0
           object_check_backward_distance: 100.0
-          ignore_object_velocity_threshold: 0.0
+          ignore_object_velocity_threshold: 1.0
           # ObjectTypesToCheck
           object_types_to_check:
             check_car: true
@@ -151,7 +153,7 @@
         # For safety check
         safety_check_params:
           # safety check configuration
-          enable_safety_check: true
+          enable_safety_check: false # Don't set to true if auto_mode is enabled
           # collision check parameters
           check_all_predicted_path: true
           publish_debug_marker: false
@@ -161,6 +163,8 @@
             lateral_distance_max_threshold: 1.0
             longitudinal_distance_min_threshold: 1.0
             longitudinal_velocity_delta_time: 1.0
+          # hysteresis factor to expand/shrink polygon with the value
+          hysteresis_factor_expand_rate: 1.0
           # temporary
           backward_path_length: 30.0
           forward_path_length: 100.0

autoware_launch/config/planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/start_planner/start_planner.param.yaml

@@ -79,20 +79,21 @@
       path_safety_check:
         # EgoPredictedPath
         ego_predicted_path:
+          min_velocity: 0.0
           acceleration: 1.0
-          time_horizon: 10.0
+          max_velocity: 1.0
+          time_horizon_for_front_object: 10.0
+          time_horizon_for_rear_object: 10.0
           time_resolution: 0.5
-          min_slow_speed: 0.0
           delay_until_departure: 1.0
-          target_velocity: 1.0
         # For target object filtering
         target_filtering:
           safety_check_time_horizon: 5.0
           safety_check_time_resolution: 1.0
           # detection range
           object_check_forward_distance: 10.0
           object_check_backward_distance: 100.0
-          ignore_object_velocity_threshold: 0.0
+          ignore_object_velocity_threshold: 1.0
           # ObjectTypesToCheck
           object_types_to_check:
             check_car: true
@@ -119,7 +120,7 @@
         # For safety check
         safety_check_params:
           # safety check configuration
-          enable_safety_check: true
+          enable_safety_check: false # Don't set to true if auto_mode is enabled
           # collision check parameters
           check_all_predicted_path: true
           publish_debug_marker: false
@@ -129,6 +130,8 @@
             lateral_distance_max_threshold: 1.0
             longitudinal_distance_min_threshold: 1.0
             longitudinal_velocity_delta_time: 1.0
+          # hysteresis factor to expand/shrink polygon
+          hysteresis_factor_expand_rate: 1.0
           # temporary
           backward_path_length: 30.0
           forward_path_length: 100.0

autoware_launch/launch/components/tier4_perception_component.launch.xml

@@ -21,16 +21,11 @@
     <arg name="objects_validation_method" value="$(var detected_objects_validation_method)"/>
 
     <!-- object recognition -->
-    <arg name="object_recognition_detection_compare_map_param_path" value="$(find-pkg-share autoware_launch)/config/perception/object_recognition/detection/clustering/compare_map.param.yaml"/>
     <arg
       name="object_recognition_detection_euclidean_cluster_param_path"
       value="$(find-pkg-share autoware_launch)/config/perception/object_recognition/detection/clustering/euclidean_cluster.param.yaml"
     />
     <arg name="object_recognition_detection_outlier_param_path" value="$(find-pkg-share autoware_launch)/config/perception/object_recognition/detection/clustering/outlier.param.yaml"/>
-    <arg
-      name="object_recognition_detection_voxel_grid_based_euclidean_param_path"
-      value="$(find-pkg-share autoware_launch)/config/perception/object_recognition/detection/clustering/voxel_grid.param.yaml"
-    />
     <arg
       name="object_recognition_detection_voxel_grid_based_euclidean_cluster_param_path"
       value="$(find-pkg-share autoware_launch)/config/perception/object_recognition/detection/clustering/voxel_grid_based_euclidean_cluster.param.yaml"
@@ -63,6 +58,10 @@
       name="object_recognition_detection_object_merger_distance_threshold_list_path"
       value="$(find-pkg-share autoware_launch)/config/perception/object_recognition/detection/object_merger/overlapped_judge.param.yaml"
     />
+    <arg
+      name="object_recognition_detection_radar_lanelet_filtering_range_param"
+      value="$(find-pkg-share autoware_launch)/config/perception/object_recognition/detection/object_filter/radar_lanelet_filter.param.yaml"
+    />
     <arg name="object_recognition_detection_lidar_model_param_path" value="$(find-pkg-share autoware_launch)/config/perception/object_recognition/detection/lidar_model"/>
     <arg
       name="object_recognition_tracking_multi_object_tracker_data_association_matrix_param_path"

autoware_launch/rviz/autoware.rviz

@@ -319,6 +319,22 @@ Visualization Manager:
               Value: true
           Enabled: true
           Name: Vehicle
+        - Class: rviz_plugins/MrmSummaryOverlayDisplay
+          Enabled: false
+          Font Size: 10
+          Left: 512
+          Max Letter Num: 100
+          Name: MRM Summary
+          Text Color: 25; 255; 240
+          Top: 64
+          Topic:
+            Depth: 5
+            Durability Policy: Volatile
+            History Policy: Keep Last
+            Reliability Policy: Reliable
+            Value: /system/emergency/hazard_status
+          Value: false
+          Value height offset: 0
       Enabled: true
       Name: System
     - Class: rviz_common/Group