Fixed covarience odom publishing