Added odom publisher. Improved a little bit Gazebo integration