Skip to content

Commit 501b643

Browse files
pre-commit-ci[bot]beyza
authored and
beyza
committed
style(pre-commit): autofix
1 parent f095639 commit 501b643

File tree

1 file changed

+9
-4
lines changed
  • planning/behavior_velocity_dynamic_obstacle_stop_module/src

1 file changed

+9
-4
lines changed

planning/behavior_velocity_dynamic_obstacle_stop_module/src/collision.cpp

+9-4
Original file line numberDiff line numberDiff line change
@@ -53,10 +53,15 @@ std::optional<geometry_msgs::msg::Point> find_closest_collision_point(
5353
auto p = geometry_msgs::msg::Point().set__x(coll_p.x()).set__y(coll_p.y());
5454
const auto dist_ego_to_coll =
5555
motion_utils::calcSignedArcLength(ego_data.path.points, ego_pose.position, p);
56-
const auto dist_obj_to_coll = tier4_autoware_utils::calcDistance2d(object_pose.position, p);
57-
const auto tta_cp_npc = abs(dist_obj_to_coll) / object.kinematics.initial_twist_with_covariance.twist.linear.x;
58-
const auto tta_cp_ego = dist_ego_to_coll / ego_data.path.points[path_idx].point.longitudinal_velocity_mps;
59-
if (abs(dist_ego_to_coll) < closest_dist && std::abs(tta_cp_npc - tta_cp_ego) < params.time_horizon) {
56+
const auto dist_obj_to_coll =
57+
tier4_autoware_utils::calcDistance2d(object_pose.position, p);
58+
const auto tta_cp_npc =
59+
abs(dist_obj_to_coll) / object.kinematics.initial_twist_with_covariance.twist.linear.x;
60+
const auto tta_cp_ego =
61+
dist_ego_to_coll / ego_data.path.points[path_idx].point.longitudinal_velocity_mps;
62+
if (
63+
abs(dist_ego_to_coll) < closest_dist &&
64+
std::abs(tta_cp_npc - tta_cp_ego) < params.time_horizon) {
6065
closest_dist = dist_ego_to_coll;
6166
closest_collision_point = p;
6267
}

0 commit comments

Comments
 (0)