apollo
apollo copied to clipboard
parking_inwards endpoint calculation bug
Describe the bug
file: modules/planning/tasks/open_space_roi_decider/open_space_roi_decider.cc
264 row: if (parking_inwards) { parking_heading = (left_down - left_top).Angle(); Vec2d middle_top = (left_top + right_top) / 2.0; end_pt = middle_top + Vec2d::CreateUnitVec2d(parking_heading) * (vehicle_params_.front_edge_to_center() + parking_depth_buffer); }
if parking_inwards is true,The correct endpoint calculation should be
end_pt = middle_top + Vec2d::CreateUnitVec2d(parking_heading) *
(vehicle_params_.back_edge_to_center() +
parking_depth_buffer);