Added gazebo::transport::Publisher into simulation_system; Publish message method call not successful yet