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.