GPS drift correction