Add basic handler for publishing, and support for detecting ROS not ok.