Merge pull request autowarefoundation#352 from tier4/sync-awf-latest

chore: sync awf-latest
TomohitoAndo · Jul 7, 2022 · 6d5db69 · 6d5db69
2 parents 70f9cf6 + 11b30f1
commit 6d5db69
Show file tree

Hide file tree

Showing 36 changed files with 678 additions and 233 deletions.
diff --git a/.github/workflows/build-and-test-differential.yaml b/.github/workflows/build-and-test-differential.yaml
@@ -22,7 +22,7 @@ jobs:
             build-depends-repos: build_depends.repos
     steps:
       - name: Cancel previous runs
-        uses: styfle/cancel-workflow-action@0.9.1
+        uses: styfle/cancel-workflow-action@0.10.0
 
       - name: Check out repository
         uses: actions/checkout@v3

diff --git a/.pre-commit-config.yaml b/.pre-commit-config.yaml
@@ -4,7 +4,7 @@ ci:
 
 repos:
   - repo: https://github.com/pre-commit/pre-commit-hooks
-    rev: v4.2.0
+    rev: v4.3.0
     hooks:
       - id: check-json
       - id: check-merge-conflict
@@ -24,7 +24,7 @@ repos:
         args: [-c, .markdownlint.yaml, --fix]
 
   - repo: https://github.com/pre-commit/mirrors-prettier
-    rev: v2.6.2
+    rev: v2.7.1
     hooks:
       - id: prettier
 
@@ -46,7 +46,7 @@ repos:
       - id: shellcheck
 
   - repo: https://github.com/scop/pre-commit-shfmt
-    rev: v3.5.0-1
+    rev: v3.5.1-1
     hooks:
       - id: shfmt
         args: [-w, -s, -i=4]
@@ -57,7 +57,7 @@ repos:
       - id: isort
 
   - repo: https://github.com/psf/black
-    rev: 22.3.0
+    rev: 22.6.0
     hooks:
       - id: black
         args: [--line-length=100]

diff --git a/README.md b/README.md
@@ -1,6 +1,6 @@
 # autoware_launcher
 
-## Getting Started
+## Getting started
 
 ### Using real vehicle
 
@@ -14,7 +14,7 @@ ros2 launch autoware_launch autoware.launch.xml map_path:=/path/to/map_folder ve
 ros2 launch autoware_launch planning_simulator.launch.xml map_path:=/path/to/map_folder vehicle_model:=[vehicle_name] sensor_model:=[sensor_name]
 ```
 
-## Directory Structure
+## Directory structure
 
 - [autoware_launch](./autoware_launch)
 - [control_launch](./control_launch)

diff --git a/autoware_api_launch/launch/include/external_api_adaptor.launch.py b/autoware_api_launch/launch/include/external_api_adaptor.launch.py
@@ -29,6 +29,7 @@ def _create_api_node(node_name, class_name, **kwargs):
 
 def generate_launch_description():
     components = [
+        _create_api_node("calibration_status", "CalibrationStatus"),
         _create_api_node("cpu_usage", "CpuUsage"),
         _create_api_node("diagnostics", "Diagnostics"),
         _create_api_node("door", "Door"),

diff --git a/autoware_launch/launch/autoware.launch.xml b/autoware_launch/launch/autoware.launch.xml
@@ -7,6 +7,7 @@
   <!-- Optional parameters -->
   <arg name="rviz" default="true" description="launch rviz"/>
   <arg name="use_pointcloud_container" default="true" description="launch pointcloud container"/>
+  <arg name="perception_mode" default="camera_lidar_fusion" description="select perception mode. camera_lidar_radar_fusion, camera_lidar_fusion, lidar_radar_fusion, lidar, radar"/>
   <arg name="pointcloud_container_name" default="pointcloud_container"/>
   <arg name="lanelet2_map_file" default="lanelet2_map.osm" description="lanelet2 map file name"/>
   <arg name="pointcloud_map_file" default="pointcloud_map.pcd" description="pointcloud map file name"/>
@@ -69,8 +70,7 @@
   <!-- Perception -->
   <group>
     <include file="$(find-pkg-share perception_launch)/launch/perception.launch.xml">
-      <!-- options for mode: camera_lidar_fusion, lidar, camera -->
-      <arg name="mode" value="camera_lidar_fusion" />
+      <arg name="mode" value="$(var perception_mode)" />
       <arg name="use_pointcloud_container" value="$(var use_pointcloud_container)" />
       <arg name="pointcloud_container_name" value="$(var pointcloud_container_name)"/>
     </include>

diff --git a/autoware_launch/launch/logging_simulator.launch.xml b/autoware_launch/launch/logging_simulator.launch.xml
@@ -19,6 +19,7 @@
   <arg name="rviz" default="true" description="launch rviz" />
   <arg name="lanelet2_map_file" default="lanelet2_map.osm" description="lanelet2 map file name"/>
   <arg name="pointcloud_map_file" default="pointcloud_map.pcd" description="pointcloud map file name"/>
+  <arg name="perception_mode" default="camera_lidar_fusion" description="select perception mode. camera_lidar_radar_fusion, camera_lidar_fusion, lidar_radar_fusion, lidar, radar"/>
   <arg name="use_pointcloud_container" default="true" description="launch pointcloud container"/>
   <arg name="pointcloud_container_name" default="pointcloud_container"/>
   <arg name="launch_vehicle_interface" default="false"/>
@@ -85,8 +86,7 @@
   <!-- Perception -->
   <group>
     <include file="$(find-pkg-share perception_launch)/launch/perception.launch.xml" if="$(var perception)">
-      <!-- options for mode: camera_lidar_fusion, lidar, camera -->
-      <arg name="mode" value="camera_lidar_fusion" />
+      <arg name="mode" value="$(var perception_mode)" />
       <arg name="use_pointcloud_container" value="$(var use_pointcloud_container)" />
       <arg name="pointcloud_container_name" value="$(var pointcloud_container_name)"/>
     </include>

diff --git a/autoware_launch/rviz/autoware.rviz b/autoware_launch/rviz/autoware.rviz
@@ -727,6 +727,7 @@ Visualization Manager:
               Display Twist: true
               Display UUID: true
               Display Velocity: true
+              Line Width: 0.03
               Enabled: true
               MOTORCYCLE:
                 Alpha: 0.999
@@ -774,6 +775,7 @@ Visualization Manager:
               Display Twist: true
               Display UUID: true
               Display Velocity: true
+              Line Width: 0.03
               Enabled: true
               MOTORCYCLE:
                 Alpha: 0.999
@@ -821,6 +823,7 @@ Visualization Manager:
               Display Twist: false
               Display UUID: true
               Display Velocity: true
+              Line Width: 0.03
               Enabled: true
               MOTORCYCLE:
                 Alpha: 0.999
@@ -846,6 +849,18 @@ Visualization Manager:
                 Alpha: 0.999
                 Color: 255; 255; 255
               Value: true
+            - Class: rviz_default_plugins/MarkerArray
+              Enabled: false
+              Name: Maneuver
+              Namespaces:
+                maneuver: true
+              Topic:
+                Depth: 5
+                Durability Policy: Volatile
+                History Policy: Keep Last
+                Reliability Policy: Reliable
+                Value: /perception/object_recognition/prediction/maneuver
+              Value: true
           Enabled: true
           Name: Prediction
         - Class: rviz_common/Group
@@ -1021,6 +1036,18 @@ Visualization Manager:
                             Reliability Policy: Reliable
                             Value: /planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/virtual_wall/crosswalk
                           Value: true
+                        - Class: rviz_default_plugins/MarkerArray
+                          Enabled: true
+                          Name: VirtualWall (Walkway)
+                          Namespaces:
+                            {}
+                          Topic:
+                            Depth: 5
+                            Durability Policy: Volatile
+                            History Policy: Keep Last
+                            Reliability Policy: Reliable
+                            Value: /planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/virtual_wall/walkway
+                          Value: true
                         - Class: rviz_default_plugins/MarkerArray
                           Enabled: true
                           Name: VirtualWall (DetectionArea)
@@ -1158,6 +1185,18 @@ Visualization Manager:
                             Reliability Policy: Reliable
                             Value: /planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/debug/crosswalk
                           Value: false
+                        - Class: rviz_default_plugins/MarkerArray
+                          Enabled: false
+                          Name: Walkway
+                          Namespaces:
+                            {}
+                          Topic:
+                            Depth: 5
+                            Durability Policy: Volatile
+                            History Policy: Keep Last
+                            Reliability Policy: Reliable
+                            Value: /planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/debug/walkway
+                          Value: false
                         - Class: rviz_default_plugins/MarkerArray
                           Enabled: false
                           Name: Intersection

diff --git a/control_launch/config/trajectory_follower/latlon_muxer.param.yaml b/control_launch/config/trajectory_follower/latlon_muxer.param.yaml
diff --git a/control_launch/config/trajectory_follower/longitudinal_controller.param.yaml b/control_launch/config/trajectory_follower/longitudinal_controller.param.yaml
@@ -1,11 +1,12 @@
 /**:
   ros__parameters:
-    longitudinal_ctrl_period: 0.03
     delay_compensation_time: 0.17
 
     enable_smooth_stop: true
     enable_overshoot_emergency: true
+    enable_large_tracking_error_emergency: true
     enable_slope_compensation: true
+    enable_keep_stopped_until_steer_convergence: false
 
     # state transition
     drive_state_stop_dist: 0.5

diff --git a/control_launch/config/trajectory_follower/mpc_follower.param.yaml b/control_launch/config/trajectory_follower/mpc_follower.param.yaml
@@ -1,8 +1,6 @@
 /**:
   ros__parameters:
-
     # -- system --
-    ctrl_period: 0.03               # control period [s]
     traj_resample_dist: 0.1         # path resampling interval [m]
     use_steer_prediction: false     # flag for using steer prediction (do not use steer measurement)
     admissible_position_error: 5.0  # stop mpc calculation when error is larger than the following value
@@ -57,6 +55,10 @@
     # stop state: steering command is kept in the previous value in the stop state.
     stop_state_entry_ego_speed: 0.001
     stop_state_entry_target_speed: 0.001
+    converged_steer_rad: 0.1
+    keep_steer_control_until_converged: false
+    new_traj_duration_time: 1.0
+    new_traj_end_dist: 0.3
 
     # vehicle parameters
     vehicle:

diff --git a/control_launch/config/vehicle_cmd_gate/vehicle_cmd_gate.param.yaml b/control_launch/config/vehicle_cmd_gate/vehicle_cmd_gate.param.yaml
@@ -6,8 +6,15 @@
     stop_hold_acceleration: -1.5
     emergency_acceleration: -2.4
     stopped_state_entry_duration_time: 0.1
-    vel_lim: 25.0
-    lon_acc_lim: 5.0
-    lon_jerk_lim: 5.0
-    lat_acc_lim: 5.0
-    lat_jerk_lim: 5.0
+    nominal:
+      vel_lim: 25.0
+      lon_acc_lim: 5.0
+      lon_jerk_lim: 5.0
+      lat_acc_lim: 5.0
+      lat_jerk_lim: 5.0
+    on_transition:
+      vel_lim: 50.0
+      lon_acc_lim: 1.0
+      lon_jerk_lim: 0.5
+      lat_acc_lim: 1.2
+      lat_jerk_lim: 0.75