Add handling for extreme outliers and fix x/y gps position

[avikomarlingam]

In progress, will probably use a low-pass filter for outliers. Still figuring out what's wrong with x/y data.