Fixed problem with updating of covariance matrix, implemented likelihood