Fix race where first message won't get published
Fix race where first message won't get published

Signed-off-by: Shane Loretz <7fde345e8e2e22c78a1570a4807e4629866dc7de@osrfoundation.org>

ros-controls/realtime_tools