Программы для выполнения лаб 1 и 2 / KALMAN / SOURCE / SOURCE / W-DATA

#include "w-data.h"

const char *GraphicNames[MAX_MODE] = {
	"0 Коэффициет усиления К1",
	"1 Коэффициет усиления К2",
	"2 Ошибка наблюденния",
	"3 Ошибки фильтрации по Y",
	"4 Нормированные факт. ошибки Y",
	"5 Ошибки фильтрации по Y'",
	"6 Нормированные факт. ошибки Y'",
	"7 Состояние Y",
	"8 Состояние Y'"
};

FirstSetup FSSU8 = {
	"Вариант 8", KalmanFilter, 10, 0.2, 0.01, 0, 2, 100, EquNoise,
		-3.04, 13.2, 0, 20, 20, 0, 0, 10,
		0,
		0, 0, 0,
		EquNoise, EquNoise, EquNoise,
		32767, 0, 32767, 0, 0, 0,
		0, 0, 0,
		FALSE, TRUE, NULL
},				 FSSU7 = {
	"Вариант 7", KalmanFilter, 1, 0.02, 0.01, 0, 10, 100, EquNoise,
		-2.3, 51.0, 0, 50, 10, 0, 0, 10,
		0,
		0, 0, 0,
		EquNoise, EquNoise, EquNoise,
		32767, 0, 32767, 0, 0, 0,
		0, 0, 0,
		FALSE, TRUE, &FSSU8
},				 FSSU6 = {
	"Вариант 6", KalmanFilter, 1, 0.01, 0.005, 0, 3, 100, EquNoise,
		11.2, 12.8, 10, 20, 50, 5, 0, 10,
		0,
		0, 0, 0,
		EquNoise, EquNoise, EquNoise,
		32767, 0, 32767, 0, 0, 0,
		0, 0, 0,
		FALSE, TRUE, &FSSU7
},				 FSSU5 = {
	"Вариант 5", KalmanFilter, 1, 0.02, 0.0001, 0, 2, 100, EquNoise,
		-328.9, 88.6, -300, 100, 50, 0, 0, 20,
		0,
		0, 0, 0,
		EquNoise, EquNoise, EquNoise,
		32767, 0, 32767, 0, 0, 0,
		0, 0, 0,
		FALSE, TRUE, &FSSU6
},				 FSSU4 = {
	"Вариант 4", KalmanFilter, 1, 0.4, 0.0004, 0, 2, 100, EquNoise,
		-5.77, 47.2, 0, 50, 10, 0, 0, 5,
		0,
		0, 0, 0,
		EquNoise, EquNoise, EquNoise,
		32767, 0, 32767, 0, 0, 0,
		0, 0, 0,
		FALSE, TRUE, &FSSU5
},				 FSSU3 = {
	"Вариант 3", KalmanFilter, 10, 0.2, 0.0005, 0, 5, 100, EquNoise,
		-111.5, 94.3, -100, 100, 20, 0, 0, 10,
		0,
		0, 0, 0,
		EquNoise, EquNoise, EquNoise,
		32767, 0, 32767, 0, 0, 0,
		0, 0, 0,
		FALSE, TRUE, &FSSU4
},				 FSSU2 = {
	"Вариант 2", KalmanFilter, 5, 0.05, 0, 0, 3, 100, EquNoise,
		-5, 4.3, 0, 10, 10, 0, 0, 10,
		0,
		0, 0, 0,
		EquNoise, EquNoise, EquNoise,
		32767, 0, 32767, 0, 0, 0,
		0, 0, 0,
		FALSE, TRUE, &FSSU3
},				 FirstSetupStartUp = {
	"Вариант 1", KalmanFilter, 1, 0.005, 0, 0, 1, 100, EquNoise,
		-5, 8, 0, 10, 10, 0, 0, 3,
		0,
		0, 0, 0,
		EquNoise, EquNoise, EquNoise,
		32767, 0, 32767, 0, 0, 0,
		0, 0, 0,
		FALSE, TRUE, &FSSU2
};

FirstSetupList FirstSetupHistory;

FirstSetupList::FirstSetupList() :
	Root(&FirstSetupStartUp), result(SetupStopped)
{  }

FirstSetupList::~FirstSetupList()
{
	FirstSetup *p, *next;

	for (p = next = Root; next; p = next)
	{
		next = p->Next;
		delete p;
	}
}

void FirstSetupList::Insert()
{
	FirstSetup *p = Root;

	Root = new FirstSetup;
	Root->Next = p;
	Root->Complete = FALSE;

	Root->KOld = 1;

	Root->XI_IntervalRule = EquNoise;
	Root->XI_DurationRule = EquNoise;
	Root->XI_TypeRule = EquNoise;
	Root->XI_Interval_E = 32767;
	Root->XI_Interval_D = 0;
	Root->XI_Duration_E = 32767;
	Root->XI_Duration_D = 0;
	Root->XI_Type_E = 0;
	Root->XI_Type_D = 0;

	Root->Complete = FALSE;
	Root->Predefined = FALSE;
}

void FirstSetupList::Delete()
{
	if (Root)
	{
		FirstSetup *p = Root;

		Root = p->Next;
		delete p;
	}
}

TMatrix w_e(1, 1), w_y(1, 1), w_t(1, 1), w_k(1, 1), w_r(1, 1),
				w_ne(1, 1),
				TrueY(1, 2);
TMatrix w_j(2, 2);
TVector w_w(1);

unsigned HMagnify, VMagnify,
				 HShift, VShift;