Removed debug line ROS_INFO()