test sr_self_test is now working and gazebo self_tests can be called properly. Need to pass string to service test + add other tests