Robot Gps Waypoint Path Following Algorithm