void IMeasurements.UpdateMeasurements() { foreach (IMeasurements mea in inmea) { mea.UpdateMeasurements(); } transitionObjectM.State = state; transition = transitionObjectM.Matrix(); double[] st = transitionObjectM.Output; Array.Copy(st, state, state.Length); measurementsM.State = state; double[,] partial = measurementsM.Matrix(); double[] y = measurementsM.Output; double[] y1 = inmea[0][0].Parameter() as double[]; double[,] ec = inmea[1][0].Parameter() as double[, ]; double[,] mc = inmea[2][0].Parameter() as double[, ]; for (int i = 0; i < y.Length; i++) { delta[i] = y1[i] - y[i]; } RealMatrix.KalmanFilter(state, delta, transition, partial, covariation, ec, mc, coefficient, partialTrans, partialPeer, errorCovariationPeer, errorCovariationPeerPlus, statePeer, covariationPeer, covariationPeerPlus); }