public static bool CheckSafetyDistanceOfObstacle(this SafetyModule safetyModule,
VPVehicleController carController, IObstacle obstacle)
{
var distanceOfObstacle = carController.GetDistance(obstacle);
var brakingDistance = safetyModule.BrakingDistance;
//TODO dystans wyliczany powinnien być zgodnie z trajektorią ruchu nie po lini prostej
return(distanceOfObstacle.magnitude > brakingDistance + safetyModule.SafetyDistance);
}
public static float CalculateBrakingDistance(this SafetyModule safetyModule, float speed)
{
return(speed * speed / (2 * safetyModule.BrakingAccelerate));
}
