fixed ROS_INFO messages and performed code cleanup