De-bugged lawnmower

Wasn't able to find error in determining GPS points, but the program now
checks for an error and corrects it if necessary