Added utility files to robot package. Tried to put the line back in to adjust the angular velocity to help with error while driving, but it led to erratic driving again.