Fix gazebo deps
Fix gazebo include paths

This is needed to be compatible with newer Gazebo ABI/API