First pass at absolute filter with GPS.  Need to add latency compensatio...

...n and covariance limiting.