Wait for service before calling it (#244)
Wait for service before calling it (#244)

* Wait for service before calling it
* Wait for a maximum of 15 seconds
* Refactor to make sure cleanup happens

ros2/system_tests,ros2/system_tests