-Fix instantaneous odom getting computed, but not published

Instantaneous odometry velocities (linear x and angular z) that are published were always 0 so far, which for example prevents DWA planner from working correctly in simulation.