Code cleanup and usability improvements

Can loop if reading from directory, ROS_INFO and related calls now work
properly in windows..