Removed debug, went back to roslog info