[WIP] Adapt to new refactoring from master

-Remove TworldCovariance uses
-Switch Covariance convention
-Add namespaces
1 job for Kalman in 57 seconds
latest