private void Calc()
{
CM = new CovarianceMatrix(ref ID);
FF = new FormingFilter(ref ID);
KF = new KalmanFilter(ref ID, ref FF);
}
public Controller()
{
FF = new FormingFilter(3, 5000, 0.01, 11.427, 3.464, 0.286, 4.414);
CM = new Covariance(3, 5000, 1.621, 0.542, 1.732, 2.903, 1.973, 0.01, 11.427, 3.464, 0.286, 4.414);
KF = new KalmanFilter(3, 5000, FF.OutputSignal, CM);
}
