Skip to content

Commit 5de4076

Browse files
KYabuuchij4tfwm6z
and
j4tfwm6z
authoredSep 17, 2024
chore(trajectory_follower): change control parameter for jpt8 (autowarefoundation#966)
Co-authored-by: j4tfwm6z <j4tfwm6z@tier4.jp>
1 parent fb4e83e commit 5de4076

File tree

2 files changed

+12
-8
lines changed

2 files changed

+12
-8
lines changed
 

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

+4-4
Original file line numberDiff line numberDiff line change
@@ -24,12 +24,12 @@
2424
mpc_weight_heading_error_squared_vel: 0.03 # heading error * velocity weight in matrix Q
2525
mpc_weight_steering_input: 1.0 # steering error weight in matrix R
2626
mpc_weight_steering_input_squared_vel: 1.00 # steering error * velocity weight in matrix R
27-
mpc_weight_lat_jerk: 0.0 # lateral jerk weight in matrix R
27+
mpc_weight_lat_jerk: 0.075 # lateral jerk weight in matrix R
2828
mpc_weight_steer_rate: 0.0 # steering rate weight in matrix R
2929
mpc_weight_steer_acc: 0.000001 # steering angular acceleration weight in matrix R
30-
mpc_low_curvature_weight_lat_error: 0.05 # lateral error weight in matrix Q in low curvature point
30+
mpc_low_curvature_weight_lat_error: 0.1 # lateral error weight in matrix Q in low curvature point
3131
mpc_low_curvature_weight_heading_error: 0.0 # heading error weight in matrix Q in low curvature point
32-
mpc_low_curvature_weight_heading_error_squared_vel: 0.03 # heading error * velocity weight in matrix Q in low curvature point
32+
mpc_low_curvature_weight_heading_error_squared_vel: 0.2 # heading error * velocity weight in matrix Q in low curvature point
3333
mpc_low_curvature_weight_steering_input: 1.0 # steering error weight in matrix R in low curvature point
3434
mpc_low_curvature_weight_steering_input_squared_vel: 2.00 # steering error * velocity weight in matrix R in low curvature point
3535
mpc_low_curvature_weight_lat_jerk: 0.0 # lateral jerk weight in matrix R in low curvature point
@@ -45,7 +45,7 @@
4545

4646
# -- vehicle model --
4747
vehicle_model_type: "kinematics" # vehicle model type for mpc prediction. option is kinematics, kinematics_no_delay, and dynamics
48-
input_delay: 0.1 # steering input delay time for delay compensation
48+
input_delay: 0.3 # steering input delay time for delay compensation
4949
vehicle_model_steer_tau: 0.1 # steering dynamics time constant (1d approximation) [s]
5050
steer_rate_lim_dps_list_by_curvature: [20.0, 20.0, 20.0] # steering angle rate limit list depending on curvature [deg/s]
5151
curvature_list_for_steer_rate_lim: [0.001, 0.002, 0.01] # curvature list for steering angle rate limit interpolation in ascending order [/m]

‎autoware_launch/config/control/trajectory_follower/8/longitudinal/pid.param.yaml

+8-4
Original file line numberDiff line numberDiff line change
@@ -20,8 +20,8 @@
2020
emergency_state_traj_rot_dev: 0.7854
2121

2222
# drive state
23-
kp: 2.0
24-
ki: 0.02
23+
kp: 0.5
24+
ki: 0.0
2525
kd: 0.0
2626
max_out: 1.0
2727
min_out: -5.0
@@ -31,7 +31,7 @@
3131
min_i_effort: -0.3
3232
max_d_effort: 0.0
3333
min_d_effort: 0.0
34-
lpf_vel_error_gain: 0.9
34+
lpf_vel_error_gain: 0.99
3535
enable_integration_at_low_speed: false
3636
current_vel_threshold_pid_integration: 0.5
3737
time_threshold_before_pid_integration: 2.0
@@ -41,7 +41,7 @@
4141
# smooth stop state
4242
smooth_stop_max_strong_acc: -0.8
4343
smooth_stop_min_strong_acc: -1.3
44-
smooth_stop_weak_acc: -0.4
44+
smooth_stop_weak_acc: -0.63
4545
smooth_stop_weak_stop_acc: -0.8
4646
smooth_stop_strong_stop_acc: -3.4
4747
smooth_stop_max_fast_vel: 0.5
@@ -61,6 +61,10 @@
6161

6262
emergency_jerk: -3.0
6363

64+
# acceleration feedback
65+
lpf_acc_error_gain: 0.98
66+
acc_feedback_gain: 1.0
67+
6468
# acceleration limit
6569
max_acc: 3.0
6670
min_acc: -5.0

0 commit comments

Comments
 (0)