replace print statements with rospy.loginfo