Moving UGV(unmanned ground vehicle) based on two waypoints

I am sorry this is the real 4th code as per attachment

waypointlatest3AB.ino (10.3 KB)