Merge branch 'main' into feature/parallel_ndt_build

anhnv3991 · Mar 5, 2024 · 0705397 · 0705397
2 parents ca05df7 + c3199b7
commit 0705397
Show file tree

Hide file tree

Showing 91 changed files with 3,264 additions and 403 deletions.
diff --git a/.github/CODEOWNERS b/.github/CODEOWNERS
@@ -1,5 +1,3 @@
-### Copied from .github/CODEOWNERS-manual ###
-
 ### Automatically generated from package.xml ###
 common/autoware_ad_api_specs/** [email protected] [email protected]
 common/autoware_auto_common/** [email protected] [email protected] [email protected] [email protected]
@@ -23,6 +21,7 @@ common/goal_distance_calculator/** [email protected]
 common/grid_map_utils/** [email protected]
 common/interpolation/** [email protected] [email protected]
 common/kalman_filter/** [email protected] [email protected] [email protected]
+common/mission_planner_rviz_plugin/** [email protected]
 common/motion_utils/** [email protected] [email protected] [email protected] [email protected] [email protected] [email protected] [email protected] [email protected]
 common/object_recognition_utils/** [email protected] [email protected] [email protected] [email protected]
 common/osqp_interface/** [email protected] [email protected] [email protected] [email protected]
@@ -32,7 +31,7 @@ common/polar_grid/** [email protected]
 common/qp_interface/** [email protected] [email protected] [email protected] [email protected]
 common/rtc_manager_rviz_plugin/** [email protected] [email protected]
 common/signal_processing/** [email protected] [email protected] [email protected] [email protected] [email protected]
-common/tensorrt_common/** [email protected] [email protected] [email protected]
+common/tensorrt_common/** [email protected] [email protected]
 common/tier4_adapi_rviz_plugin/** [email protected] [email protected] [email protected]
 common/tier4_api_utils/** [email protected]
 common/tier4_automatic_goal_rviz_plugin/** [email protected] [email protected] [email protected] [email protected]
@@ -55,7 +54,7 @@ common/tier4_traffic_light_rviz_plugin/** [email protected]
 common/tier4_vehicle_rviz_plugin/** [email protected]
 common/time_utils/** [email protected] [email protected] [email protected]
 common/traffic_light_recognition_marker_publisher/** [email protected] [email protected] [email protected]
-common/traffic_light_utils/** mingyu.li@tier4.jp [email protected] [email protected]
+common/traffic_light_utils/** kotaro.uetake@tier4.jp [email protected] [email protected]
 common/tvm_utility/** [email protected] [email protected]
 control/autonomous_emergency_braking/** [email protected] [email protected] [email protected]
 control/control_performance_analysis/** [email protected] [email protected] [email protected] [email protected] [email protected] [email protected] [email protected] [email protected]
@@ -76,6 +75,7 @@ control/vehicle_cmd_gate/** [email protected] [email protected]
 evaluator/diagnostic_converter/** [email protected] [email protected] [email protected]
 evaluator/kinematic_evaluator/** [email protected] [email protected] [email protected] [email protected] [email protected] [email protected] [email protected]
 evaluator/localization_evaluator/** [email protected] [email protected]
+evaluator/perception_online_evaluator/** [email protected] [email protected] [email protected] [email protected] [email protected] [email protected]
 evaluator/planning_evaluator/** [email protected] [email protected]
 evaluator/tier4_metrics_rviz_plugin/** [email protected] [email protected] [email protected]
 launch/tier4_autoware_api_launch/** [email protected] [email protected]
@@ -118,9 +118,9 @@ perception/cluster_merger/** [email protected] [email protected] yukihir
 perception/compare_map_segmentation/** [email protected] [email protected] [email protected]
 perception/crosswalk_traffic_light_estimator/** [email protected] [email protected] [email protected]
 perception/detected_object_feature_remover/** [email protected]
-perception/detected_object_validation/** [email protected] [email protected] [email protected]
-perception/detection_by_tracker/** [email protected] [email protected]
-perception/elevation_map_loader/** [email protected] [email protected]
+perception/detected_object_validation/** [email protected] [email protected] [email protected] [email protected]
+perception/detection_by_tracker/** [email protected] [email protected] [email protected]
+perception/elevation_map_loader/** [email protected] [email protected] [email protected]
 perception/euclidean_cluster/** [email protected]
 perception/ground_segmentation/** [email protected] [email protected] [email protected] [email protected]
 perception/image_projection_based_fusion/** [email protected] [email protected] [email protected] [email protected] [email protected] [email protected] [email protected]
@@ -130,26 +130,26 @@ perception/lidar_apollo_segmentation_tvm_nodes/** [email protected] xinyu
 perception/lidar_centerpoint/** [email protected] [email protected]
 perception/lidar_centerpoint_tvm/** [email protected] [email protected]
 perception/map_based_prediction/** [email protected] [email protected] [email protected] [email protected] [email protected] [email protected]
-perception/multi_object_tracker/** [email protected] [email protected]
-perception/object_merger/** [email protected] [email protected]
+perception/multi_object_tracker/** [email protected] [email protected] [email protected]
+perception/object_merger/** [email protected] [email protected] [email protected]
 perception/object_range_splitter/** [email protected]
 perception/object_velocity_splitter/** [email protected] [email protected] [email protected]
 perception/occupancy_grid_map_outlier_filter/** [email protected] [email protected] [email protected]
 perception/probabilistic_occupancy_grid_map/** [email protected] [email protected] [email protected]
 perception/radar_crossing_objects_noise_filter/** [email protected] [email protected] [email protected] [email protected]
 perception/radar_fusion_to_detected_object/** [email protected] [email protected] [email protected] [email protected]
 perception/radar_object_clustering/** [email protected] [email protected] [email protected] [email protected]
-perception/radar_object_tracker/** [email protected] [email protected] [email protected]
+perception/radar_object_tracker/** [email protected] [email protected] [email protected] [email protected]
 perception/radar_tracks_msgs_converter/** [email protected] [email protected] [email protected] [email protected]
 perception/shape_estimation/** [email protected] [email protected]
 perception/simple_object_merger/** [email protected] [email protected] [email protected]
-perception/tensorrt_classifier/** mingyu.li@tier4.jp
-perception/tensorrt_yolox/** [email protected] [email protected] [email protected]
-perception/tracking_object_merger/** [email protected] [email protected]
+perception/tensorrt_classifier/** [email protected] shunsuke.miura@tier4.jp
+perception/tensorrt_yolox/** [email protected] [email protected]
+perception/tracking_object_merger/** [email protected] [email protected] [email protected]
 perception/traffic_light_arbiter/** [email protected] [email protected]
 perception/traffic_light_classifier/** [email protected] [email protected]
-perception/traffic_light_fine_detector/** [email protected] [email protected]
-perception/traffic_light_map_based_detector/** [email protected]
+perception/traffic_light_fine_detector/** [email protected] [email protected] [email protected]
+perception/traffic_light_map_based_detector/** [email protected] [email protected]
 perception/traffic_light_multi_camera_fusion/** [email protected] [email protected]
 perception/traffic_light_occlusion_predictor/** [email protected] [email protected]
 perception/traffic_light_visualization/** [email protected]
@@ -186,7 +186,7 @@ planning/costmap_generator/** [email protected] [email protected]
 planning/external_velocity_limit_selector/** [email protected] [email protected] [email protected] [email protected] [email protected]
 planning/freespace_planner/** [email protected] [email protected] [email protected]
 planning/freespace_planning_algorithms/** [email protected] [email protected] [email protected]
-planning/mission_planner/** [email protected] [email protected] [email protected] [email protected] [email protected]
+planning/mission_planner/** [email protected] [email protected] [email protected] [email protected] [email protected] [email protected]
 planning/motion_velocity_smoother/** [email protected] [email protected] [email protected] [email protected]
 planning/objects_of_interest_marker_interface/** [email protected] [email protected] [email protected]
 planning/obstacle_avoidance_planner/** [email protected] [email protected] [email protected]
@@ -217,7 +217,7 @@ sensing/radar_scan_to_pointcloud2/** [email protected] shunsuke.miura@tier
 sensing/radar_static_pointcloud_filter/** [email protected] [email protected] [email protected] [email protected]
 sensing/radar_threshold_filter/** [email protected] [email protected] [email protected] [email protected]
 sensing/radar_tracks_noise_filter/** [email protected] [email protected] [email protected] [email protected]
-sensing/tier4_pcl_extensions/** [email protected]
+sensing/tier4_pcl_extensions/** [email protected] [email protected] [email protected]
 sensing/vehicle_velocity_converter/** [email protected]
 simulator/dummy_perception_publisher/** [email protected]
 simulator/fault_injection/** [email protected]
@@ -232,10 +232,12 @@ system/default_ad_api_helpers/automatic_pose_initializer/** [email protected]
 system/diagnostic_graph_aggregator/** [email protected]
 system/dummy_diag_publisher/** [email protected] [email protected]
 system/dummy_infrastructure/** [email protected]
-system/duplicated_node_checker/** [email protected] [email protected]
+system/duplicated_node_checker/** [email protected] [email protected] [email protected]
 system/emergency_handler/** [email protected] [email protected] [email protected]
+system/hazard_status_converter/** [email protected]
 system/mrm_comfortable_stop_operator/** [email protected] [email protected]
 system/mrm_emergency_stop_operator/** [email protected] [email protected]
+system/mrm_handler/** [email protected] [email protected] [email protected]
 system/system_error_monitor/** [email protected]
 system/system_monitor/** [email protected] [email protected]
 system/topic_state_monitor/** [email protected]
@@ -245,3 +247,5 @@ vehicle/external_cmd_converter/** [email protected]
 vehicle/raw_vehicle_cmd_converter/** [email protected] [email protected] [email protected]
 vehicle/steer_offset_estimator/** [email protected]
 vehicle/vehicle_info_util/** [email protected] [email protected] [email protected]
+
+### Copied from .github/CODEOWNERS-manual ###
diff --git a/.github/workflows/build-and-test-differential.yaml b/.github/workflows/build-and-test-differential.yaml
@@ -73,38 +73,3 @@ jobs:
 
       - name: Check disk space after build
         run: df -h
-
-  clang-tidy-differential:
-    runs-on: [self-hosted, linux, X64]
-    container: ghcr.io/autowarefoundation/autoware-universe:humble-latest-cuda
-    needs: build-and-test-differential
-    steps:
-      - name: Check out repository
-        uses: actions/checkout@v3
-        with:
-          fetch-depth: 0
-
-      - name: Remove exec_depend
-        uses: autowarefoundation/autoware-github-actions/remove-exec-depend@v1
-
-      - name: Get modified packages
-        id: get-modified-packages
-        uses: autowarefoundation/autoware-github-actions/get-modified-packages@v1
-
-      - name: Get modified files
-        id: get-modified-files
-        uses: tj-actions/changed-files@v35
-        with:
-          files: |
-            **/*.cpp
-            **/*.hpp
-
-      - name: Run clang-tidy
-        if: ${{ steps.get-modified-files.outputs.all_changed_files != '' }}
-        uses: autowarefoundation/autoware-github-actions/clang-tidy@v1
-        with:
-          rosdistro: humble
-          target-packages: ${{ steps.get-modified-packages.outputs.modified-packages }}
-          target-files: ${{ steps.get-modified-files.outputs.all_changed_files }}
-          clang-tidy-config-url: https://raw.githubusercontent.com/autowarefoundation/autoware/main/.clang-tidy
-          build-depends-repos: build_depends.repos
diff --git a/.github/workflows/json-schema-check.yaml b/.github/workflows/json-schema-check.yaml
@@ -2,17 +2,38 @@ name: json-schema-check
 
 on:
   pull_request:
-    paths:
-      - "**/schema/*.schema.json"
-      - "**/config/*.param.yaml"
   workflow_dispatch:
 
 jobs:
+  check-if-relevant-files-changed:
+    runs-on: ubuntu-latest
+    outputs:
+      run-check: ${{ steps.paths_filter.outputs.json_or_yaml }}
+    steps:
+      - uses: actions/checkout@v3
+      - uses: dorny/paths-filter@v3
+        id: paths_filter
+        with:
+          filters: |
+            json_or_yaml:
+              - '**/schema/*.schema.json'
+              - '**/config/*.param.yaml'
+
   json-schema-check:
+    needs: check-if-relevant-files-changed
+    if: needs.check-if-relevant-files-changed.outputs.run-check == 'true'
     runs-on: ubuntu-latest
     steps:
       - name: Check out repository
         uses: actions/checkout@v3
 
       - name: Run json-schema-check
         uses: autowarefoundation/autoware-github-actions/json-schema-check@v1
+
+  no-relevant-changes:
+    needs: check-if-relevant-files-changed
+    if: needs.check-if-relevant-files-changed.outputs.run-check == 'false'
+    runs-on: ubuntu-latest
+    steps:
+      - name: Dummy step
+        run: echo "No relevant changes, passing check"
diff --git a/README.md b/README.md
@@ -1,7 +1,16 @@
-# autoware.universe
+# Autoware Universe
 
-For Autoware's general documentation, see [Autoware Documentation](https://autowarefoundation.github.io/autoware-documentation/).
+## Welcome to Autoware Universe
 
-For detailed documents of Autoware Universe components, see [Autoware Universe Documentation](https://autowarefoundation.github.io/autoware.universe/).
+Autoware Universe serves as a foundational pillar within the Autoware ecosystem, playing a critical role in enhancing the core functionalities of autonomous driving technologies.
+This repository is a pivotal element of the Autoware Core/Universe concept, managing a wide array of packages that significantly extend the capabilities of autonomous vehicles.
 
----
+![autoware_universe_front](docs/assets/images/autoware_universe_front.png)
+
+## Getting Started
+
+To dive into the vast world of Autoware and understand how Autoware Universe fits into the bigger picture, we recommend starting with the [Autoware Documentation](https://autowarefoundation.github.io/autoware-documentation/). This resource provides a thorough overview of the Autoware ecosystem, guiding you through its components, functionalities, and how to get started with development.
+
+### Explore Autoware Universe documentation
+
+For those looking to explore the specifics of Autoware Universe components, the [Autoware Universe Documentation](https://autowarefoundation.github.io/autoware.universe/), deployed with MKDocs, offers detailed insights.
diff --git a/common/autoware_overlay_rviz_plugin/autoware_overlay_rviz_plugin/package.xml b/common/autoware_overlay_rviz_plugin/autoware_overlay_rviz_plugin/package.xml
@@ -23,7 +23,7 @@
   <test_depend>ament_lint_auto</test_depend>
   <test_depend>autoware_lint_common</test_depend>
 
-  <buildtool_depend>ament_cmake</buildtool_depend>
+  <buildtool_depend>ament_cmake_auto</buildtool_depend>
 
   <export>
     <build_type>ament_cmake</build_type>

diff --git a/common/tensorrt_common/package.xml b/common/tensorrt_common/package.xml
@@ -6,7 +6,6 @@
 
   <author email="[email protected]">Taichi Higashide</author>
   <author email="[email protected]">Daisuke Nishimatsu</author>
-  <maintainer email="[email protected]">Daisuke Nishimatsu</maintainer>
   <maintainer email="[email protected]">Dan Umeda</maintainer>
   <maintainer email="[email protected]">Manato Hirabayashi</maintainer>
 

diff --git a/common/tier4_control_rviz_plugin/src/tools/manual_controller.cpp b/common/tier4_control_rviz_plugin/src/tools/manual_controller.cpp
@@ -30,14 +30,6 @@ using std::placeholders::_1;
 namespace rviz_plugins
 {
 
-double lowpassFilter(
-  const double current_value, const double prev_value, double cutoff, const double dt)
-{
-  const double tau = 1.0 / (2.0 * M_PI * cutoff);
-  const double a = tau / (dt + tau);
-  return prev_value * a + (1.0 - a) * current_value;
-}
-
 ManualController::ManualController(QWidget * parent) : rviz_common::Panel(parent)
 {
   auto * state_layout = new QHBoxLayout;
@@ -115,25 +107,23 @@ void ManualController::update()
     ackermann.stamp = raw_node_->get_clock()->now();
     ackermann.lateral.steering_tire_angle = steering_angle_;
     ackermann.longitudinal.speed = cruise_velocity_;
-    if (current_acceleration_) {
-      /**
-       * @brief Calculate desired acceleration by simple BackSteppingControl
-       *  V = 0.5*(v-v_des)^2 >= 0
-       *  D[V] = (D[v] - a_des)*(v-v_des) <=0
-       *  a_des = k_const *(v - v_des) + a (k < 0 )
-       */
-      const double k = -0.5;
-      const double v = current_velocity_;
-      const double v_des = cruise_velocity_;
-      const double a = *current_acceleration_;
-      const double a_des = k * (v - v_des) + a;
-      ackermann.longitudinal.acceleration = std::clamp(a_des, -1.0, 1.0);
-    }
+    /**
+     * @brief Calculate desired acceleration by simple BackSteppingControl
+     *  V = 0.5*(v-v_des)^2 >= 0
+     *  D[V] = (D[v] - a_des)*(v-v_des) <=0
+     *  a_des = k_const *(v - v_des) + a (k < 0 )
+     */
+    const double k = -0.5;
+    const double v = current_velocity_;
+    const double v_des = cruise_velocity_;
+    const double a = current_acceleration_;
+    const double a_des = k * (v - v_des) + a;
+    ackermann.longitudinal.acceleration = std::clamp(a_des, -1.0, 1.0);
   }
   GearCommand gear_cmd;
   {
     const double eps = 0.001;
-    if (ackermann.longitudinal.speed > eps) {
+    if (ackermann.longitudinal.speed > eps && current_velocity_ > -eps) {
       gear_cmd.command = GearCommand::DRIVE;
     } else if (ackermann.longitudinal.speed < -eps && current_velocity_ < eps) {
       gear_cmd.command = GearCommand::REVERSE;
@@ -220,19 +210,11 @@ void ManualController::onEngageStatus(const Engage::ConstSharedPtr msg)
 void ManualController::onVelocity(const VelocityReport::ConstSharedPtr msg)
 {
   current_velocity_ = msg->longitudinal_velocity;
-  if (previous_velocity_) {
-    const double cutoff = 10.0;
-    const double dt = 1.0 / 10.0;
-    const double acc = (current_velocity_ - *previous_velocity_) / dt;
-    if (!current_acceleration_) {
-      current_acceleration_ = std::make_unique<double>(acc);
-    } else {
-      current_acceleration_ =
-        std::make_unique<double>(lowpassFilter(acc, *current_acceleration_, cutoff, dt));
-    }
-  }
-  previous_velocity_ = std::make_unique<double>(msg->longitudinal_velocity);
-  prev_stamp_ = rclcpp::Time(msg->header.stamp);
+}
+
+void ManualController::onAcceleration(const AccelWithCovarianceStamped::ConstSharedPtr msg)
+{
+  current_acceleration_ = msg->accel.accel.linear.x;
 }
 
 void ManualController::onGear(const GearReport::ConstSharedPtr msg)