added checkpoint functionality  corrected waypoints to work in two dimensions. 1: start -> end 2: interest points in between