publishes odometry messages based on localization data

This commits computes odometry data based on the measured sensor location and publishes an nav/Odometry message