Most changes related to the re-factoring needed to publish
MovementStatus messages when Odometry is received. Probably more
changes, I was real bad this time about commiting...