где уравнение (24.1) решается с периодом цикла управления траекторией полета (?Тc=Nj—Nj-1=2 сек), а уравнение (24.2)—с периодом цикла управления ориентацией (T=0,1 сек). Величина ?d задается угловой скоростью маневра, а величина ?j определяется как предполагаемое угловое ускорение от двух ЖРД РСУ. По окончании маневра величины ?d, ??d и ? обнуляются и система возвращается к режиму стабилизации вновь заданной ориентации.
Рис. 24.3. Блок-схема автоматического управления ориентацией лунного корабля на пассивных участках траектории полета.
Автоматическое управление аппаратом на активных участках траектории полета значительно сложнее, чем на пассивных. На активных участках к программе ЦАП управления ориентацией добавляются программа управления траекторией полета, программа вычисления массы корабля, в алгоритме оценки определяется угловое ускорение а; законы управления ЖРД РСУ видоизменяются таким образом, чтобы по оцененному значению углового ускорения ввести поправку в текущее значение эффективности управления; на участках снижения и посадки на Луну осуществляется управление величиной и направлением вектора тяги посадочного ЖРД, с учетом взаимодействия с ЖРД РСУ.
Масса корабля и тяга ЖРД рассчитываются ЦАП каждые 2 сек по уравнениям
Эти расчеты вводятся в цепь настройки ЦАП. Эффективность управления ЖРД РСУ относительно осей Р, Q, R рассчитывается по уравнению
где аj – угловое ускорение корабля; С1, С2, С3 – константы пропорциональные оставшейся массе.
Выбор констант С1, С2, С3 осуществляется для каждой оси и каждой конфигурации аппарата – посадочной и взлетной.
Таким образом подсчитанные величины ортогональных компонентов угловых ускорений ?qu и ?ru затем пересчитываются относительно оси V' для определения ?u'u. Вследствие инерциальной симметрии значения ?u'u можно использовать и для расчетов относительно оси V.
Эффективность сигнала управления вектором тяги посадочного ЖРД рассчитывается по уравнению
где ?q, ?r– изменение углового ускорения вследствие поворота тяги относительно осей Q и R; F– рассчитываются по уравнению (24.5); Iq и Ir – величины, обратно пропорциональные ?qu и ?ru; L – определяется по уравнению
Рис. 24.4. Блок-схема автоматического управления лунным кораблем на активных участках полета при посадке на Луну
На рис. 24.4 изображена блок-схема автоматического управления аппаратом на активных участках траектории полета при посадке на Луну.
Алгоритм расчета ориентации
Структура алгоритма расчета ориентации была выбрана на основе калмановской теории фильтрации. Принцип работы алгоритма состоит в сравнении экстраполированных и измеренных значений угла.
Для расчета ориентации аппарата необходимыми ЦАП исходными измерениями являются углы кардана инерциальной стабилизированной платформы, которые выдаются каждые 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, не обнаруженные неисправности ЖРД РСУ, запаздывание сервомотора кардана ЖРД, разброс моментов инерции, упругие деформации сервопривода, точность модели измерения количества топлива в баках.
