трами =-g0;% по осях X, Y, Z
% Початкові умови = 15;% помилка місця розташування по довготних каналу = 0.1;% швидкісна помилка по довготних каналу = 15;% помилка місцеположення по широтному каналу = 0.1;% швидкісна помилка по широтному каналу = 15; % помилка місцеположення по висотному каналу = 0.1;% швидкісна помилка по висотному каналу = 3.48e-4;% Кути похибки = 3.48e-4;% побудови = 3.48e-4;% базового 3-х гранника = 2.42e-8; % Проекції вектора інструментальних = 2.42e-8;% і методичних похибок вимірників кутовий = 2.42e-8;% швидкості на осі X, Y, Z = 0.005;% Похибки вимірювання = 0.005;% прискорення акселерометрами = 0.005;% по осях X , Y, Z
% Матриця динаміки системи (для випадку впливу через перехресні зв'язки вертикального каналу)
% A = [0 1 0 0 0 0 0 0 0 0 0 0 0 0 0;
% (OMy ^ 2 + OMz ^ 2-om0 ^ 2) 0 (dtOMz-OMx * OMy) 2 * OMz - (dtOMy + OMx * OMz) -2 * OMy 0-nz ny 1 0 0 0 0 0;
% 0 0 0 1 0 0 0 0 0 0 0 0 0 0 0;
% - (dtOMz + OMx * OMy) -2 * OMz (OMx ^ 2 + OMz ^ 2-om0 ^ 2) 0 (dtOMx-OMy * OMz) 2 * OMx nz 0-nx 0 1 0 0 0 0;
% 0 0 0 0 0 1 0 0 0 0 0 0 0 0 0;
% (dtOMy-OMx * OMz) 2 * OMy - (dtOMx + OMy * OMz) 2 * OMx (2 * om0 ^ 2 + OMx ^ 2 + OMy ^ 2) 0-ny nx 0 0 0 1 0 0 0;
% 0 0 0 0 0 0 0 OMz-OMy 0 0 0 1 0 0;
% 0 0 0 0 0 0-OMz 0 OMx 0 0 0 0 1 0;
% 0 0 0 0 0 0 OMy-OMx 0 0 0 0 0 0 1;
% 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0;
% 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0;
% 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0;
% 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0;
% 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0;
% 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0;];
% Матриця динаміки системи (для випадку відсутності впливу вертикального каналу) = [0 1 0 0 0 0 0 0 0 0 0 0 0 0 0;
(OMy ^ 2 + OMz ^ 2-om0 ^ 2) 0 (dtOMz-OMx * OMy) 2 * OMz - (dtOMy + OMx * OMz) -2 * OMy 0-nz ny 1 0 0 0 0 0;
0 0 1 0 0 0 0 0 0 0 0 0 0 0;
(dtOMz + OMx * OMy) -2 * OMz (OMx ^ 2 + OMz ^ 2-om0 ^ 2) 0 (dtOMx-OMy * OMz) 2 * OMx nz 0-nx 0 1 0 0 0 0;
0 0 0 1 0 0 0 0 0 0 0 0 0;
0 0 0 0 0 0 0 0 0 0 1 0 0 0;
0 0 0 0 0 0 OMz-OMy 0 0 0 1 0 0;
0 0 0 0 0-OMz 0 OMx 0 0 0 0 1 0;
0 0 0 0 0 OMy-OMx 0 0 0 0 0 0 1;
0 0 0 0 0 0 0 0 0 0 0 0 0 0;
0 0 0 0 0 0 0 0 0 0 0 0 0 0;
0 0 0 0 0 0 0 0 0 0 0 0 0 0;
0 0 0 0 0 0 0 0 0 0 0 0 0 0;
0 0 0 0 0 0 0 0 0 0 0 0 0 0;
0 0 0 0 0 0 0 0 0 0 0 0 0 0;];