New 1d sample Kalman filter
Better multivariate Gaussians