Skip to content

Commit b8c0c6d

Browse files
Merge pull request #289 from tier4/sync-awf-upstream
chore: sync awf/autoware_launch
2 parents 1542e23 + f5a2875 commit b8c0c6d

29 files changed

+198
-69
lines changed

autoware_launch/config/control/trajectory_follower/lateral/mpc.param.yaml

+2
Original file line numberDiff line numberDiff line change
@@ -74,3 +74,5 @@
7474
update_steer_threshold: 0.035
7575
average_num: 1000
7676
steering_offset_limit: 0.02
77+
78+
debug_publish_predicted_trajectory: false # publish debug predicted trajectory in Frenet coordinate

autoware_launch/config/localization/ekf_localizer.param.yaml

+5
Original file line numberDiff line numberDiff line change
@@ -4,6 +4,7 @@
44
enable_yaw_bias_estimation: true
55
predict_frequency: 50.0
66
tf_rate: 50.0
7+
publish_tf: true
78
extend_state_step: 50
89

910
# for Pose measurement
@@ -22,6 +23,10 @@
2223
proc_stddev_vx_c: 10.0
2324
proc_stddev_wz_c: 5.0
2425

26+
#Simple1DFilter parameters
27+
z_filter_proc_dev: 1.0
28+
roll_filter_proc_dev: 0.01
29+
pitch_filter_proc_dev: 0.01
2530
# for diagnostics
2631
pose_no_update_count_threshold_warn: 50
2732
pose_no_update_count_threshold_error: 100
Original file line numberDiff line numberDiff line change
@@ -1,11 +1,10 @@
11
/**:
22
ros__parameters:
3-
tracker_ignore_label:
4-
UNKNOWN : true
5-
CAR : false
6-
TRUCK : false
7-
BUS : false
8-
TRAILER : false
9-
MOTORCYCLE : false
10-
BICYCLE : false
11-
PEDESTRIAN : false
3+
tracker_ignore_label.UNKNOWN : true
4+
tracker_ignore_label.CAR : false
5+
tracker_ignore_label.TRUCK : false
6+
tracker_ignore_label.BUS : false
7+
tracker_ignore_label.TRAILER : false
8+
tracker_ignore_label.MOTORCYCLE : false
9+
tracker_ignore_label.BICYCLE : false
10+
tracker_ignore_label.PEDESTRIAN : false
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,12 @@
1+
/**:
2+
ros__parameters:
3+
fusion_distance: 100.0
4+
trust_object_distance: 100.0
5+
trust_object_iou_mode: "iou"
6+
non_trust_object_iou_mode: "iou_x"
7+
use_cluster_semantic_type: false
8+
only_allow_inside_cluster: true
9+
roi_scale_factor: 1.1
10+
iou_threshold: 0.65
11+
unknown_iou_threshold: 0.1
12+
remove_unknown: false
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,19 @@
1+
/**:
2+
ros__parameters:
3+
# UNKNOWN, CAR, TRUCK, BUS, TRAILER, MOTORBIKE, BICYCLE, PEDESTRIAN
4+
passthrough_lower_bound_probability_thresholds: [0.35, 0.35, 0.35, 0.35, 0.35, 0.35, 0.35, 0.50]
5+
trust_distances: [50.0, 100.0, 100.0, 100.0, 100.0, 50.0, 50.0, 50.0]
6+
min_iou_threshold: 0.5
7+
use_roi_probability: false
8+
roi_probability_threshold: 0.5
9+
10+
can_assign_matrix:
11+
#UNKNOWN, CAR, TRUCK, BUS, TRAILER, MOTORBIKE, BICYCLE, PEDESTRIAN <-roi_msg
12+
[1, 0, 0, 0, 0, 0, 0, 0, # UNKNOWN <-detected_objects
13+
0, 1, 1, 1, 1, 0, 0, 0, # CAR
14+
0, 1, 1, 1, 1, 0, 0, 0, # TRUCK
15+
0, 1, 1, 1, 1, 0, 0, 0, # BUS
16+
0, 1, 1, 1, 1, 0, 0, 0, # TRAILER
17+
0, 0, 0, 0, 0, 1, 1, 1, # MOTORBIKE
18+
0, 0, 0, 0, 0, 1, 1, 1, # BICYCLE
19+
0, 0, 0, 0, 0, 1, 1, 1] # PEDESTRIAN
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,5 @@
1+
/**:
2+
ros__parameters:
3+
fuse_unknown_only: true
4+
min_cluster_size: 2
5+
cluster_2d_tolerance: 0.5

autoware_launch/config/perception/object_recognition/prediction/map_based_prediction.param.yaml

+3
Original file line numberDiff line numberDiff line change
@@ -16,6 +16,9 @@
1616
check_lateral_acceleration_constraints: false # whether to check if the predicted path complies with lateral acceleration constraints
1717
max_lateral_accel: 2.0 # [m/ss] max acceptable lateral acceleration for predicted vehicle paths
1818
min_acceleration_before_curve: -2.0 # [m/ss] min acceleration a vehicle might take to decelerate before a curve
19+
use_vehicle_acceleration: false # whether to consider current vehicle acceleration when predicting paths or not
20+
speed_limit_multiplier: 1.5 # When using vehicle acceleration. Set vehicle's maximum predicted speed as the legal speed limit in that lanelet times this value
21+
acceleration_exponential_half_life: 2.5 # [s] When using vehicle acceleration. The decaying acceleration model considers that the current vehicle acceleration will be halved after this many seconds
1922
# parameter for shoulder lane prediction
2023
prediction_time_horizon_rate_for_validate_shoulder_lane_length: 0.8
2124

autoware_launch/config/planning/preset/default_preset.yaml

+1-1
Original file line numberDiff line numberDiff line change
@@ -112,7 +112,7 @@ launch:
112112

113113
- arg:
114114
name: launch_surround_obstacle_checker
115-
default: "true"
115+
default: "false"
116116

117117
# parking modules
118118
- arg:

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

+2-1
Original file line numberDiff line numberDiff line change
@@ -122,7 +122,8 @@
122122
motorcycle: true # [-]
123123
pedestrian: true # [-]
124124
# detection range
125-
object_check_goal_distance: 20.0 # [m]
125+
object_check_goal_distance: 20.0 # [m]
126+
object_check_return_pose_distance: 20.0 # [m]
126127
# filtering parking objects
127128
threshold_distance_object_is_on_center: 1.0 # [m]
128129
object_check_shiftable_ratio: 0.6 # [-]

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

+1
Original file line numberDiff line numberDiff line change
@@ -38,6 +38,7 @@
3838
object_recognition_collision_check_margin: 0.6 # this should be larger than `surround_check_distance` of surround_obstacle_checker
3939
object_recognition_collision_check_max_extra_stopping_margin: 1.0
4040
th_moving_object_velocity: 1.0
41+
detection_bound_offset: 15.0
4142

4243
# pull over
4344
pull_over:

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

+2-2
Original file line numberDiff line numberDiff line change
@@ -53,7 +53,7 @@
5353

5454
goal_planner:
5555
enable_rtc: false
56-
enable_simultaneous_execution_as_approved_module: false
56+
enable_simultaneous_execution_as_approved_module: true
5757
enable_simultaneous_execution_as_candidate_module: false
5858
keep_last: true
5959
priority: 1
@@ -67,7 +67,7 @@
6767
priority: 4
6868
max_module_size: 1
6969

70-
avoidance_by_lc:
70+
avoidance_by_lane_change:
7171
enable_rtc: false
7272
enable_simultaneous_execution_as_approved_module: false
7373
enable_simultaneous_execution_as_candidate_module: false

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

+1-1
Original file line numberDiff line numberDiff line change
@@ -13,7 +13,7 @@
1313
center_line_path_interval: 1.0
1414
# shift pull out
1515
enable_shift_pull_out: true
16-
check_shift_path_lane_departure: false
16+
check_shift_path_lane_departure: true
1717
minimum_shift_pull_out_distance: 0.0
1818
deceleration_interval: 15.0
1919
lateral_jerk: 0.5

autoware_launch/config/planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/crosswalk.param.yaml

+6-6
Original file line numberDiff line numberDiff line change
@@ -16,7 +16,7 @@
1616
# For the case where the crosswalk width is very wide
1717
far_object_threshold: 10.0 # [m] If objects cross X meters behind the stop line, the stop position is determined according to the object position (stop_distance_from_object meters before the object).
1818
# For the case where the stop position is determined according to the object position.
19-
stop_distance_from_object: 2.0 # [m] the vehicle decelerates to be able to stop in front of object with margin
19+
stop_distance_from_object: 3.0 # [m] the vehicle decelerates to be able to stop in front of object with margin
2020

2121
# params for ego's slow down velocity. These params are not used for the case of "enable_rtc: false".
2222
slow_down:
@@ -38,7 +38,7 @@
3838
# params for the pass judge logic against the crosswalk users such as pedestrians or bicycles
3939
pass_judge:
4040
ego_pass_first_margin_x: [0.0] # [[s]] time to collision margin vector for ego pass first situation (the module judges that ego don't have to stop at TTC + MARGIN < TTV condition)
41-
ego_pass_first_margin_y: [6.0] # [[s]] time to vehicle margin vector for ego pass first situation (the module judges that ego don't have to stop at TTC + MARGIN < TTV condition)
41+
ego_pass_first_margin_y: [3.0] # [[s]] time to vehicle margin vector for ego pass first situation (the module judges that ego don't have to stop at TTC + MARGIN < TTV condition)
4242
ego_pass_first_additional_margin: 0.5 # [s] additional time margin for ego pass first situation to suppress chattering
4343
ego_pass_later_margin_x: [0.0] # [[s]] time to vehicle margin vector for object pass first situation (the module judges that ego don't have to stop at TTV + MARGIN < TTC condition)
4444
ego_pass_later_margin_y: [10.0] # [[s]] time to collision margin vector for object pass first situation (the module judges that ego don't have to stop at TTV + MARGIN < TTC condition)
@@ -50,19 +50,19 @@
5050
min_jerk: -1.0 # min jerk [m/sss]
5151
max_jerk: 1.0 # max jerk [m/sss]
5252

53-
stop_object_velocity_threshold: 0.28 # [m/s] velocity threshold for the module to judge whether the objects is stopped (0.28 m/s = 1.0 kmph)
53+
stop_object_velocity_threshold: 0.25 # [m/s] velocity threshold for the module to judge whether the objects is stopped (0.25 m/s = 0.9 kmph)
5454
min_object_velocity: 1.39 # [m/s] minimum object velocity (compare the estimated velocity by perception module with this parameter and adopt the larger one to calculate TTV. 1.39 m/s = 5.0 kmph)
5555
## param for yielding
5656
disable_stop_for_yield_cancel: true # for the crosswalks with traffic signal
5757
disable_yield_for_new_stopped_object: true # for the crosswalks with traffic signal
5858
# If the pedestrian does not move for X seconds after the ego has stopped in front the crosswalk, the module judge that the pedestrian has no intention to walk and allows the ego to proceed.
5959
distance_map_for_no_intention_to_walk: [1.0, 5.0] # [m] ascending order
60-
timeout_map_for_no_intention_to_walk: [3.0, 0.0] # [s]
61-
timeout_ego_stop_for_yield: 3.0 # [s] If the ego maintains the stop for this amount of time, then the ego proceeds, assuming it has stopped long time enough.
60+
timeout_map_for_no_intention_to_walk: [1.0, 0.0] # [s]
61+
timeout_ego_stop_for_yield: 1.0 # [s] If the ego maintains the stop for this amount of time, then the ego proceeds, assuming it has stopped long time enough.
6262

6363
# param for target object filtering
6464
object_filtering:
65-
crosswalk_attention_range: 1.0 # [m] the detection area is defined as -X meters before the crosswalk to +X meters behind the crosswalk
65+
crosswalk_attention_range: 2.0 # [m] the detection area is defined as -X meters before the crosswalk to +X meters behind the crosswalk
6666
vehicle_object_cross_angle_threshold: 0.5 # [rad] threshold judging object is crossing walkway as a pedestrian or passing over as a vehicle
6767
target_object:
6868
unknown: true # [-] whether to look and stop by UNKNOWN objects

autoware_launch/config/planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/intersection.param.yaml

+2-2
Original file line numberDiff line numberDiff line change
@@ -12,6 +12,7 @@
1212
max_accel: -2.8
1313
max_jerk: -5.0
1414
delay_response_time: 0.5
15+
enable_pass_judge_before_default_stopline: false
1516

1617
stuck_vehicle:
1718
turn_direction:
@@ -36,7 +37,6 @@
3637
consider_wrong_direction_vehicle: false
3738
collision_detection_hold_time: 0.5
3839
min_predicted_path_confidence: 0.05
39-
keep_detection_velocity_threshold: 0.833
4040
velocity_profile:
4141
use_upstream: true
4242
minimum_upstream_velocity: 0.01
@@ -67,7 +67,7 @@
6767
occupied_min: 58
6868
denoise_kernel: 1.0
6969
attention_lane_crop_curvature_threshold: 0.25
70-
attention_lane_curvature_calculation_ds: 0.5
70+
attention_lane_curvature_calculation_ds: 0.6
7171
creep_during_peeking:
7272
enable: false
7373
creep_velocity: 0.8333

autoware_launch/config/planning/scenario_planning/lane_driving/behavior_planning/behavior_velocity_planner/run_out.param.yaml

+33-25
Original file line numberDiff line numberDiff line change
@@ -3,7 +3,7 @@
33
run_out:
44
detection_method: "Object" # [-] candidate: Object, ObjectWithoutPath, Points
55
use_partition_lanelet: true # [-] whether to use partition lanelet map data
6-
suppress_on_crosswalk: true # [-] whether to suppress on crosswalk lanelet:
6+
suppress_on_crosswalk: true # [-] whether to suppress on crosswalk lanelet
77
specify_decel_jerk: true # [-] whether to specify jerk when ego decelerates
88
stop_margin: 2.5 # [m] the vehicle decelerates to be able to stop with this margin
99
passing_margin: 1.1 # [m] the vehicle begins to accelerate if the vehicle's front in predicted position is ahead of the obstacle + this margin
@@ -12,15 +12,7 @@
1212
detection_span: 1.0 # [m] calculate collision with this span to reduce calculation time
1313
min_vel_ego_kmph: 3.6 # [km/h] min velocity to calculate time to collision
1414

15-
detection_area:
16-
margin_behind: 0.5 # [m] ahead margin for detection area length
17-
margin_ahead: 1.0 # [m] behind margin for detection area length
18-
19-
# This area uses points not filtered by vector map to ensure safety
20-
mandatory_area:
21-
decel_jerk: -1.2 # [m/s^3] deceleration jerk for obstacles in this area
22-
23-
# parameter to create abstracted dynamic obstacles
15+
# Parameter to create abstracted dynamic obstacles
2416
dynamic_obstacle:
2517
use_mandatory_area: false # [-] whether to use mandatory detection area
2618
assume_fixed_velocity:
@@ -34,26 +26,42 @@
3426
time_step: 0.5 # [sec] time step for each path step. used for creating dynamic obstacles from points or objects without path
3527
points_interval: 0.1 # [m] divide obstacle points into groups with this interval, and detect only lateral nearest point. used only for Points method
3628

37-
# approach if ego has stopped in the front of the obstacle for a certain amount of time
38-
approaching:
39-
enable: false
40-
margin: 0.0 # [m] distance on how close ego approaches the obstacle
41-
limit_vel_kmph: 3.0 # [km/h] limit velocity for approaching after stopping
42-
43-
# parameters for the change of state. used only when approaching is enabled
44-
state:
45-
stop_thresh: 0.01 # [m/s] threshold to decide if ego is stopping
46-
stop_time_thresh: 3.0 # [sec] threshold for stopping time to transit to approaching state
47-
disable_approach_dist: 3.0 # [m] end the approaching state if distance to the obstacle is longer than this value
48-
keep_approach_duration: 1.0 # [sec] keep approach state for this duration to avoid chattering of state transition
49-
50-
# parameter to avoid sudden stopping
29+
# Parameter to prevent sudden stopping.
30+
# If the deceleration jerk and acceleration exceed this value upon inserting a stop point,
31+
# the deceleration will be moderated to stay under this value.
5132
slow_down_limit:
5233
enable: false
5334
max_jerk: -0.7 # [m/s^3] minimum jerk deceleration for safe brake.
5435
max_acc : -2.0 # [m/s^2] minimum accel deceleration for safe brake.
5536

56-
# prevent abrupt stops caused by false positives in perception
37+
# Parameter to prevent abrupt stops caused by false positives in perception
5738
ignore_momentary_detection:
5839
enable: true
5940
time_threshold: 0.15 # [sec] ignores detections that persist for less than this duration
41+
42+
# Typically used when the "detection_method" is set to ObjectWithoutPath or Points
43+
# Approach if the ego has stopped in front of the obstacle for a certain period
44+
# This avoids the issue of the ego continuously stopping in front of the obstacle
45+
approaching:
46+
enable: false
47+
margin: 0.0 # [m] distance on how close ego approaches the obstacle
48+
limit_vel_kmph: 3.0 # [km/h] limit velocity for approaching after stopping
49+
# Parameters for state change when "approaching" is enabled
50+
state:
51+
stop_thresh: 0.01 # [m/s] threshold to decide if ego is stopping
52+
stop_time_thresh: 3.0 # [sec] threshold for stopping time to transit to approaching state
53+
disable_approach_dist: 3.0 # [m] end the approaching state if distance to the obstacle is longer than this value
54+
keep_approach_duration: 1.0 # [sec] keep approach state for this duration to avoid chattering of state transition
55+
56+
# Only used when "detection_method" is set to Points
57+
# Filters points by the detection area polygon to reduce computational cost
58+
# The detection area is calculated based on the current velocity and acceleration and deceleration jerk constraints
59+
detection_area:
60+
margin_behind: 0.5 # [m] ahead margin for detection area length
61+
margin_ahead: 1.0 # [m] behind margin for detection area length
62+
63+
# Only used when "detection_method" is set to Points
64+
# Points in this area are detected even if it is in the no obstacle segmentation area
65+
# The mandatory area is calculated based on the current velocity and acceleration and "decel_jerk" constraints
66+
mandatory_area:
67+
decel_jerk: -1.2 # [m/s^3] deceleration jerk for obstacles in this area
Original file line numberDiff line numberDiff line change
@@ -1,5 +1,5 @@
11
/**:
22
ros__parameters:
33
walkway:
4-
stop_duration: 1.0 # [s] stop time at stop position
4+
stop_duration: 0.1 # [s] stop time at stop position
55
stop_distance_from_crosswalk: 3.5 # [m] make stop line away from crosswalk when no explicit stop line exists

autoware_launch/config/planning/scenario_planning/lane_driving/motion_planning/obstacle_avoidance_planner/obstacle_avoidance_planner.param.yaml

+3-3
Original file line numberDiff line numberDiff line change
@@ -31,7 +31,7 @@
3131
max_ego_moving_dist: 5.0 # threshold of ego's moving distance for replan [m]
3232
# make max_goal_moving_dist long to keep start point fixed for pull over
3333
max_goal_moving_dist: 15.0 # threshold of goal's moving distance for replan [m]
34-
max_delta_time_sec: 1.0 # threshold of delta time for replan [second]
34+
max_delta_time_sec: 0.0 # threshold of delta time for replan [second]
3535

3636
# mpt param
3737
mpt:
@@ -40,7 +40,7 @@
4040
steer_limit_constraint: false
4141
visualize_sampling_num: 1
4242
enable_manual_warm_start: false
43-
enable_warm_start: true
43+
enable_warm_start: false
4444
enable_optimization_validation: false
4545

4646
common:
@@ -62,7 +62,7 @@
6262
# weight parameter for optimization
6363
weight:
6464
# collision free
65-
soft_collision_free_weight: 1000.0 # soft weight for lateral error around the middle point
65+
soft_collision_free_weight: 1.0 # soft weight for lateral error around the middle point
6666

6767
# tracking error
6868
lat_error_weight: 1.0 # weight for lateral error

autoware_launch/config/planning/scenario_planning/lane_driving/motion_planning/obstacle_cruise_planner/obstacle_cruise_planner.param.yaml

+4-4
Original file line numberDiff line numberDiff line change
@@ -85,15 +85,15 @@
8585
obstacle_traj_angle_threshold : 1.22 # [rad] = 70 [deg], yaw threshold of crossing obstacle against the nearest trajectory point for cruise or stop
8686

8787
stop:
88-
max_lat_margin: 0.0 # lateral margin between obstacle and trajectory band with ego's width
88+
max_lat_margin: 0.2 # lateral margin between obstacle and trajectory band with ego's width
8989
crossing_obstacle:
9090
collision_time_margin : 4.0 # time threshold of collision between obstacle adn ego for cruise or stop [s]
9191

9292
cruise:
9393
max_lat_margin: 1.0 # lateral margin between obstacle and trajectory band with ego's width
9494
outside_obstacle:
95-
obstacle_velocity_threshold : 3.0 # minimum velocity threshold of obstacles outside the trajectory to cruise or stop [m/s]
96-
ego_obstacle_overlap_time_threshold : 1.0 # time threshold to decide cut-in obstacle for cruise or stop [s]
95+
obstacle_velocity_threshold : 3.5 # minimum velocity threshold of obstacles outside the trajectory to cruise or stop [m/s]
96+
ego_obstacle_overlap_time_threshold : 2.0 # time threshold to decide cut-in obstacle for cruise or stop [s]
9797
max_prediction_time_for_collision_check : 20.0 # prediction time to check collision between obstacle and ego
9898

9999
slow_down:
@@ -187,7 +187,7 @@
187187
static:
188188
min_lat_margin: 0.2
189189
max_lat_margin: 1.0
190-
min_ego_velocity: 2.0
190+
min_ego_velocity: 4.0
191191
max_ego_velocity: 8.0
192192

193193
moving_object_speed_threshold: 0.5 # [m/s] how fast the object needs to move to be considered as "moving"

autoware_launch/config/planning/scenario_planning/lane_driving/motion_planning/path_smoother/elastic_band_smoother.param.yaml

+1-1
Original file line numberDiff line numberDiff line change
@@ -44,4 +44,4 @@
4444
max_ego_moving_dist: 5.0 # threshold of ego's moving distance for replan [m]
4545
# make max_goal_moving_dist long to keep start point fixed for pull over
4646
max_goal_moving_dist: 15.0 # threshold of goal's moving distance for replan [m]
47-
max_delta_time_sec: 1.0 # threshold of delta time for replan [second]
47+
max_delta_time_sec: 0.0 # threshold of delta time for replan [second]

0 commit comments

Comments
 (0)