Refactoring
Moved Kalman filters to public repo