Started coding Kalman Filter
More on notation and models