Odometry 1

Robot firmware updates and code to support proprioceptive odometry.