URDF /xacro more modular. Small gazebo improvements. Updates in README