Small corrections
Correcting KF to generate single template with first cycles, instead of resetting covariance matrices every couple seconds