Changed to using a constant acceleration for stepper motors instead of a time constant.
Fixed odometry problem where sign of forward angle was flipped and that we were still using unset calibrated right distance.  Also tried to account for when we lose walls.
Fixed bug where forward distance was never being incremented to reach distance travelled.