Added odometry class, and have robot sticking to the wall