Removed remaining print statements, using ros logging now