Commit 1a7af2d 1 parent c8fcac8 commit 1a7af2d Copy full SHA for 1a7af2d
File tree 1 file changed +2
-2
lines changed
planning/behavior_velocity_dynamic_obstacle_stop_module/src
1 file changed +2
-2
lines changed Original file line number Diff line number Diff line change @@ -69,8 +69,8 @@ std::vector<autoware_auto_perception_msgs::msg::PredictedObject> filter_predicte
69
69
params.ego_lateral_offset + o.shape .dimensions .y / 2.0 + params.hysteresis ;
70
70
// https://en.wikipedia.org/wiki/Distance_from_a_point_to_a_line#Line_defined_by_point_and_angle
71
71
const auto lat_distance = std::abs (
72
- (o_pose.position .y - ego_data.pose .position .y ) * std::cos (o_yaw) -
73
- (o_pose.position .x - ego_data.pose .position .x ) * std::sin (o_yaw));
72
+ (o_pose.position .y - ego_data.pose .position .y ) * std::cos (o_yaw) -
73
+ (o_pose.position .x - ego_data.pose .position .x ) * std::sin (o_yaw));
74
74
auto has_collision = lat_distance <= collision_distance_threshold;
75
75
if (ego_data.earliest_stop_pose ) {
76
76
const auto collision_at_earliest_stop_pose =
You can’t perform that action at this time.
0 commit comments