Filter out gps if too far from last read