Optimisation for spatial accuracy

[danielparthier]

The current implementation corrects with a B-spline if outliers are detected in 1D. Once in a while it might glitch under extreme situations.
An optimisation could include a multidimensional Kalman filter implementation when loading and correcting coordinates.