First pass at absolute filter with GPS.  Need to add latency compensation and covariance limiting.
Merge pull request #10 from chadrockey/ukf

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