Skip to content

Commit f6521da

Browse files
revert
Signed-off-by: Yuki Takagi <yuki.takagi@tier4.jp>
1 parent 12e8d0a commit f6521da

File tree

1 file changed

+12
-14
lines changed
  • planning/behavior_path_dynamic_avoidance_module/src

1 file changed

+12
-14
lines changed

planning/behavior_path_dynamic_avoidance_module/src/scene.cpp

+12-14
Original file line numberDiff line numberDiff line change
@@ -1069,27 +1069,25 @@ MinMaxValue DynamicAvoidanceModule::calcMinMaxLongitudinalOffsetToAvoid(
10691069
// The ego and object are the opposite directional or the object is parked.
10701070
return std::min(time_while_collision.time_to_start_collision, 8.0) * std::abs(obj_vel) +
10711071
std::abs(relative_velocity) * parameters_->start_duration_to_avoid_oncoming_object;
1072-
} else {
1073-
// The ego and object are the same directional
1074-
const double obj_acc = -0.5;
1075-
const double decel_time = 1.0;
1076-
const double obj_moving_dist =
1077-
(std::pow(std::max(obj_vel + obj_acc * decel_time, 0.0), 2) - std::pow(obj_vel, 2)) / 2 /
1078-
obj_acc;
1079-
const double ego_moving_dist = getEgoSpeed() * decel_time;
1080-
return std::max(0.0, ego_moving_dist - obj_moving_dist) +
1081-
std::abs(relative_velocity) * parameters_->start_duration_to_avoid_overtaking_object;
10821072
}
1073+
// The ego and object are the same directional
1074+
const double obj_acc = -0.5;
1075+
const double decel_time = 1.0;
1076+
const double obj_moving_dist =
1077+
(std::pow(std::max(obj_vel + obj_acc * decel_time, 0.0), 2) - std::pow(obj_vel, 2)) / 2 /
1078+
obj_acc;
1079+
const double ego_moving_dist = getEgoSpeed() * decel_time;
1080+
return std::max(0.0, ego_moving_dist - obj_moving_dist) +
1081+
std::abs(relative_velocity) * parameters_->start_duration_to_avoid_overtaking_object;
10831082
}();
10841083
const double end_length_to_avoid = [&]() {
10851084
if (obj_vel < parameters_->max_stopped_object_vel) {
10861085
// The ego and object are the opposite directional or the object is parked.
10871086
return std::abs(relative_velocity) * parameters_->end_duration_to_avoid_oncoming_object;
1088-
} else {
1089-
// The ego and object are the same directional
1090-
return std::min(time_while_collision.time_to_end_collision, 3.0) * obj_vel +
1091-
std::abs(relative_velocity) * parameters_->end_duration_to_avoid_overtaking_object;
10921087
}
1088+
// The ego and object are the same directional
1089+
return std::min(time_while_collision.time_to_end_collision, 3.0) * obj_vel +
1090+
std::abs(relative_velocity) * parameters_->end_duration_to_avoid_overtaking_object;
10931091
}();
10941092

10951093
// calculate valid path for the forked object's path from the ego's path

0 commit comments

Comments
 (0)