Working EnKF.

First time to get the Ensemble Kalman filter working. Well, we
have smooth output - this is not fully tested yet.