На рис. 4.1 точками A, B, C, D, E показаны значения коэффициентов алгоритма оценки угловой скорости, используемые при моделировании. Численные значения коэффициентов при моделировании выбирались из различных участков (I, II, III) области устойчивости.

Рис. 4.1 - Значения коэффициентов алгоритма оценки угловой скорости

4.3 Алгоритм обработки и контроля информации ГИВУС

Включение ГИВУС производится в режиме ВКЛ.

В режиме ВКЛ после наступления тепловой готовности включаются все шесть ЧЭ ГИВУС. После достижения функциональной готовности (~22 мин с момента включения прибора) производится контроль работоспособности ЧЭ и в случае нормы два ЧЭ отключаются. Эти ЧЭ находятся в «горячем» резерве и в случае необходимости могут быть готовы к работе спустя 1 минуту [21].

Задача обработки и контроля информации ГИВУС состоит из следующих алгоритмов [1, 3, 21]:

1. Алгоритм начальной установки задачи ГИВУС.

2. Алгоритм выбора конфигурации включаемых каналов ГИВУС.

3. Алгоритм расчета приращений углов ГИВУС.

4. Алгоритм контроля и формирования признака информативности ГИВУС.

1. Алгоритм начальной установки задачи ГИВУС

Алгоритм рассчитывает матрицу С(6х3) установки шести ЧЭ в приборных осях:

Сi1 = cos(j+dji);

Ci2 = sin(j+dji)×cos((i-1)×q+dqi);

Ci3 = sin(j+dji)×sin((i-1)×q+dqi);

где j, q - углы установки ЧЭ в ПСК;

dji, dqi – погрешности углов установки (і = 1¸6).

Алгоритм также производит обнуление внутренних переменных задачи. По полетному заданию (ПЗ) (параметр IZGIV*) выбирается число включаемых в режиме ЧЭ [21]:

IZGIV*=2 - работа на 5 ЧЭ;

IZGIV*=1 - работа на 4 ЧЭ;

IZGIV*=0 - работа на 3 ЧЭ.

По ПЗ задается признак контроля Zcon:

Zcon = 0 – наличие контроля;

Zcon = 1 – отсутствие контроля.

Алгоритм разовый, работает на первом такте каждого режима.

2. Алгоритм выбора конфигурации включаемых каналов ГИВУС

Алгоритм работает на тех тактах режима, где происходит смена работающего комплекта чувствительных элементов (ЧЭ), функционально при возникновении отказа или по ПЗ [1, 3, 21].

Алгоритм состоит из трех частей, соответствующих трем состояниям признака работы IZGIV*=0V1V2.

При IZGIV*=2 алгоритм формирует пятерку работающих ЧЭ из числа исправных. Из этой пятерки выбирается ортогональная управляющая тройка ЧЭ для формирования матрицы управления В(3х3). Если номера работающих ЧЭ выбираются по ПЗ, то управляющей тройкой считаются первые три из заданных.

При IZGIV*=1 из числа исправных ЧЭ выбираются номера четырех ЧЭ: 3 из них считаются управляющими, а четвертый используется для контроля. Выбор четверки по ПЗ осуществляется аналогично случаю IZGIV*=2.

При IZGIV*=0 выбор работающих измерительных каналов осуществляется аналогично случаю работы на четырех ЧЭ, отличие состоит в том, что контрольный ЧЭ не формируется [21].

Алгоритм ЧЭ формирует запросы на включение ЧЭ IPVG(i)=1 после определения их номеров [21].

В результате формируется управляющая матрица В(3х3), используемая в расчетах проекций приращений углов на приборные оси. Для этого формируется вспомогательная матрица D(3х3), составленная из строк матрицы С(6х3), соответствующих номерам управляющих ЧЭ. Управляющая матрица рассчитывается следующим образом [21]:

B = D-1.

Алгоритм тактированный, работает с тактом То=0,1 с.

3. Алгоритм расчета приращений углов

Алгоритм формирует суммарные признаки функциональной и точностной готовности ГИВУС по признакам, приходящим из подсистемы. Осуществляет выбор диапазона измерений ГИВУС по признаку ППД, формируемому алгоритмами режимов [5 ,21].

Алгоритм формирует информацию о приращениях углов, измеренных каждым ЧЭ :