From 6b75cf2380aa650961ed0dc447fab78b9f62245c Mon Sep 17 00:00:00 2001 From: Motz <83898149+Motsu-san@users.noreply.github.com> Date: Tue, 6 Feb 2024 09:20:47 +0900 Subject: [PATCH 1/5] refactor(ekf_localizer): rework parameters (#847) refactor: Add the classification names to yaml file Signed-off-by: Motsu-san --- .../localization/ekf_localizer.param.yaml | 69 +++++++++++-------- 1 file changed, 39 insertions(+), 30 deletions(-) diff --git a/autoware_launch/config/localization/ekf_localizer.param.yaml b/autoware_launch/config/localization/ekf_localizer.param.yaml index ebdf2828fc..4cc71e0904 100644 --- a/autoware_launch/config/localization/ekf_localizer.param.yaml +++ b/autoware_launch/config/localization/ekf_localizer.param.yaml @@ -1,37 +1,46 @@ /**: ros__parameters: - show_debug_info: false - enable_yaw_bias_estimation: true - predict_frequency: 50.0 - tf_rate: 50.0 - publish_tf: true - extend_state_step: 50 + node: + show_debug_info: false + enable_yaw_bias_estimation: true + predict_frequency: 50.0 + tf_rate: 50.0 + publish_tf: true + extend_state_step: 50 - # for Pose measurement - pose_additional_delay: 0.0 - pose_measure_uncertainty_time: 0.01 - pose_smoothing_steps: 5 - pose_gate_dist: 10000.0 + pose_measurement: + # for Pose measurement + pose_additional_delay: 0.0 + pose_measure_uncertainty_time: 0.01 + pose_smoothing_steps: 5 + pose_gate_dist: 10000.0 - # for twist measurement - twist_additional_delay: 0.0 - twist_smoothing_steps: 2 - twist_gate_dist: 10000.0 + twist_measurement: + # for twist measurement + twist_additional_delay: 0.0 + twist_smoothing_steps: 2 + twist_gate_dist: 10000.0 - # for process model - proc_stddev_yaw_c: 0.005 - proc_stddev_vx_c: 10.0 - proc_stddev_wz_c: 5.0 + process_noise: + # for process model + proc_stddev_yaw_c: 0.005 + proc_stddev_vx_c: 10.0 + proc_stddev_wz_c: 5.0 - #Simple1DFilter parameters - z_filter_proc_dev: 1.0 - roll_filter_proc_dev: 0.01 - pitch_filter_proc_dev: 0.01 - # for diagnostics - pose_no_update_count_threshold_warn: 50 - pose_no_update_count_threshold_error: 100 - twist_no_update_count_threshold_warn: 50 - twist_no_update_count_threshold_error: 100 + simple_1d_filter_parameters: + #Simple1DFilter parameters + z_filter_proc_dev: 1.0 + roll_filter_proc_dev: 0.01 + pitch_filter_proc_dev: 0.01 - # for velocity measurement limitation (Set 0.0 if you want to ignore) - threshold_observable_velocity_mps: 0.0 # [m/s] + diagnostics: + # for diagnostics + pose_no_update_count_threshold_warn: 50 + pose_no_update_count_threshold_error: 100 + twist_no_update_count_threshold_warn: 50 + twist_no_update_count_threshold_error: 100 + + misc: + # for velocity measurement limitation (Set 0.0 if you want to ignore) + threshold_observable_velocity_mps: 0.0 # [m/s] + pose_frame_id: "map" From 2eeb90e28f43830bd427570af73773cf20c2c14a Mon Sep 17 00:00:00 2001 From: kminoda <44218668+kminoda@users.noreply.github.com> Date: Tue, 6 Feb 2024 11:06:25 +0900 Subject: [PATCH 2/5] chore(lidar_centerpoint): rework parameters (#822) * chore(lidar_centerpoint): use config Signed-off-by: kminoda * fix: remove build_only param Signed-off-by: kminoda --------- Signed-off-by: kminoda Co-authored-by: Kenzo Lobos Tsunekawa --- .../detection/lidar_model/centerpoint.param.yaml | 11 +++++++++++ .../lidar_model/centerpoint_tiny.param.yaml | 12 ++++++++++++ 2 files changed, 23 insertions(+) diff --git a/autoware_launch/config/perception/object_recognition/detection/lidar_model/centerpoint.param.yaml b/autoware_launch/config/perception/object_recognition/detection/lidar_model/centerpoint.param.yaml index 0b29a87965..a9c3174846 100644 --- a/autoware_launch/config/perception/object_recognition/detection/lidar_model/centerpoint.param.yaml +++ b/autoware_launch/config/perception/object_recognition/detection/lidar_model/centerpoint.param.yaml @@ -13,3 +13,14 @@ iou_nms_search_distance_2d: 10.0 iou_nms_threshold: 0.1 yaw_norm_thresholds: [0.3, 0.3, 0.3, 0.3, 0.0] + score_threshold: 0.35 + has_twist: false + trt_precision: fp16 + densification_num_past_frames: 1 + densification_world_frame_id: map + + # weight files + encoder_onnx_path: "$(var model_path)/pts_voxel_encoder_$(var model_name).onnx" + encoder_engine_path: "$(var model_path)/pts_voxel_encoder_$(var model_name).engine" + head_onnx_path: "$(var model_path)/pts_backbone_neck_head_$(var model_name).onnx" + head_engine_path: "$(var model_path)/pts_backbone_neck_head_$(var model_name).engine" diff --git a/autoware_launch/config/perception/object_recognition/detection/lidar_model/centerpoint_tiny.param.yaml b/autoware_launch/config/perception/object_recognition/detection/lidar_model/centerpoint_tiny.param.yaml index 8252fde827..5eb560dd7b 100644 --- a/autoware_launch/config/perception/object_recognition/detection/lidar_model/centerpoint_tiny.param.yaml +++ b/autoware_launch/config/perception/object_recognition/detection/lidar_model/centerpoint_tiny.param.yaml @@ -13,3 +13,15 @@ iou_nms_search_distance_2d: 10.0 iou_nms_threshold: 0.1 yaw_norm_thresholds: [0.3, 0.3, 0.3, 0.3, 0.0] + score_threshold: 0.35 + build_only: false # shutdown node after TensorRT engine file is built + has_twist: false + trt_precision: fp16 + densification_num_past_frames: 1 + densification_world_frame_id: map + + # weight files + encoder_onnx_path: "$(var model_path)/pts_voxel_encoder_$(var model_name).onnx" + encoder_engine_path: "$(var model_path)/pts_voxel_encoder_$(var model_name).engine" + head_onnx_path: "$(var model_path)/pts_backbone_neck_head_$(var model_name).onnx" + head_engine_path: "$(var model_path)/pts_backbone_neck_head_$(var model_name).engine" From f487e03916fcbddbedf7776ee322a65bcf2ed753 Mon Sep 17 00:00:00 2001 From: kminoda <44218668+kminoda@users.noreply.github.com> Date: Tue, 6 Feb 2024 11:22:05 +0900 Subject: [PATCH 3/5] fix(pointpainting): update parameter (#850) Signed-off-by: kminoda --- .../detection/lidar_model/pointpainting.param.yaml | 1 - 1 file changed, 1 deletion(-) diff --git a/autoware_launch/config/perception/object_recognition/detection/lidar_model/pointpainting.param.yaml b/autoware_launch/config/perception/object_recognition/detection/lidar_model/pointpainting.param.yaml index 8fb88da291..8ccd469786 100755 --- a/autoware_launch/config/perception/object_recognition/detection/lidar_model/pointpainting.param.yaml +++ b/autoware_launch/config/perception/object_recognition/detection/lidar_model/pointpainting.param.yaml @@ -1,7 +1,6 @@ /**: ros__parameters: trt_precision: fp16 - build_only: false encoder_onnx_path: "$(var model_path)/pts_voxel_encoder_$(var model_name).onnx" encoder_engine_path: "$(var model_path)/pts_voxel_encoder_$(var model_name).engine" head_onnx_path: "$(var model_path)/pts_backbone_neck_head_$(var model_name).onnx" From 43570938556f633447cb37149ba22019bbd40ede Mon Sep 17 00:00:00 2001 From: Yamato Ando Date: Tue, 6 Feb 2024 13:04:09 +0900 Subject: [PATCH 4/5] refactor(map_tf_generator): rework parameters (#835) Signed-off-by: Yamato Ando --- autoware_launch/config/map/map_tf_generator.param.yaml | 4 ++++ .../launch/components/tier4_map_component.launch.xml | 1 + 2 files changed, 5 insertions(+) create mode 100644 autoware_launch/config/map/map_tf_generator.param.yaml diff --git a/autoware_launch/config/map/map_tf_generator.param.yaml b/autoware_launch/config/map/map_tf_generator.param.yaml new file mode 100644 index 0000000000..90790808ac --- /dev/null +++ b/autoware_launch/config/map/map_tf_generator.param.yaml @@ -0,0 +1,4 @@ +/**: + ros__parameters: + map_frame: map + viewer_frame: viewer diff --git a/autoware_launch/launch/components/tier4_map_component.launch.xml b/autoware_launch/launch/components/tier4_map_component.launch.xml index 455b848c63..ba5611b6c0 100644 --- a/autoware_launch/launch/components/tier4_map_component.launch.xml +++ b/autoware_launch/launch/components/tier4_map_component.launch.xml @@ -8,6 +8,7 @@ + From 4e94d652916525fccc1a9d505b5db2594767d9f5 Mon Sep 17 00:00:00 2001 From: danielsanchezaran Date: Tue, 6 Feb 2024 13:40:08 +0900 Subject: [PATCH 5/5] feat(behavior_path_sampling_planner): add sampling based planner to behavior path planner (#810) * Add sampling based planner params Signed-off-by: Daniel Sanchez * update keep_last param Signed-off-by: Daniel Sanchez * change priority of sampling based planner Signed-off-by: Daniel Sanchez * Set parameters for frenet planner Signed-off-by: Daniel Sanchez * changes for testing Signed-off-by: Daniel Sanchez * change curvature weight for testing Signed-off-by: Daniel Sanchez * tuning params Signed-off-by: Daniel Sanchez * tuning Signed-off-by: Daniel Sanchez * for integ w/ other modules Signed-off-by: Daniel Sanchez * add support for soft constraints weight reconfig Signed-off-by: Daniel Sanchez * rebase Signed-off-by: Daniel Sanchez * temp Signed-off-by: Daniel Sanchez * update default params Signed-off-by: Daniel Sanchez * Tune params Signed-off-by: Daniel Sanchez * Set defaults back to normal Signed-off-by: Daniel Sanchez * fix name of ablc Signed-off-by: Daniel Sanchez * formatting fix Signed-off-by: Daniel Sanchez * set verbose to false Signed-off-by: Daniel Sanchez --------- Signed-off-by: Daniel Sanchez Signed-off-by: Daniel Sanchez --- .../planning/preset/default_preset.yaml | 3 ++ .../sampling_planner.param.yaml | 40 +++++++++++++++++++ .../scene_module_manager.param.yaml | 9 +++++ .../tier4_planning_component.launch.xml | 1 + 4 files changed, 53 insertions(+) create mode 100644 autoware_launch/config/planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/sampling_planner/sampling_planner.param.yaml diff --git a/autoware_launch/config/planning/preset/default_preset.yaml b/autoware_launch/config/planning/preset/default_preset.yaml index 3512d722ec..69328a9b79 100644 --- a/autoware_launch/config/planning/preset/default_preset.yaml +++ b/autoware_launch/config/planning/preset/default_preset.yaml @@ -9,6 +9,9 @@ launch: - arg: name: launch_dynamic_avoidance_module default: "false" + - arg: + name: launch_sampling_planner_module + default: "false" # Warning, experimental module, use only in simulations - arg: name: launch_lane_change_right_module default: "true" diff --git a/autoware_launch/config/planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/sampling_planner/sampling_planner.param.yaml b/autoware_launch/config/planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/sampling_planner/sampling_planner.param.yaml new file mode 100644 index 0000000000..9a6b30c219 --- /dev/null +++ b/autoware_launch/config/planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/sampling_planner/sampling_planner.param.yaml @@ -0,0 +1,40 @@ +/**: + ros__parameters: + common: + output_delta_arc_length: 0.5 # [m] delta arc length for output trajectory + + debug: + enable_calculation_time_info: false # flag to print calculation times + id: 0 # id of the candidate paths for which to print/show details (e.g., footprint in rviz) + + preprocessing: + force_zero_initial_deviation: True # if true, initial planning starts from the reference path + force_zero_initial_heading: True # if true, initial planning starts with a heading aligned with the reference path + smooth_reference_trajectory: False # if true, the reference trajectory is smoothed before being used for planning + constraints: + hard: + max_curvature: 3.0 # [m⁻¹] maximum curvature of a sampled path + min_curvature: -3.0 # [m⁻¹] minimum curvature of a sampled path + soft: + lateral_deviation_weight: 1.0 # cost weight for lateral deviation between the end of a sampled path and the reference path + length_weight: 1.0 # cost weight for the length of a sampled path + curvature_weight: 2000.0 # cost weight for the curvature of a sampled path + weights: [0.5,1.0,20.0] + sampling: + enable_frenet: True + enable_bezier: False + resolution: 0.5 # [m] target distance between sampled path points + previous_path_reuse_points_nb: 2 # number of points reused from the previously generated path (0:no reuse, 1:replan from end of prev path, 2: end and mid of prev path, etc) + target_lengths: [20.0, 40.0] # [m] target lengths of the sampled paths + nb_target_lateral_positions: 0 # number of lateral positions to use for sampling (in addition to 0.0 and the current lateral deviation) + target_lateral_positions: [-4.5,-2.5, 0.0, 2.5,4.5] # manual values that are only used if nb_target_lateral_positions = 0 + frenet: # target values for the sampled "lateral deviation over longitudinal position" polynomial + target_lateral_velocities: [-0.5, 0.0, 0.5] + target_lateral_accelerations: [0.0] + # bezier: + # nb_k: 3 # number of sampled curvature values + # mk_min: 0.0 # minimum curvature value + # mk_max: 10.0 # maximum curvature value + # nb_t: 5 # number of sampled acceleration values + # mt_min: 0.3 # minimum acceleration value + # mt_max: 1.7 # maximum acceleration value diff --git a/autoware_launch/config/planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/scene_module_manager.param.yaml b/autoware_launch/config/planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/scene_module_manager.param.yaml index 9853e220bc..8d4fe057b4 100644 --- a/autoware_launch/config/planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/scene_module_manager.param.yaml +++ b/autoware_launch/config/planning/scenario_planning/lane_driving/behavior_planning/behavior_path_planner/scene_module_manager.param.yaml @@ -82,3 +82,12 @@ keep_last: true priority: 7 max_module_size: 1 + + sampling_planner: + enable_module: true + enable_rtc: false + enable_simultaneous_execution_as_approved_module: false + enable_simultaneous_execution_as_candidate_module: false + keep_last: false + priority: 16 + max_module_size: 1 diff --git a/autoware_launch/launch/components/tier4_planning_component.launch.xml b/autoware_launch/launch/components/tier4_planning_component.launch.xml index 4e65c30c02..cbc2349a6e 100644 --- a/autoware_launch/launch/components/tier4_planning_component.launch.xml +++ b/autoware_launch/launch/components/tier4_planning_component.launch.xml @@ -27,6 +27,7 @@ +