Navigation fixed & collision avoidance

Constants have been adjusted so navigation is much more smooth.

Robot now detects impending frontal collisions and stops before backing
up and restarting search.