Nice! I have been running into the same problem, and solving it for our specific situation. Better to have a generic solution. --- [Visit Topic](https://discourse.ros.org/t/announcement-ros-control-robotstatus-publisher/8170/2) or reply to this email to respond.