Started working on GPS filtering for robot data.
Added some unit tests.
Next steps will be to finish GPS filtering (smoothing) and then start to
add additional measurements- IMU, odometry. I'll need to increase the
complexity of the filter and evaluate versus GPS.