First version of the ROS data publishing from Jon