Kalman and C matrix
Code clear and commented