Function f and matrix A
Classic extended kalman matrix.