ROS demo - first working draft