Fixes race condition that exists due to action server autostart

fixes https://github.com/ros/geometry_experimental/issues/9