finish basic offset_to_movement function, clean out debuggin printf's from the offset finding if statements, general bug fixing, currently the offsets need to be adjusted as the robot often overshoots