Forward behavior now uses odometry to estimate travelled distance.
Robot now halves the speed when starts sensing an obstacle in front. There is a delay in reading the sensors that makes it safer to move slowly when near an obstacle.