Added Gazebo 1.9 interface for control to replace the outdated gazebo interface