Completed conversion of prints to ROS verbosity statements. Also, cleaned some files.