Removed useless distance check
Removed random debug line