Added a resolve function for the assign conflicts
Changed ROS_INFO into ROS_DEBUG for the most