Алгоритм расчета ориентации

Алгоритм расчета ориентации

Структура алгоритма расчета ориентации была выбрана на основе калмановской теории фильтрации. Принцип работы алгоритма состоит в сравнении экстраполированных и измеренных значений угла.

Для расчета ориентации аппарата необходимыми ЦАП исходными измерениями являются углы кардана инерциальной стабилизированной платформы, которые выдаются каждые 0,1 сек. Чтобы выделить любые смещения углового ускорения, являющиеся следствием тяги посадочного ЖРД от углового ускорения, создаваемого ЖРД РСУ, в блок расчета ориентации необходимо ввести дополнительную информацию. Вводя информацию о работе ЖРД РСУ и информацию об управлении вектором тяги посадочного ЖРД, можно осуществить фильтрацию основных сигналов управления ориентацией, не прибегая к сложным цепям расчета угловой скорости и смещения углового ускорения.

Изменения угловых скоростей аппарата от действия ЖРД РСУ на интервале последнего управления рассчитываются по формулам

Смещение углового ускорения, происходящее вследствие команд на отклонение вектора тяги на интервале последнего управления, подсчитывается по уравнению

где T=0,1 сек период квантования; uq, ur – (+ 1,0—1) командные сигналы на поворот вектора тяги относительно осей Q и R.

Углы кардана инерциальной стабилизированной платформы, полученные в процессе предыдущего выполнения расчетов, хранятся в блоке памяти бортовой ЭЦВМ. Измерив углы кардана в данный момент, можно рассчитать изменение углов и перевести в изменение углов аппарата.

Разность между измеренным изменением ориентации и предсказанным изменением называется «необъяснимым» изменением ориентации. «Необъяснимое» изменение вычисляется и прибавляется к суммарному предыдущему «необъяснимому» изменению, образуя «необъяснимое» изменение ориентации в данный момент

где ?p, ?q, ?r – компоненты «необъяснимого» изменения ориентации по осям Р, Q, R.

Выражения в скобках в правой части уравнений (24.11) можно определить как компоненты предсказанного изменения ориентации. Заметим, что предсказанное изменение ориентации исключается вследствие команд на привод кардана ЖРД и точное выражение для изменения ориентации в результате работы ЖРД РСУ аппроксимируется более простым выражением.

«Необъяснимое» изменение ориентации используется для уточнения расчетов угловой скорости и углового ускорения аппарата. Но вначале логика используется, чтобы исключить измеренный квантованный шум. Вследствие того, что вероятное распределение этого шума не гауссовское, а прямоугольное, в каждой из осей (Р, Q, R) блока расчета ориентации шум может быть исключен нелинейным логическим фильтром.

Для каждой из осей Р, Q, R, если компонент «необъяснимого» изменения ориентации меньше, чем пороговая величина ?max=0,14 град, в этом случае коррекции смещения? ?? и ?? для расчетов угловой скорости и углового ускорения считаются нулевыми.

«Необъяснимое» изменение ориентации не обнуляется и когда «необъяснимое» изменение ориентации превышает пороговую величину, вводится коррекция. Нулевые коррекции ?? и ?? рассчитываются по уравнениям

После введения коррекции «необъяснимое» изменение ориентации для этой оси вновь устанавливается равным нулю.

Расчет угловой скорости и смещения углового ускорения теперь производятся по уравнениям

Заметим, что смещение углового ускорения вокруг оси Р принимается равным нулю и на последнем интервале управления не учитывается изменение угловой скорости вследствие отклонения кардана ЖРД.

На пассивных участках траектории полета аппарата считается, что компоненты смещения углового ускорения по осям Q и R равны нулю.

Динамические характеристики блока расчета ориентации сильно зависят от выбора коэффициентов усиления цепей фильтра К? и К?. Выбор этих коэффициентов основывается на компромиссе между быстротой расчета и исключением колебаний из-за плескания топлива.

Учитываемые алгоритмом расчета ориентации динамические эффекты: плескание топлива, изгибные колебания, силовое взаимодействие выхлопных струй ЖРД РСУ с конструкцией корабля, запаздывание тяги ЖРД РСУ по отношению к командам, эксцентриситет тяги ЖРД РСУ, ускорение выхлопных струй ЖРД РСУ при перемещениях по У и Z, не обнаруженные неисправности ЖРД РСУ, запаздывание сервомотора кардана ЖРД, разброс моментов инерции, упругие деформации сервопривода, точность модели измерения количества топлива в баках.