Absolute filter with GPS working well enough to refactor, double check transformations, and add tests.