Here I think we can make a serious discussion whether we would rather worked directly on the raw GPS data or the state estimation data. In one case we would be sensitive to GPS glitches. In the other case we are sensitive to divergence of the state estimation.

I think this is better overall, but could be persuaded.