Publish odometry

Publish Odometry messages for use by the ROS navigation stack.