Obstacle detection finished and ready for NUbugger implementation and testing.