Kalman filter fortran code