Fix initialization of state variances

• incomplete computation of variances in case 1; the matrix block must be extracted after computing the full covariance matrix
• wrong ordering for case 2