First files uploaded, working prototype but with lots of ROS_INFO msgs published.