trying to add self test to gazebo as well - not working yet, seems to hang when calling the service. not sure add is working properly