Calculate sigma_next
Encapsulate Kalman filter in a 'class'.