public void Notify(int notification) { if (_activeSelected) { Servo activeServo = _servos[_activeServoIndex]; foreach (Entity entity in _entities) { bool difEntity = !entity.Equals(activeServo); double distance = Vector2.Distance(entity.Position, activeServo.Position); double radi = (entity.Radius + activeServo.Radius * 2); if (difEntity && distance < radi) { if (notification > 2) { notification = 2; } } } activeServo.Notify(notification); } }