AP_GPS: Fix bug that causes permanent lag if we miss a message

I'm sure it can be corrected more efficiently, but this is the clearest way to do it.