Added distance checking for collisions

Instead of quad trees