File tree 3 files changed +7
-4
lines changed
behavior_path_lane_change_module/src
behavior_path_planner/src
behavior_path_planner_common/include/behavior_path_planner_common
3 files changed +7
-4
lines changed Original file line number Diff line number Diff line change @@ -1247,9 +1247,9 @@ bool NormalLaneChange::getLaneChangePaths(
1247
1247
};
1248
1248
1249
1249
// get path on original lanes
1250
- const auto prepare_velocity = std::max (
1250
+ const auto prepare_velocity = std::clamp (
1251
1251
current_velocity + sampled_longitudinal_acc * prepare_duration,
1252
- minimum_lane_changing_velocity);
1252
+ minimum_lane_changing_velocity, getCommonParam (). max_vel );
1253
1253
1254
1254
// compute actual longitudinal acceleration
1255
1255
const double longitudinal_acc_on_prepare =
@@ -1313,8 +1313,9 @@ bool NormalLaneChange::getLaneChangePaths(
1313
1313
const auto lane_changing_length =
1314
1314
initial_lane_changing_velocity * lane_changing_time +
1315
1315
0.5 * longitudinal_acc_on_lane_changing * lane_changing_time * lane_changing_time;
1316
- const auto terminal_lane_changing_velocity =
1317
- initial_lane_changing_velocity + longitudinal_acc_on_lane_changing * lane_changing_time;
1316
+ const auto terminal_lane_changing_velocity = std::min (
1317
+ initial_lane_changing_velocity + longitudinal_acc_on_lane_changing * lane_changing_time,
1318
+ getCommonParam ().max_vel );
1318
1319
utils::lane_change::setPrepareVelocity (
1319
1320
prepare_segment, current_velocity, terminal_lane_changing_velocity);
1320
1321
Original file line number Diff line number Diff line change @@ -238,6 +238,7 @@ BehaviorPathPlannerParameters BehaviorPathPlannerNode::getCommonParam()
238
238
p.min_acc = declare_parameter<double >(" normal.min_acc" );
239
239
p.max_acc = declare_parameter<double >(" normal.max_acc" );
240
240
241
+ p.max_vel = declare_parameter<double >(" max_vel" );
241
242
p.backward_length_buffer_for_end_of_pull_over =
242
243
declare_parameter<double >(" backward_length_buffer_for_end_of_pull_over" );
243
244
p.backward_length_buffer_for_end_of_pull_out =
Original file line number Diff line number Diff line change @@ -42,6 +42,7 @@ struct BehaviorPathPlannerParameters
42
42
// common parameters
43
43
double min_acc;
44
44
double max_acc;
45
+ double max_vel;
45
46
46
47
double minimum_pull_over_length;
47
48
double minimum_pull_out_length;
You can’t perform that action at this time.
0 commit comments