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

Формула изобретения

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

Описание изобретения к патенту

Изобретение относится к области космической техники и может быть использовано для эффективного управления угловым положением космических аппаратов (КА).

Существует много систем осуществления программного разворота космического аппарата. В аналогичной системе управления программным разворотом КА в требуемое конечное угловое положение вращения КА осуществляется по назначенным траекториям согласно концепции управления по ускорению. Кинематические уравнения желаемого движения космического аппарата при развороте записываются через компоненты кватерниона

,

где: (t) кватернион, определяющий ориентацию связанных с КА осей относительно инерционного базиса;

_н = (o) кватернион начального положения КА;

_к = (T_зад) кватернион конечного положения КА (Крутько П.Д. Обратные задачи динамики управляемых систем М. Наука, 1988, с.168-178);

Символ ~ означает сопряженный кватернион, а обозначает операцию умножения кватернионов.

Функциональная схема системы аналога (фиг.1) содержит: 1 блок задания начального и конечного положения (БЗНКП), 2 блок задания моментов инерции (БЗМИ), 3 задатчик времени разворота (ЗВР), 4 бесплатформенную инерциальную навигационную систему (БИНС), 5 блок датчиков угловых скоростей (БДУС), 6 блок определения параметров разворотом (БОПР), 7 блок определения требуемой угловой скорости (БОТУС), 8 блок определения моментов управления (БОМУ).

В БИНС 4 по информации об угловой скорости непрерывно определяется фактическое угловое положение L(t) которое при сравнении с требуемым конечным угловым положением _к в БОПР 6 дает информацию N(t) о фазе процесса достижения требуемого положения. Вид назначенных траекторий движения КА содержит в качестве параметра время разворота Т_зад, информация о котором берется с ЗВР 3. По кватерниону рассогласования N относительно достижения цели управления _к и по информации об угловой скорости определяется желаемое изменение кватерниона N и соответственно, определяется угловая скорость для того, чтобы вращение КА проходило по назначенной траектории. Управляющие моменты определяются БОМУ 8 путем отслеживания требуемой угловой скорости с высокой прочностью. При многих достоинствах систем, построенных по принципу управления по ускорению, применительно к управлению программным разворотом КА отмеченная система обладает существенным недостатком назначенные траектории должны задаваться аналитически. Более того, не любая назначенная траектория может быть реализована фактически в силу ограниченности управляющих моментов возможностями системы исполнительных органов где m_o максимально возможная величина управляющего момента, развиваемого исполнительными органами.

Ближайшим аналогом изобретения является система (патент RU N 2006431, B 64 G 1/24, 1994).

Функциональная схема системы-прототипа (фиг.2) включает в себя:

1 блок задания начального и конечного положений (БЗНКП), 2 блок задания моментов инерции (БЗМИ), 3 задатчик времени разворота (ЗВР), 4 - бесплатформенная инерциональная навигационная система (БИНС), 5 блок датчиков угловых скоростей (БДУС), 6 блок определения параметров разворота (БОПР), 9 блок определения момента инерции вокруг поперечной оси (БОМИПО), 10 блок прогноза вектора разворота (БПВР), 11 блок определения направления разгонного импульса (БОНРИ), 12 блок формирования момента управления (БФМУ), 13 блок определения кинетического момента (БОКМ), 14 блок определения времени разгона (БОВР), 15 блок определения отклонения кинетического момента от расчетного (БООКМ), 16 блок формирования разгонного и тормозного импульсов (БФРТИ), 17 блок определения момента разгона (БОМР), 18 блок определения момента свободного вращения (БОМСВ), 19 блок определения момента торможения (БОМТ), 20 блок логики, 21 блок обновления параметров разворота (БОБПР), 22 блок определения промаха разворота (БОПрР), 23 блок коррекции параметров разворота (БКПР), 24 блок сравнения промаха разворота с заданной величиной (БОПР), 25 блок фиксации вектора разворота (БФВР), 26 блок определения направления тормозного импульса (БОНТИ), 27 блок определения направления разворота (БОНР), 28 задатчик команды на начало разворота (ЗКНР), 29 задатчик максимальной величины управляющего момента (ЗМВУМ), при этом выход задания начального положения БЗНКП связан с соответствующими входами БОПР, БОПрР и входом ввода параметров углового положения БОНРИ, выход задания конечного положения БЗНКП связан с соответствующим БОПР, БОПрР и входом ввода требуемого углового положения БКПР, первый выход КЗМИ связан с первым входом БОМИПО, первым параметрическим входом БОКМ и первым входом ввода момента инерции вокруг поперечной оси БОПрР, второй выход БЗМИ связан со вторым входом БОМИПО, вторым параметрическим входом БОКМ и вторым входом ввода момента инерции вокруг поперечной оси БОПРР, третий выход БЗМИ связан с третьим параметрическим входом БОКМ, с входами ввода момента инерции вокруг продольной оси БПВР и БОПрР, выход ЗВР связан с параметрическим входом БОМСВ и входами ввода времени разворота БОПрР и БОВР, выход БИНС связан с входами ввода параметров углового положения БФМУ и БОНТИ, выход БДУС связан с входом БИНС и информационным входом БОКМ, выход БОПР связан с входом задания начальных условий БОбПР, выход БОМИНО, связан с входом ввода момента инерции вокруг поперечной оси БПВР, входом ввода момента инерции БОВР и входом ввода усредненного момента инерции БОПрР, выход вектора разворота БПВР связан с соответствующими входами БОПрР, БФВР, выход угла разворота БПВР связан с соответствующими входами БОПрП и БФВР, вход ввода вектора разворота БОНРИ с соответствующим выходом БФВР, выход БОНРИ связан с первым векторным входом БОНР, вход ввода вектора разворота БФМУ связан с выходом БОНР, выход БМФМУ связан с выходами задания управляющего момента БООКМ и БФРТИ, выход БОКМ связан с информационными входами БООМ, БОМТ и БОНТИ, выход БОВР связан с параметрическим входом БООКМ, выход которого связан с информационным входом БОМСВ, первый выход БОМСВ связан с логическим входом БОМР, выход которого связан с входами разрешения разгона БФРТИ, блока логики и БОНР, второй выход БОМОВ связан с входом разрешения свободного движения блока логики, выход БОМТ связан с входом разрешения блока логики, выход которого связан с входами разрешения торможения БФРТИ, бонти БОНТИ и БОНР, выход БОбПР связан с входами задания параметров разворота БПВР и БКПР, выход которого связан с входом ввода новых параметров разворота БОбПР, выход прогнозируемого положения БОПрР связан с соответствующим входом БКПР, выход ошибки разворота БОПрП связан с одновременным входом БСПР, выход которого связан с логическими входами БОбПР и БФВР, выход угла разворота БФВР связан с одноименным входом БОВР, выход БОНТИ связан со вторым векторным входом БОНР, выход ЗКНР связан с времязадающими входами БОМР и БОМСВ, выход ЗМВУМ связан с параметрическими входами БФМУ и БОВР, выход БФРТИ является выходом системы.

Определяющими характеристиками процесса разворота являются время разгона (торможения) которое вычисляется по соотношению:



где I момент инерции КА вокруг поперечной оси;

угол процессии;

m_o величина максимального момента управления;

Т_раз время разворота.

Вектор разворота вычисляется в результате решения некоторого трансцендентного уравнения.

Работает система-прототип следующим образом.

Прежде всего определяется момент инерции вокруг поперечной оси блока 9. По начальному _н и конечному _к положениям в блоке 6 определяется кватернион разворота _р Согласно полученному _р и инерционным характеристикам I и I_Z блоком 10 выдается угол прецессии и направление кинетического момента в связанной системе координат. Далее в блоке 22 моделируется движение объекта в ускоренном масштабе времени в предположении, что ему сообщили кинетический момент в полученном направлении определяется величина промаха разворота и кватернион m(t_к) Пока < _доп фактическое угловое положение (t_к) полученное моделированием в блоке 22, сравнивается с требуемым _к и рассчитывается блоком 23 новый кватернион разворота, который через блок 21 поступает в качестве исходных данных в блок 10, рассчитывается новое направление и т.д. Процесс повторяется. Как только _доп блок 25 запоминает полученные в блоке 10 угол прецессии и направление кинетического момента Далее это направление пересчитывается блоком 11 в направление относительно инерционального базиса по формуле Запомненный угол прецессии служит исходным для определения времени разгона (торможения) t По фактическому угловому положению, определенному БИНС, определяется действующий момент по которому в блоке 15 вычисляют расчетный кинетический момент

В начальный момент времени

В момент скачка времязадающего сигнала t_разв 1 (поступила команда на разворот) появляется сигнал R 1 (разгон). Управляющий момент Блок 5 измеряет абсолютную угловую скорость и по данным oI вычисляется фактический кинетический момент в блоке 13, и разгон продолжается (R 1) до тех пор пока

В момент времени, когда объект предоставлен сам себе. По истечении расчетного времени сначала разворота формируется сигнал на торможение T 1, по которому блок 27 фиксирует направление вычисленное в блоке 28. Это направление сохраняется постоянным в инерционном пространстве. Блок 12 определяет момент Момент управления направлен против фактического кинетического момента и действует до полной остановки объекта Когда сигнал разворот окончен. Система готова к следующему развороту.

Недостатком системы-прототипа является то, что момент окончания разворота (момент полной остановки КА) может отличаться от заданного времени.

Техническим результатом изобретения является повышение точности управления по времени окончания разворота космического аппарата.

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

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

Суть изобретения можно пояснить следующим образом.

В предлагаемой системе управляющие моменты формируются только при разгоне и торможении объекта. В системе автоматически определяется такой требуемый импульс с кинетического момента сообщение которого корпуса КА гарантирует достижение через заданное время T_зад требуемого углового положения _доп с любой допустимой точностью как по положению _к так и по времени t

Отличительной особенностью системы является определение в ней поправки времени разворота, коррекции времени разворота и определение времени торможения. Расчет требуемого кинетического момента носит иттерационный характер и учитывает не только ошибку по угловому положению но и прогнозируемое время окончания разворота t_k.

Математическая модель вращательного движения твердого тела в поле тяготения Земли, которая входит в блок определения промаха разворота, описывается в предлагаемой системе той же системой уравнений, что и в системе-прототипе. Но в отличие от прототипа контролируются не только компоненты кватерниона, но и время, а по окончании прогноза углового движения аппарата наряду с прогнозируемым угловым положением и ошибкой по положению фиксируется время окончания разворота.

Направление считается найденным, когда и (в идеале 1 и T_k t_зад).

Наличие в системе блока определения поправки времени разворота, блока коррекции времени разворота и бока определения времени торможения делает ее существенно отличной от системы-прототипа.

Сущность изобретения поясняется чертежами, где на фиг.1 приведена функциональная схема системы-аналога; на фиг.2 функциональная схема системы-прототипа; на фиг. 3 функциональная схема предлагаемой системы; на фиг. 4 функциональная схема БОПрР (22); на фиг. 5 схема реализации БОПрР (22);

На фиг. 6 схема выполнения БОМСВ (18); на фиг. 7 схема выполнения блока логики; на фиг. 8 схема реализации БОбПР (21); на фиг. 9 схема реализации БСПР (24); на фиг. 10 схема реализации БОПВР (31); на фиг. 11 - схема реализации БОВТ (32); на фиг. 12 схема реализации БСВР (34); на фиг. 13 схема реализации БОВР (14); на фиг. 14 временные диаграммы процесса разворота КА.

Функциональная схема предлагаемой системы представлена на фиг.3 и 4, где 1 блок задания начального и конечного положений (БЗНКП), 2 блок задания моментов инерции (БЗМИ), 3 задатчик времени разворота (ЗВР), 4 - бесплатформенная инерциальная навигационная система (БИНС), 5 блок датчиков угловых скоростей (БДУС), 6 блок определения параметров разворота (БОПР), 9 блок определения момента инерции вокруг поперечной оси (БОМИПО), 10 блок прогноза вектора разворота (БПВР), 11 блок определения направления разгонного импульса (БОНРИ), 12 блок формирования момента управления (БФМУ), 13 блок определения кинетического момента (БОКМ), 14 блок определения времени разгона (БОВР), 15 блок определения отклонения кинетического момента от расчетного (БООКМ), 16 блок формирования разгонного и тормозного импульсов (БФРТИ), 17 блок определения момента разгона (БОМР), 18 блок определения момента свободного вращения (БОМСВ), 19 блок определения момента торможения (БОМТ), 20 блок логики, 21 блок обновления параметров разворота (БОбПР), 22 блок определения промаха разворота (БОПрР), 23 блок коррекции параметров разворота (БКПР), 24 блок сравнения промаха разворота с заданной величиной (БСПР), 25 блок фиксации вектора разворота (БФВР), 26 блок определения направления тормозного импульса (БОНТИ), 27 блок определения направления разворота (БОНР), 28 задатчик команд на начало разворота (ЗКНР), 31 блок определения поправки времени разворота (БОПВР), 30 блок коррекции времени разворота (БКВР), 29 задатчик максимальной величины управляющего момента (ЗМВУМ), 32 блок определения времени торможения (БОВТ), 33 - вычитающее устройство (БУ), 34 блок сравнения прогнозируемого времени разворота с заданной величиной (БСВР), 35 схема логического ИЛИ, 36 блок определения наличия вектора разворота (БОНВР), 37 блок моделирования движения аппарата (БМДА), 38 блок формирования управляющего сигнала (БФУС), 39 блок фиксации прогнозируемого положения (БФПП), 40 счетчик времени (СВ), при этом БОПрР состоит из БОНВР, БМДА, БФУС, БФПП и счетчика времени, причем выход БОНВР связан с управляющим входом БМДА выход которого связан с информационными входами БФУС и БФПП, вход задания начального положения БМДА является одноименным входом БОПрР, первый, второй и третий входы задания моментов инерции БМДА являются соответствующими взводами БОПрР, вход ввода угла разворота БМДА является одноименным входом БОПрР, вход ввода времени разворота БМДА является одноименным входом БОПрР, установочный вход БФУС является входом задания конечного положения БОПрР, управляющий выход БФУС является управляющим выходом БОПрР и связан с управляющим входом БФПП, выход промаха разворота БФУС связан с информационным входом БФПП, выходы которого являются выходами БОПрР, вход запуска счетчика времени связан с выходом БОНВР, вход останова счетчика времени связан с управляющим выходом БФУС, выход счетчика времени является выходом прогнозируемого времени разворота БОПрР, выход задания начального положения БЗНКП связан с соответствующим входом БОПР, БОПрР и входом ввода параметров углового положения БОНРИ, выход задания конечного положения БЗНКП связан с соответствующим входом БОПР, БОПрР и входом ввода требуемого углового положения БКПР.

Первый выход БЗМИ связан с первым входом БОМИПО, первым параметрическим входом БОКМ и первым входом ввода момента инерции вокруг поперечной оси БОПрР, второй выход БЗМИ связан со вторым входом БОМИПО, вторым параметрическим входом БОКМ и вторым входом ввода момента инерции вокруг поперечной оси БОПрР, третий выход БЗМИ связан с третьим параметрическим входом БОКМ, с входами ввода момента инерции вокруг продольной оси БПВР и БОПрР, выход задатчика времени разворота связан с входами задания времени разворота БОПВР, БКВР, БОВР и первым входом вычитающего устройства, выход БИНС связан с входами ввода параметров углового положения БФМУ и БОНТИ, выход БДУС связан с входом БИНС и информационным входом БОКМ, выход БОПР связан с входом задания начальных условий БОбПР, выход БОМИПО связан с входом ввода момента инерции вокруг поперечной оси БПВР, входом ввода момента инерции БОВР и входом ввода усредненного момента инерции БОПрР, выход вектора разворота БПВР связан с соответствующими входами БОПрР, БФВР, выход угла разворота БПБР связан с соответствующими входами БОПР, БФВР, вход ввода вектора разворота БОНРИ связан с соответствующим входом БФВР, выход БОНРИ связан с первым векторным входом БОНР, вход ввода разворота БФМУ связан с выходом БОНР, выход БФМУ связан с входами задания управляющего момента БООКМ и БФРТИ, выход БОКМ связан с информационными входами БООКМ, БОМТ, БОНТИ и БОВТ, выход БОВР связан с параметрическим входом БООКМ, выход которого связан с информационным входом БОМСВ, первый выход БОСМВ связан с логическим входом БОМР, выход которого связан с входами разрешения разгона БФРТИ, блока логики и БОНР, второй выход БОМСВ связан с входом разрешения свободного движения блока логики, выход БОМТ связан с входом разрешения блока логики, выход которого связан с входами разрешения торможения БФРТИ, БОНТИ, и БОНР, выход БОбПР связан с входами задания параметров разворота БПВР и БКПР, выход которого связан с входом ввода новых параметров разворота БОбПР, выход прогнозируемого положения блока определения промаха разворота связан с соответствующим входом БКПР, выход ошибки разворота БОПрР связан с одноименным входом БСПР, выход угла разворота БФВР связан с одноименным входом БОВР, выход БОНТИ связан со вторым векторным входом БОНР, выход задатчика команды на начало разворота связан с времязадающими входами БОМР и БОМСВ, выход задатчика максимальной величины управляющего момента связан с параметрическими входами БФМУ, БОВР и БОВТ, выход которого связан со вторым входом вычитающего устройства, управляющий выход БОПрР связан с управляющими входами БОбПр и БОПВР, выход времени окончания маневра БОПрР связан с одноименными входами БСВР и БОПВР, выход которого связан с входами ввода поправки по времени разворота БОПрР и БКВР, выход которого связан с входом ввода времени разворота БОВР, выход БОВР связан входом ввода времени разворота БОПрР, выход вычитающего устройства связан с параметрическим входом БОМСВ, первый вход схемы логического ИЛИ связан с выходом БСПР, второй вход схемы логического ИЛИ связан с выходом БСВР, выход схемы логического ИЛИ связан с логическими входами БОбПР и БФВР, выход БФРТИ является выходом системы.

Реализация отдельных блоков и элементов предлагаемой системы выполнены на интегральных схема и стандартных аналоговых модулях (фиг.4 13).

БОПР 6 вычисляет кватернион разворота по формуле и состоит из блока взятия сопряженного кватерниона и блока перемножения кватернионов.

БОМИПО 9 усредняет моменты инерции вокруг поперечных осей I_x и I_y по выражению I (I_x + I_y)/2

БПВР 10 как и в прототипе определяет вектор разворота и угол поворота КА вокруг него (угол прецессии), соответствующие развороту динамически симметричного тела с моментами инерции I, I_Z на кватернион L_р.

БОНРИ 11 реализует соотношение .

БФМУ 12 вычисляет потребный момент управления исходя из фактического углового положения и вектора разворота и реализует функцию .

БОКС 13 осуществляет умножение вектора на диагональную матрицу по выражению

БОВР 14 (фиг.13) вычисляет время разгона _р(1).

БОМСВ 18 (фиг.6) состоит из блока возведения вектора в квадрат, генератора линейно-изменяющегося напряжения (ГЛИН), двух компараторов 51 и 52, триггера и логических схем. При подаче на времязадающий вход сигнала разрешения на разворот (t_разв 1) изменяются и растет сигнал t на выходе ГЛИН, Так как то и поэтому на выходе компаратора 52 установлен логический 0, а продолжает быть. Поэтому cb 0. В момент, когда схема 51 устанавливает лог.0, по которому переключается триггер и а cb 1. По мере течения времени t, растет и в момент, когда t > T_{зад т} на выходе компаратора 52 установится: 1 и соответственно cb 0.

Блок логики выделяет команду на торможение Т из сигнала с БОМТ 19, исходя из наличия сигналов cb. и R. Он реализует логическую функцию где обозначено: операция ИСКЛЮЧАЮЩЕЕ ИЛИ, V операция ИЛИ.

БОбПР 21 (фиг.8) служит для смены значений параметров разворота по сигналу стробирования.

Блоки БООКМ 15, БФРТИ 16, БОМР 17, БОМТ 19, БКПР 23, БФВР 25, БОНТИ 26, БОНР 27 полностью идентичны соответствующим блокам системы-прототипа. А вот блок БОПрР 22 наделен дополнительными функциями и конструктивно выполнен по-новому.

БОПрР 22 представляет собой математическую модель вращательного движения твердого тела в гравитационном поле Земли (фиг. 5). Начальные условия определяются начальным положением и вектором разворота а также инерционными характеристиками I_x, I_y, I_z, углом разворота и временем разворота T_зад. Требуемую на начало участка свободного движения угловую скорость определяет блок 43 по вычислительной схеме (фиг.5).

БОПрР состоит из определителя наличия вектора разворота, который выдает импульс запуска интеграторов и схемы формирования гармонических функций 42. Блоком 44 вычисляется ориентация связанных осей относительно орбитальной системы координат L_от = _ор (t), из которой блок 45 определяет направляющие косинусы ₁; ₂; ₃ по известным соотношениям.

Блоки 47, 48 совместно с 44, 45, 48 образуют динамический контур математической модели. Блок 49 и интегратор моделируют кинематические уравнения. Блоки 46, 48 необходимые для формирования попарных произведений ₁₂; ₁₃; ₂₃ и ₁₂; ₁₃; ₂₃, которые входят в правые части динамических уравнений математической модели.

Блок 47 формирует угловое ускорение коэффициенты передачи по входам соответственно равны

(I_y-I_z)/I_x, (I_z-I_x)/I_y, (I_x-I_y)/I_z.

Таким образом, блоки 44, 45, 46 формируют гравитационные возмущения, блок 48 центробежные возмущения. Их сумма (суммирование производится поканально), умноженная на матрицу коэффициентов передачи (блок 47) и даст угловое ускорение которое после интегрирования с учетом начальных условий даст угловую скорость

Степень отдаленности моделируемого положения m от конечного L_к определяется блоками по выражению

.

В момент начала спада схемы хранения аналоговых сигналов фиксируют лучшие значения e и (t_к) а также прогнозируемое время окончания маневра t_к.

БСПР 24 представляет собой компаратор, сравнивающий выдаваемый БСПрР с допустимым значением e_доп задаваемым соответствующим задатчиком, и формирует лог.0, когда _доп (фиг.9).

БОНР 27 устанавливает на выходе либо направление разгонного импульса (если R 1), либо направление тормозного импульса (если T 1). Если оба логических сигнала отсутствуют R T 0, то на выходе БОНР устанавливается нулевой вектор

БКВР 30 производит деление заданного времени разворота T_зад на коэффициент временной поправки K_t; T_раз T_зад/K_t.

БОПВР 31 сравнивает прогнозируемое время разворота t_к, полученное в БОПрР 22, с заданным временем T_зад формирует и фиксирует поправку к времени разворота K_t согласно рекурентному соотношению



где предыдущее значение поправки (K⁽_t^o) = 1) (фиг.10).

ВБОВТ 32 определяет время торможения _т исходя из фактических кинематических параметров движения KA по выражению



Вычитающее устройство 33 производит вычитание сигнала _т поступающего на его второй вход, из сигнала первого входа T_зад, и устанавливает на своем выходе разность T_зад - _т

БОВР 34 сравнивает выдаваемое БОПрР прогнозируемое время окончания маневра t_к с заданным временем разворота T_зад и формирует логическую 1 пока (фиг.12).

Рассмотрим принцип действия и работу системы.

Прежде всего определяется момент инерции вокруг поперечной оси I БОМИПО 9. По начальному _н и конечному _к положениям в БОПР 6 определяется кватернион разворота _р Согласно полученному _р и инерционных характеристик I и I_z БПВР 10 выдается угол процессии и направление кинетического момента в связанной системе координат. Далее в БОПрР 22 моделируется движение объекта в ускоренном масштабе времени в предположении, что ему сообщили кинематический момент в полученном направлении и расчетной величины, определяется величина промаха разворота кватернион m(t_к) и прогнозируемое время окончания разворота t_к пока < _доп или фактическое угловое положение (t_к) полученное моделированием в БОПрР 22, сравнивается с требуемым _к и рассчитывается БКПР 23 новый кватернион разворота, который через БОбПР 21 поступает в качестве исходных данных в БПВР 10, рассчитывается новое направление БОПВР 31 сравнивает прогнозируемое время разворота t_к с заданной величиной T_зад и формирует поправку к времени разворота K_t и т.д. процесс повторяется.

Как только логический сигнал на выходе схемы ИЛИ пропадет и итерационный процесс, реализованный блоками 21, 10, 22, 23, 29 прекращается, БФВР 25 фиксирует полученные в БПВР 10 угол прецессии и направление кинетического момента Далее это направление пересчитывается БОНРИ 11 в направлении относительно инерциального базиса по формуле



Зафиксированный угол прецессии служит исходным для определения времени разгона t_р с учетом поправки K_t по фактическому угловому положению, определенному БИНС 4, определяется действующий момент по которому в БООКМ 15 вычисляется расчетный кинетический момент

Временные диаграммы процесса разворота представлены на фиг.14. В начальный момент времени В момент скачка t_разв 1 (поступила команда на разворот) появляется сигнал R 1 (разгон) и запускается счетчик времени в БОМСВ 18. Управляющий момент БДУС 5 измеряет абсолютную угловую скорость вычисляется фактический кинетический момент в БОКМ 13 и разгон продолжается (R 1) до тех пор, пока В момент времени, когда R 0 и объект предоставлен сам себе, БОВТ 32 определяет время необходимое для торможения KA _т БОМСВ 18 непрерывно сравнивает текущее время с начала разворота t с рассчитанной здесь же величиной T_зад-_т а в момент, когда t T_зад - _т формируется сигнал на торможение T 1, по которому БФВР 25 фиксирует направление вычисляемое в БОНТИ 26 по выражению



t_Т время начала торможения.

Это направление сохраняется постоянным в инерциальном пространстве, БФМУ 12 определяет момент Момент управления направлен против фактического кинетического момента и действует до полной остановки объекта Когда сигнал T 0 и t_разв= 0, разворот окончен. Система готова к следующему развороту.

Эффективность предлагаемой системы определяется прежде всего тем, что она учитывает требование терминальности управления (т.е. окончание поворотного маневра в строго назначенное время T_зад), что особенно важно в случае построения ориентации KA относительно подвижной системы координат (например, орбитальной системы координат).

Математическое моделирование работы предлагаемой системы на ПЭВМ позволяет оценить эту точность выполнения разворота по времени. Была проведена серия численных экспериментов, моделирующих процесс разворота KA с моментами инерции I_x 5385873 кгм², I_y 7158641 кгм², I_z 2274242 кгм². Для каждого разворота из серии были получены оценки точности окончания маневра, обеспечиваемые системой-прототипом и предлагаемой системой. Исходные данные для анализа сравниваемых систем (начальные и конечные угловые положения KA, время разворота, инерционные характеристики KA) были одинаковыми. Средняя угловая скорость при развороте считалась равной 0,2 о/с.

Для системы-прототипа ошибка по времени окончания разворота составила порядка 5-8% от времени разворота, а для предлагаемой системы эта ошибка не зависит от времени разворота и не превышает заданной величины Dt 0,5 с.