Fix gazebo odom callback

This gets gazebo working for me.