Fixed lead vehicle distance stuttering
Removed debug statement
This commit is contained in:
parent
b769786bc3
commit
c5cc7b7f2f
|
@ -202,7 +202,9 @@ namespace CollisionStageConstants {
|
|||
|
||||
!(!reference_front_wp->CheckJunction() &&
|
||||
cg::Math::Dot(reference_heading, reference_to_other) > 0 &&
|
||||
inter_vehicle_distance > minimum_inter_vehicle_distance)) {
|
||||
inter_vehicle_distance > std::max(minimum_inter_vehicle_distance,
|
||||
std::pow(parameters.GetDistanceToLeadingVehicle(reference_vehicle)
|
||||
+ inter_vehicle_length, 2.0f)))) {
|
||||
|
||||
const Polygon reference_geodesic_polygon = GetPolygon(GetGeodesicBoundary(reference_vehicle, reference_location));
|
||||
const Polygon other_geodesic_polygon = GetPolygon(GetGeodesicBoundary(other_vehicle, other_location));
|
||||
|
|
|
@ -158,7 +158,7 @@ float Parameters::GetDistanceToLeadingVehicle(const ActorPtr &actor) {
|
|||
} else {
|
||||
specific_distance_margin = distance_margin;
|
||||
}
|
||||
//std::cout <<"distance_margin :- "<< distance_margin <<" " <<"Value of Specific Distance Margin - " << specific_distance_margin << std::endl;
|
||||
|
||||
return specific_distance_margin;
|
||||
}
|
||||
|
||||
|
|
Loading…
Reference in New Issue