publishes odometry messages based on localization data

This commits computes odometry data based on the measured sensor location and publishes an nav/Odometry message
Doesn't `odom` have a covariance matrix?  Does this need to be populated? (just curious)