RU2597015C1 - System for controlling spatial orientation of spacecraft using gimballess orbital gyrocompass - Google Patents
System for controlling spatial orientation of spacecraft using gimballess orbital gyrocompass Download PDFInfo
- Publication number
- RU2597015C1 RU2597015C1 RU2015109451/28A RU2015109451A RU2597015C1 RU 2597015 C1 RU2597015 C1 RU 2597015C1 RU 2015109451/28 A RU2015109451/28 A RU 2015109451/28A RU 2015109451 A RU2015109451 A RU 2015109451A RU 2597015 C1 RU2597015 C1 RU 2597015C1
- Authority
- RU
- Russia
- Prior art keywords
- inputs
- spacecraft
- pitch
- roll
- outputs
- Prior art date
Links
Images
Landscapes
- Navigation (AREA)
Abstract
Description
Изобретение относится к области космической техники, а точнее к системам управления угловым положением космических аппаратов (КА), в которых для построения орбитальной системы координат (ОСК) применяются бесплатформенные орбитальные гирокомпасы (БОГК). Назначение изобретения - обеспечение космическому аппарату свободы программных поворотов одновременно по каналам курса, тангажа и крена относительно ОСК без нарушения в процессе совершения программных поворотов режима орбитального гирокомпасирования, реализуемого БОГК.The invention relates to the field of space technology, and more specifically to systems for controlling the angular position of spacecraft (SC), in which strapdown orbital gyrocompasses (BOGK) are used to construct the orbital coordinate system (OSK). The purpose of the invention is to provide the spacecraft with freedom of programmatic turns along the heading, pitch and roll channels relative to the OSK without violating the orbital gyrocompassing mode implemented by the BOGK during programmatic turns.
В системах управления угловым положением орбитальных КА бесплатформенные орбитальные гирокомпасы нашли широкое применение, т.к. имеют простую структуру, обладают автономностью, удобны при восстановлении ориентации КА.In control systems for the angular position of orbital spacecraft, strapdown orbital gyrocompasses are widely used, because have a simple structure, have autonomy, are convenient when restoring the orientation of the spacecraft.
Уравнения движения, описывающие работу классического орбитального гирокомпаса (ОГК), имеют вид:The equations of motion describing the operation of the classical orbital gyrocompass (OGK) have the form:
где γ, Ψ, ϑ - малые углы ориентации связанных осей КА относительно ОСК по крену, курсу и тангажу;where γ, Ψ, ϑ - small angles of orientation of the associated axes of the spacecraft relative to the OSK roll, heading and pitch;
β,
Δβ, Δθ - сигналы обратных связей, они же выходные сигналы ОГК в систему стабилизации (СС) КА по углу в каналах крена и тангажа, они же ошибки стабилизации по углу в каналах крена и тангажа;Δβ, Δθ - feedback signals, they are the output signals of the OGKs to the spacecraft stabilization system (SS) in the angle in the roll and pitch channels, they are the stabilization errors in the angle in the roll and pitch channels;
γПМВ, ϑПМВ - выходные сигналы построителя местной вертикали (ПМВ) по крену и тангажу;γ PMV , ϑ PMV - output signals of the local vertical builder (PMV) for roll and pitch;
Δα - выходной сигнал ОГК стабилизации КА по углу в канале курса;Δα is the output signal of the OGK stabilization of the spacecraft in the angle in the channel
к1, к2, к3 - коэффициенты коррекции.to 1 , to 2 , to 3 - correction factors.
ОГК описан во многих источниках, например, в книге «Орбитальное гирокомпасирование» авторов В.А. Бесекерского, В.А. Иванова и Б.Б. Самотокина. СПб.: Политехника, 1993. 256 с.OGK is described in many sources, for example, in the book Orbital Gyrocompassing by V.A. Besekersky, V.A. Ivanova and B. B. Samotokina. St. Petersburg: Polytechnic, 1993.256 s.
В составе современных систем управления КА применяются бесплатформенные орбитальные гирокомпасы - БОГК, для практической реализации которых используют обращенные формулы, получаемые из (1):As part of modern spacecraft control systems, strapdown orbital gyrocompasses - BOGK are used, for the practical implementation of which the inverse formulas obtained from (1) are used:
где ωX, ωY, ωZ - угловые скорости КА относительно инерциальной системы координат (ИСК) в проекциях на связанные оси КА по крену, курсу и тангажу, измеряемые гироскопическими датчиками;where ω X , ω Y , ω Z are the angular velocity of the spacecraft relative to the inertial coordinate system (CSI) in the projections on the connected axis of the spacecraft along the roll, course and pitch, measured by gyroscopic sensors;
Δβ,
БОГК работает совместно с системой угловой стабилизации КА, в качестве исполнительных органов в которой могут быть использованы двигатели-маховики, гиродины, реактивные сопла и др., с настройками контура стабилизации КА по углу и угловой скорости:BOGK works in conjunction with the spacecraft angular stabilization system, in which the flywheel engines, gyrodynes, jet nozzles, etc. can be used as executive bodies, with the spacecraft stabilization loop settings for angle and angular velocity:
где τX, τY, τZ - сигналы (значения управляющих моментов), поступающие на исполнительные органы КА, например на маховики;where τ X, τ Y, τ Z - signals (values of the control points) arriving at the spacecraft actuators, such as flywheels;
кβ,
Формулы (1-2) работоспособны только для малых отклонений связанных осей КА и приборных осей БОГК относительно ОСК, для которых справедливы значения угловых скоростей:Formulas (1-2) are valid only for small deviations of the associated axes of the spacecraft and the instrument axes of the BOGK relative to the OSK, for which the values of angular velocities are valid:
где γ,
поэтому для систем такого типа пространственные программные повороты КА невозможны без нарушения режима гирокомпасирования и потери устойчивого управления угловым положением КА. Иногда уравнения (2) называют наблюдателем ОГК.therefore, for systems of this type, spatial programmatic rotations of the spacecraft are impossible without violating the gyrocompassing mode and losing stable control of the angular position of the spacecraft. Equations (2) are sometimes called the WGC observer.
Система управления КА с использованием БОГК, имеющим алгоритм в форме (2), описана также во многих зарубежных аналогах, например, в работе авторов А. Брайсона и В. Кортюма «Вычисление местного углового положения орбитального космического аппарата». Труды III Международного симпозиума ИФАК по автоматическому управлению в мирном использовании космического пространства. Управление в космосе т. 2, с. 83-105, Москва, «Наука», 1972 г.The spacecraft control system using BOGK, which has an algorithm in the form (2), is also described in many foreign counterparts, for example, in the work of the authors A. Bryson and V. Kortyum “Calculation of the local angular position of an orbiting spacecraft”. Proceedings of the III IFAC International Symposium on Automatic Control in the Peaceful Uses of Outer Space. Management in space vol. 2, p. 83-105, Moscow, “Science”, 1972
Недостатком указанных систем является запрет на программные повороты КА относительно ОСК на углы курса, тангажа и крена.The disadvantage of these systems is the ban on software turns of the spacecraft relative to the USC at heading, pitch and roll angles.
За прототип можно принять систему управления угловым положением КА, предложенную в патенте РФ №2509690 от 20.03.2014 г., в которой реализовано устройство, позволяющее вращать КА на неограниченные программные углы по курсу, сохраняя при этом режим гирокомпасирования. Недостатком этой системы является принципиальное отсутствие возможности программных поворотов КА одновременно по другим каналам ориентации - крену и тангажу с сохранением устойчивого режима гирокомпасирования.As a prototype, we can take the spacecraft angular position control system proposed in RF patent No. 2509690 of March 20, 2014, which implements a device that allows the spacecraft to rotate at unlimited programmed angles at the heading, while maintaining gyrocompassing mode. The disadvantage of this system is the fundamental lack of the ability to program spacecraft rotations simultaneously through other orientation channels - roll and pitch while maintaining a stable gyrocompassing mode.
Целью изобретения является устранение указных недостатков, т.е. создание такой системы управления угловым положением КА, которая обеспечивает КА свободу программных поворотов одновременно по каналам курса, тангажа и крена относительно ОСК и сохраняет при этом устойчивую работу БОГК в режиме гирокомпасирования, а следовательно, устойчивое управление программным угловым положением КА в целом.The aim of the invention is to remedy these disadvantages, i.e. the creation of such a spacecraft angular position control system that provides the spacecraft with freedom of programmatic turns along the heading, pitch and roll channels relative to the OSK and at the same time maintains the stable operation of the BOGK in the gyrocompassing mode, and therefore, the stable control of the spacecraft's programmatic angular position as a whole.
Для достижения поставленной цели в известное техническое решение, содержащее ПМВ, выход которого по крену подключен к последовательно соединенным первому сумматору, первому модулю усиления и преобразования (МУП), второму сумматору, третьему сумматору, первому интегратору, первому модулю настройки стабилизации КА по углу в канале крена (МНК-У) и четвертому сумматору, выход которого является входом исполнительных органов (ИО) КА в канале крена.To achieve this goal, in a well-known technical solution containing PMV, the output of which is tilted to the first adder, the first amplification and conversion module (MUP), the second adder, the third adder, the first integrator, the first module for adjusting the spacecraft stabilization by the angle in the channel roll (MNK-U) and the fourth adder, the output of which is the input of the executive bodies (IO) of the spacecraft in the roll channel.
Содержащее в канале курса последовательно соединенные тот же первый сумматор, второй МУП, пятый сумматор, шестой сумматор, второй интегратор, второй модуль настройки стабилизации КА по углу в канале курса-рыскания (МНР-У), седьмой сумматор, выход которого является входом ИО КА в канале курса.The first adder, the second CBM, the fifth adder, the sixth adder, the second integrator, the second KA stabilization module for the angle in the yaw channel (MNR-U), the seventh adder, the output of which is the input of the IO KA, which is sequentially connected in the course channel in the course channel.
Содержащее в канале тангажа ПМВ, выход которого по тангажу подключен к последовательно соединенным восьмому сумматору, третьему МУП, девятому сумматору, третьему интегратору, третьему модулю настройки стабилизации КА по углу в канале тангажа (МНТ-У), десятому сумматору, выход которого является входом ИО КА в канале тангажа.The PMV containing the pitch channel in the pitch channel, the pitch output of which is connected to the eighth adder, the third CBM, the ninth adder, the third integrator, the third spacecraft stabilization tuning module by the angle in the pitch channel (MNT-U), the tenth adder, the output of which is the IO input SC in the pitch channel.
Содержащее модули настройки контура стабилизации КА по угловой скорости МНК-С, МНР-С, МНТ-С по соответственным каналам крена, курса-рыскания и тангажа, входы которых подключены к выходам соответственно третьего, шестого и девятого сумматоров, а выходы подключены ко вторым входам соответственно четвертого, седьмого и десятого сумматоров.Containing modules for adjusting the stabilization loop of the spacecraft according to the angular velocity of MNK-S, MNR-S, MNT-S through the corresponding roll, yaw and pitch channels, the inputs of which are connected to the outputs of the third, sixth and ninth adders, respectively, and the outputs are connected to the second inputs respectively, the fourth, seventh and tenth adders.
Содержащее первый и второй модули компенсации взаимовлияний каналов (МКВК), входы которых подключены к выходам первого и второго интеграторов соответственно, а выходы подключены к вторым входам соответственно шестого и третьего сумматоров.Containing the first and second modules for compensation of channel interference (ICWC), the inputs of which are connected to the outputs of the first and second integrators, respectively, and the outputs are connected to the second inputs of the sixth and third adders, respectively.
Содержащее блок гироскопических измерителей угловых скоростей (БИУС), выходы которого по каналам крена, курса и тангажа подключены ко вторым входам соответственно второго, пятого и девятого сумматоров.Containing a block of gyroscopic angular velocity meters (CIUS), the outputs of which are connected to the second inputs of the second, fifth, and ninth adders through the roll, heading, and pitch channels, respectively.
Для достижения поставленной цели в известное техническое решение введены новые функциональные элементы и связи.To achieve this goal in the well-known technical solution introduced new functional elements and relationships.
В выходные цепи ПМВ по крену и тангажу введен модуль контроля ориентации (МКО) с функцией преобразования сигналов:An orientation control module (MCO) with a signal conversion function has been introduced into the PMV roll and pitch output circuits with a signal conversion function:
где γПМВ, ϑПМВ - сигналы ПМВ по крену и тангажу в программной системе координат (ПСК);where γ ПМВ , ϑ ПМВ - signals ПМВ along roll and pitch in the program coordinate system (UCS);
λ, µ, ε - углы программных поворотов КА относительно ОСК соответственно по курсу, тангажу и крену,λ, µ, ε are the angles of the programmed turns of the spacecraft relative to the OSK, respectively, in the course, pitch and roll,
при этом первый и второй входы МОК по крену и тангажу подключены к соответственным выходам ПМВ, а выходы МОК по крену и тангажу подключены к входам первого и восьмого сумматоров соответственно.the first and second IOC roll and pitch inputs are connected to the corresponding PMV outputs, and the IOC roll and pitch outputs are connected to the inputs of the first and eighth adders, respectively.
В выходные цепи первого, второго и третьего интеграторов введен первый модуль прямого преобразования (МПП) углов стабилизации КА, первый, второй и третий входы которого подключены к выходам первого, второго и третьего интеграторов соответственно, а выходы подключены к входам соответственно МНК-У, МНР-У и МНТ-У и выполняющий функцию:The first direct conversion module (MPM) of the stabilization angles of the spacecraft is introduced into the output circuits of the first, second, and third integrators, the first, second, and third inputs of which are connected to the outputs of the first, second, and third integrators, respectively, and the outputs are connected to the inputs of MNK-U, MNR, respectively -U and MNT-U and performing the function:
для последовательности поворотов λ, µ, ε.for the sequence of rotations λ, µ, ε.
Второй МПП угловых скоростей стабилизации КА введен в выходные цепи третьего, шестого и девятого сумматоров так, что его первый, второй и третий входы подключены соответственно к выходам третьего, шестого и девятого сумматоров, а его выходы по каналам крена, курса и тангажа подключены к первым входам вновь введенных одиннадцатого, двенадцатого и тринадцатого сумматоров соответственно, выходы которых подключены к входам соответственно МНК-С, МНР-С и МНТ-С, при этом второй МПП повторяет функцию первого МПП.The second MPP of the spacecraft stabilization angular velocity is introduced into the output circuits of the third, sixth, and ninth adders so that its first, second, and third inputs are connected to the outputs of the third, sixth, and ninth adders, respectively, and its outputs are connected to the first by the roll, course, and pitch channels the inputs of the newly introduced eleventh, twelfth and thirteenth adders, respectively, whose outputs are connected to the inputs of MNK-S, MHP-S and MNT-S, respectively, while the second MPP repeats the function of the first MPP.
В выходные цепи БИУС введены четырнадцатый, пятнадцатый и шестнадцатый сумматоры, входы которых подключены к выходам БИУС соответственно по каналам крена, курса и тангажа, и модуль обратного преобразования (МОП), входы которого соединены с соответственными выходами четырнадцатого, пятнадцатого и шестнадцатого сумматоров, а его выходы соединены с входами соответственно второго, пятого и девятого сумматоров, при этом МОП выполняет функцию ВТ, где т - знак транспонирования.The fourteenth, fifteenth, and sixteenth adders are introduced into the output circuits of the BIUS, the inputs of which are connected to the outputs of the BIUS, respectively, through the roll, course, and pitch channels, and the inverse transformation module (MOS), whose inputs are connected to the corresponding outputs of the fourteenth, fifteenth, and sixteenth adders, and its the outputs are connected to the inputs of the second, fifth and ninth adders, respectively, while the MOSFET performs the function B T , where m is the transpose sign.
В систему введены также блок задания программных движений (БЗПД) и модуль расчета программных движений (МРПД), вход которого подключен к выходу БЗПД, а первый, второй и третий выходы МРПД, соответствующие программных угловым скоростям КА по крену, курсу и тангажу, подключены соответственно ко вторым входам четырнадцатого, пятнадцатого и шестнадцатого сумматоров и одновременно ко вторым входам соответственно одиннадцатого, двенадцатого и тринадцатого сумматоров. Четвертый, пятый и шестой выходы МРПД, соответствующие программным углам поворота КА соответственно по крену, курсу и тангажу, подключены поканально к четвертым, пятым и шестым входам МОП, первого и второго МПП, а так же к третьему, четвертому и пятому входам МКО, а седьмой выход МРПД подключен к третьему входу девятого сумматора и вторым входам первого и второго МКВК.A program motion assignment block (BACA) and a program motion calculation module (MRL) are also introduced into the system, the input of which is connected to the BZAP output, and the first, second, and third MRPD outputs corresponding to the spacecraft angular speeds in roll, course, and pitch are connected, respectively to the second inputs of the fourteenth, fifteenth and sixteenth adders and simultaneously to the second inputs of the eleventh, twelfth and thirteenth adders respectively. The fourth, fifth and sixth MRPD outputs, corresponding to the programmed angles of rotation of the spacecraft, respectively, in roll, course and pitch, are connected channel-by-channel to the fourth, fifth and sixth inputs of the MOSFET, the first and second MPP, as well as to the third, fourth and fifth inputs of the MCO, and the seventh output of the MRPD is connected to the third input of the ninth adder and the second inputs of the first and second ICWC.
Ниже приведен пример практической реализации предложения.The following is an example of a practical implementation of the proposal.
На фиг. 1 показано:In FIG. 1 shows:
1 - ПМВ;1 - PMV;
2 - БИУС;2 - CIUS;
3-20 - сумматоры;3-20 - adders;
21 - МКО;21 - MCO;
22 - МОП;22 - MOS;
23-22 - МПП;23-22 - MPP;
25-27 - МУП;25-27 - municipal unitary enterprise;
28-30 - интеграторы;28-30 - integrators;
31-32 - МКВК;31-32 - ICWC;
34-35 - МНК-У, МНР-У, МНТ-У;34-35 - MNK-U, MNR-U, MNT-U;
36-38 - МНК-С, МНР-С, МНТ-С;36-38 - MNK-S, MHP-S, MNT-S;
39 - БЗПД;39 - BZPD;
40 - МРПД;40 - MRPD;
ИО - исполнительные органы;IO - executive bodies;
Δβ,
ΔβП, ΔαП, ΔθП - выходные сигналы первого МПП 23 в систему стабилизации КА по углам в каналах крена, курса и тангажа;Δβ P , Δα P , Δθ P - output signals of the
ωX, ωY, ωZ - угловые скорости КА относительно инерциальной системы координат (ИСК) в проекциях на связанные оси КА по крену, курсу и тангажу, измеряемые гироскопическими датчиками;ω X , ω Y , ω Z - angular velocity of the spacecraft relative to the inertial coordinate system (CSI) in the projections on the connected axis of the spacecraft in roll, course and pitch, measured by gyroscopic sensors;
ωXo, ωYo, ωZo - угловые скорости «виртуального» КА относительно инерциальной системы координат (ИСК) в проекциях на связанные оси «виртуального» КА по крену, курсу и тангажу, формируемые МОП 22;ω Xo , ω Yo , ω Zo are the angular velocities of the “virtual” spacecraft relative to the inertial coordinate system (CSI) in the projections onto the connected axes of the “virtual” spacecraft according to the roll, course, and pitch, formed by
ωXП, ωYП, ωZП - значения программных угловых скоростей КА относительно ИСК в проекциях на связанные оси, формируемые МРПД;ω XП , ω YП , ω ZП - the values of the program angular velocity of the spacecraft relative to the ISK in the projections on the connected axes formed by the MPD;
γПМВ, ϑПМВ - сигналы ПМВ по крену и тангажу в ПСК; PMA γ, θ PMA - PMA signals roll and pitch in the CPM;
λ,
λЗ,
к1, к2, к3 - коэффициенты коррекции БОГК, реализуемые первым, вторым и третьим МУП соответственно.to 1 , to 2 , to 3 - correction coefficients BOGK, implemented by the first, second and third CBM, respectively.
На фиг. 2, 3, 4 приведены графики программных поворотов КА по крену (фиг. 2), курсу (фиг. 3) и тангажу (фиг. 4) на равные углы 15°, на которых обозначено:In FIG. 2, 3, 4 are graphs of the spacecraft program turns in roll (Fig. 2), heading (Fig. 3) and pitch (Fig. 4) at equal angles of 15 °, which indicate:
γ, ψ, ϑ - угловое положение КА относительно ОСК в процессе программных поворотов (нарастание углов) и после их завершения (полочки);γ, ψ, ϑ - the angular position of the spacecraft relative to the OSK during program turns (increase in angles) and after their completion (shelves);
ωX, ωY, ωZ - угловые скорости КА по крену, курсу и тангажу соответственно относительно ИСК в проекции на связанные оси;ω X , ω Y , ω Z are the angular velocity of the spacecraft along the roll, course and pitch, respectively, relative to the CSI in the projection on the connected axes;
ωXO, ωYO, ωZO - угловые скорости «виртуального» КА по крену, курсу и тангажу соответственно относительно ИСК в проекции на связанные оси «виртуального» КА;ω XO , ω YO , ω ZO are the angular velocities of the “virtual” spacecraft according to the roll, course and pitch, respectively, relative to the CSI in the projection onto the connected axes of the “virtual” spacecraft;
На фиг. 5 показаны переходные процессы выполняемых одновременно программных поворотов КА на разные значения углов. Обозначения на фиг. 5 соответствуют обозначениям фиг. 2-4.In FIG. Figure 5 shows the transients of simultaneously executed spacecraft rotations by different angles. The notation in FIG. 5 correspond to the notation of FIG. 2-4.
На фиг. 6 показан пример реализации системы управления КА для программного поворота КА по курсу (в примере на 90°) при нулевых значениях программных поворотов по крену и тангажу. На фиг. 6 для наглядности сохранены все обозначения фиг. 1, только программный угол по курсу λ обозначен как ψПР, а программная скорость по курсу
На фиг. 7 показаны графики переходных процессов для программного поворота по курсу при нулевых значениях программных поворотов по крену и тангажу. Обозначения на фиг. 7 соответствуют обозначениям фиг. 2-4.In FIG. Figure 7 shows the transient graphs for the programmed course turn at zero values of the programmed roll and pitch turns. The notation in FIG. 7 correspond to the notation of FIG. 2-4.
Идея изобретения заключается в том, что в процессе поворота КА на заданные программные углы λЗ, µЗ, εЗ с заданными программными угловыми скоростями
В соответствии с фиг. 1 уравнения движения системы управления угловым движением КА имеют вид:In accordance with FIG. 1 equations of motion of the spacecraft angular motion control system have the form:
уравнения (8) полностью соответствуют уравнениям (2) классического БОГК, где:equations (8) fully correspond to equations (2) of the classical BOGK, where:
где Where
Е - единичная матрицаE is the identity matrix
где τХП, τYП, τZП - моменты управления угловым движением КА по связанным осям крена, курса и тангажа соответственно, реализуемые ИО, например двигателями-маховиками.where τ ХП , τ YП , τ ZП - moments of control of the angular motion of the spacecraft along the associated axes of the roll, course and pitch, respectively, realized by IO, for example, flywheel engines.
Программные повороты начинаются с расчета программных движений λ,
Введение программного управления по скорости позволяет добиться почти идеального качества переходного процесса в каждом канале управления (см. фиг. 2-5, 7), но можно обойтись программным управлением только по углу, положив
В МРПД производится расчет программных углов и программных скоростей:In the MRPD, the calculation of program angles and program speeds is performed:
- время поворотов по осям: - axis rotation time:
- текущие значения программных углов:- current values of program angles:
- текущие значения программных угловых скоростей
Программный поворот КА осуществляется за счет:Software rotation of the spacecraft is carried out due to:
- введения в сигналы ПМВ угловых смещений на величины программных улов ε, µ и пересчета полученных разностей (γПМВ-ε) и (ϑПМВ-µ) из ПСК в ОСК с учетом программного поворота КА по курсу на величину программного угла λ. Это осуществляется в МКО 9, который по окончании переходного процесса точно контролирует положение КА относительно ОСК;- introducing angular displacements into the PMW signals by the values of the program catch ε, μ and recalculating the obtained differences (γ PMV -ε) and (ϑ PMV -µ) from the UCS to the USC taking into account the programmed rotation of the spacecraft along the course by the value of the program angle λ. This is carried out in MCO 9, which at the end of the transition process precisely controls the position of the spacecraft relative to the USC;
- введения программных угловых скоростей (11) в сигналы стабилизации КА по скорости
Чтобы сохранить исходную работу БОГК в соответствии с (2) сами параметры стабилизации ΔβП,
В процессе программного поворота в выходных сигналах БИУС появляются программные скорости движения КА - ωXП, ωYП, ωZП. Они компенсируются на сумматорах 12-14, т.к. «мешают» нормальному функционированию БОГК в режиме (2). После этого разностные сигналы, пересчитываются в МОП 22 в малые скорости ωXo, ωYo, ωZo «виртуального» КА относительно ОСК, что полностью удовлетворяет работе БОГК (2) и соотношениям (4).In the process of a program turn, the spacecraft program speeds — ω XП , ω YП , ω ZП — appear in the output signals of the CIUS . They are compensated on the adders 12-14, because “Interfere” with the normal functioning of BOGK in mode (2). After that, the difference signals are recalculated in
На фиг. 2-4 показаны результаты моделирования движения КА на равные программные углы и с одинаковой программной угловой скоростью по всем каналам:In FIG. Figure 2-4 shows the results of modeling the motion of the spacecraft at equal program angles and with the same program angular velocity across all channels:
В МРПД 40 рассчитаем параметры программных поворотов:In
- время поворотов в каждом канале одинаковое: - the turn time in each channel is the same:
- программные углы в течение времени программного поворота:- program angles during the program rotation time:
На графиках сверху вниз показаны углы ориентации КА относительно ОСК, угловые скорости КА относительно ИСК в проекциях на собственные оси и угловые скорости «виртуального» КА относительно ИСК в проекциях на собственные оси. Программный поворот совершается за расчетное время, после этого имеет место небольшое перерегулирование, после завершения переходного процесса ориентация КА точно контролируется МКО 21 в положениях +15° по каждому каналу.The top-down graphs show the orientation angles of the spacecraft with respect to the CCS, the angular speeds of the spacecraft with respect to the CSI in projections onto its own axes and the angular velocities of the “virtual” spacecraft with respect to the CSI in projections on its own axes. A program turn takes place in the estimated time, after which there is a slight overshoot, after the transition process is completed, the orientation of the spacecraft is precisely controlled by the
На фиг. 5 продемонстрированно программное движение КА одновременно по курсу на -170°, по крену на +20°, по тангажу на -30° с одинаковой скоростью по каналам 0,05°/с со своими знаками.In FIG. Figure 5 shows the spacecraft programmed motion simultaneously along the -170 ° course, + 20 ° roll, and -30 ° pitch with the same speed along the 0.05 ° / s channels with their own signs.
Расчет в МРПД 40 дает:The calculation in the
- времена поворотов:- turnaround times:
- в течение времени программного поворота необходимо выполнять:- during the time of the program turn, it is necessary to perform:
λ=0,05·t для 0≤t≤3400 с,λ = 0.05 · t for 0≤t≤3400 s,
µ=0,05·t для 0≤t≤600 с,µ = 0.05 · t for 0≤t≤600 s,
ε=0,05·t для 0≤t≤400 сε = 0.05 · t for 0≤t≤400 s
Таким образом, система управления отрабатывает любые задания на совершение пространственных программных поворотов с сохранением устойчивого режима гирокомпасирования.Thus, the control system fulfills any tasks for making spatial programmatic turns while maintaining a stable gyrocompassing mode.
На фиг. 4 показан важный практический пример реализации системы для случая курсового программного поворота при отсутствии программных поворотов по крену и тангажу ε=µ=0. Для большей наглядности на фиг. 4 введено новое обозначение программного угла курса и программной скорости по курсу: λ=ψПР,
Система для этого случая существенно упрощается. Ниже приведен вид модулей преобразования и программных скоростей.The system for this case is greatly simplified. Below is a view of conversion modules and program speeds.
Модуль МКО 21 принимает вид:
илиor
в котором пересчет сигналов ПМВ в ОСК зависит только от программного угла КА по курсу.in which the recalculation of the PMV signals in the USC depends only on the programmed spacecraft angle at the heading.
Модули прямого преобразования МПП 23, 24 принимают вид:Modules
При этом:Wherein:
или or
Программная скорость КА имеет место только в канале курса, равна
Настройки контура стабилизации принимают вид:The stabilization loop settings take the form:
Где программная скорость
Модуль обратного преобразования МОП с функцией ВТ, где т - знак транспонирования, принимает вид:The MOS inverse transform module with the function В Т , where t is the transpose sign, takes the form:
илиor
Пример поведение КА в процессе программного поворота по курсу на фиксированный угол +90° при нулевых значениях программных углов по крену и тангажу приведен на фиг. 9.An example of the behavior of a spacecraft during a program rotation in the direction of a fixed angle + 90 ° at zero values of program angles in roll and pitch is shown in FIG. 9.
Как уже отмечалось, динамика системы (отработка меняющихся во времени программных параметров по скорости) зависит только от добротности контура стабилизации.As already noted, the dynamics of the system (development of time-varying program parameters in speed) depends only on the quality factor of the stabilization circuit.
Точность системы зависит только от погрешностей ПМВ, БИУС и погрешности интегрирования, что непосредственно следует из приведенной выше системы уравнений, и поэтому соответствует точности системы управления с использованием классического БОГК.The accuracy of the system depends only on the errors PMV, CIUS and integration errors, which directly follows from the above system of equations, and therefore corresponds to the accuracy of the control system using the classic BOGK.
Диапазон программных поворотов в режиме гирокомпасирования неограничен по курсу, а по крену и тангажу ограничивается зонами линейности ПМВ, что для современных ПМВ соответствует ~12°÷30°.The range of program turns in gyrocompassing mode is unlimited in course, and in roll and pitch it is limited to zones of linearity PMV, which for modern PMVs corresponds to ~ 12 ° ÷ 30 °.
При использовании современных ПМВ ошибки ориентации КА относительно ОСК могут находиться в пределах 3÷5 угл. мин и менее, что позволяет данной системе управления конкурировать с более точными системами, например с системами астроориентации.When using modern PMV, spacecraft orientation errors with respect to the USC can be within the range of 3–5 angles. min and less, which allows this control system to compete with more accurate systems, such as astroorientation systems.
Таким образом, предложенная система пространственной ориентации космического аппарата с использованием бесплатформенного орбитального гирокомпаса обеспечивает КА свободу программных поворотов относительно ОСК одновременно по каналам курса, тангажа и крена, сохраняя при этом устойчивую работу БОГК в режиме гирокомпасирования и устойчивое управление программным угловым положением КА в целом.Thus, the proposed spatial orientation system of the spacecraft using a strapdown orbital gyrocompass provides the spacecraft with freedom of software rotations relative to the USC simultaneously along the heading, pitch and roll channels, while maintaining stable operation of the BOGC in gyrocompassing mode and stable control of the spacecraft angular position as a whole.
Claims (1)
где γПМВ, ϑПМВ - сигналы ПМВ по крену и тангажу в программной системе координат (ПСК);
, - сигналы ПМВ по крену и тангажу, пересчитанные к показаниям ПМВ относительно орбитальной системы координат (ОСК);
λ, µ, ε - углы программных поворотов КА относительно ОСК соответственно по курсу, тангажу и крену,
при этом первый и второй входы МКО по крену и тангажу подключены к выходам соответствующих сумматоров на выходе ПМВ, а выходы МОК по крену и тангажу подключены к входам первого и восьмого сумматоров соответственно, в выходные цепи первого, второго и третьего интеграторов введен первый модуль прямого преобразования (МПП) углов стабилизации КА, первый, второй и третий входы которого подключены к выходам первого, второго и третьего интеграторов соответственно, а выходы подключены к входам соответственно МНК-У, МНР-У и МНТ-У и выполняющий функцию:
второй МПП угловых скоростей стабилизации КА введен в выходные цепи третьего, шестого и девятого сумматоров так, что его первый, второй и третий входы подключены соответственно к выходам третьего, шестого и девятого сумматоров, а его выходы по каналам крена, курса и тангажа подключены к первым входам вновь введенных одиннадцатого, двенадцатого и тринадцатого сумматоров соответственно, выходы которых подключены к входам соответственно МНК-С, МНР-С и МНТ-С, при этом второй МПП повторяет функцию первого МПП, в выходные цепи БИУС введены четырнадцатый, пятнадцатый и шестнадцатый сумматоры, входы которых подключены к выходам БИУС соответственно по каналам крена, курса и тангажа, и модуль обратного преобразования (МОП), входы которого соединены с соответственными выходами четырнадцатого, пятнадцатого и шестнадцатого сумматоров, а его выходы соединены с входами соответственно второго, пятого и девятого сумматоров, при этом МОП выполняет функцию Вт, где т - знак транспонирования, в систему введены также блок задания программных движений (БЗПД) и модуль расчета программных движений (МРПД), вход которого подключен к выходу БЗПД, а первый, второй и третий выходы МРПД, соответствующие программным угловым скоростям КА по крену, курсу и тангажу, подключены соответственно ко вторым входам четырнадцатого, пятнадцатого и шестнадцатого сумматоров и одновременно ко вторым входам соответственно одиннадцатого, двенадцатого и тринадцатого сумматоров, а четвертый, пятый и шестой выходы МРПД, соответствующие программным углам поворота КА соответственно по крену, курсу и тангажу, подключены поканально к четвертым, пятым и шестым входам МОП, четвертым, пятым и шестым входам первого и второго МПП, а также к третьему, четвертому и пятому входам МКО, а четвертый и шестой выходы МРПД подключены ко вторым входам сумматоров на выходе ПМВ соответственно в каналах крена и тангажа, а седьмой выход МРПД подключен к третьему входу девятого сумматора и вторым входам первого и второго МКВК. The control system for the spatial orientation of the spacecraft (SC) using a strapdown orbital gyrocompass (BOGK), containing a local vertical builder (PMV) in the roll channel, as well as a series-connected first adder, first amplification and conversion module (MUP), second adder, and third adder , the first integrator, the output of which is connected to the second input of the first adder, as well as the module for stabilizing the spacecraft stabilization by the angle in the roll channel (MNK-U) and the fourth adder, you the course of which is the input of the executive bodies (IO) of the spacecraft in the roll channel, containing in the course channel the same first adder, second CBM, fifth adder, sixth adder, second integrator, as well as the spacecraft stabilization tuning module by the angle in the course channel -spray (MNR-U) and the seventh adder, the output of which is the input of the IO KA in the heading channel, containing the PMV in the pitch channel, as well as the eighth adder in series, the third CBM, the ninth adder, the third integrator, the output of which of the second is connected to the second input of the eighth adder, as well as the spacecraft stabilization adjustment module for angle in the pitch channel (MNT-U) and the tenth adder, the output of which is the input of the spacecraft’s IO in the pitch channel, which also contains modules for the adjustment of the spacecraft stabilization contour in angular velocity MNK-S, MNR-S, MNT-S through the corresponding roll, yaw and pitch channels, the outputs of which are connected to the second inputs of the fourth, seventh and tenth adders, respectively, which also contains the first and second mutually compensating modules the influence of channels (ICWC), the inputs of which are connected to the outputs of the first and second integrators, respectively, and the outputs are connected to the second inputs of the sixth and third adders, respectively, which also contains a block of gyroscopic angular velocity meters (CIU), characterized in that the roll and the adders are introduced to the pitch, one for each channel so that their inputs are connected to the corresponding PMV outputs, and an orientation control module (MCO) with a signal conversion function:
where γ ПМВ , ϑ ПМВ - signals ПМВ along roll and pitch in the program coordinate system (UCS);
, - PMV roll and pitch signals recalculated to PMV readings relative to the orbital coordinate system (OSK);
λ, µ, ε are the angles of the programmed turns of the spacecraft relative to the OSK, respectively, in the course, pitch and roll,
the first and second roll and pitch MCO inputs are connected to the outputs of the respective adders at the PMV output, and the roll and pitch IOC outputs are connected to the inputs of the first and eighth adders, respectively, the first direct conversion module is introduced into the output circuits of the first, second, and third integrators (MPP) stabilization angles of the spacecraft, the first, second and third inputs of which are connected to the outputs of the first, second and third integrators, respectively, and the outputs are connected to the inputs of respectively MNK-U, MNR-U and MNT-U and performing Theological:
the second MPP of the angular velocity of stabilization of the spacecraft is introduced into the output circuits of the third, sixth and ninth adders so that its first, second and third inputs are connected respectively to the outputs of the third, sixth and ninth adders, and its outputs are connected to the first by the roll, course and pitch channels the inputs of the newly introduced eleventh, twelfth and thirteenth adders, respectively, the outputs of which are connected to the inputs of MNK-S, MNR-S and MNT-S, respectively, while the second MPP repeats the function of the first MPP, four the eleventh, fifteenth and sixteenth adders, the inputs of which are connected to the outputs of the CIUS, respectively, through the roll, course and pitch channels, and the inverse transformation module (MOS), whose inputs are connected to the corresponding outputs of the fourteenth, fifteenth and sixteenth adders, and its outputs are connected to the inputs, respectively of the second, fifth and ninth adders, while the MOS performs the function B t , where t is the transpose sign, the program motion setting block (BZPD) and the program motion calculation module are also introduced into the system I (MRPD), the input of which is connected to the output of the BJPM, and the first, second and third outputs of the MPJP, corresponding to the program angular velocity of the spacecraft in roll, course and pitch, are connected respectively to the second inputs of the fourteenth, fifteenth and sixteenth adders and simultaneously to the second inputs respectively eleventh, twelfth and thirteenth adders, and the fourth, fifth and sixth MRPD outputs, corresponding to the programmed angles of rotation of the spacecraft, respectively, in roll, course and pitch, are connected channel-by-channel to the fourth, fifth and poles m inputs of the MOSFET, fourth, fifth and sixth inputs of the first and second MPP, as well as to the third, fourth and fifth inputs of the MCO, and the fourth and sixth outputs of the MPPD are connected to the second inputs of the adders at the PMV output, respectively, in the roll and pitch channels, and the seventh output MRPD is connected to the third input of the ninth adder and the second inputs of the first and second ICWC.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
RU2015109451/28A RU2597015C1 (en) | 2015-03-18 | 2015-03-18 | System for controlling spatial orientation of spacecraft using gimballess orbital gyrocompass |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
RU2015109451/28A RU2597015C1 (en) | 2015-03-18 | 2015-03-18 | System for controlling spatial orientation of spacecraft using gimballess orbital gyrocompass |
Publications (1)
Publication Number | Publication Date |
---|---|
RU2597015C1 true RU2597015C1 (en) | 2016-09-10 |
Family
ID=56892655
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
RU2015109451/28A RU2597015C1 (en) | 2015-03-18 | 2015-03-18 | System for controlling spatial orientation of spacecraft using gimballess orbital gyrocompass |
Country Status (1)
Country | Link |
---|---|
RU (1) | RU2597015C1 (en) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2676844C1 (en) * | 2017-11-27 | 2019-01-11 | Акционерное общество "Военно-промышленная корпорация "Научно-производственное объединение машиностроения" | System of return of course orientation of space vehicle using orbital gyrocompass |
CN116295389A (en) * | 2023-05-23 | 2023-06-23 | 中国船舶集团有限公司第七〇七研究所 | Method, device, equipment and medium for stably switching strapdown compass system state |
RU2812876C1 (en) * | 2023-07-07 | 2024-02-05 | Акционерное общество "Военно-промышленная корпорация "Научно-производственное объединение машиностроения" | Astronomical orientation system for orbital spacecraft with feedback |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2378616C1 (en) * | 2008-07-03 | 2010-01-10 | Открытое акционерное общество "Концерн "Центральный научно-исследовательский институт "Электроприбор" | Celestial guidance system |
RU2509690C1 (en) * | 2012-09-11 | 2014-03-20 | Открытое акционерное общество "Военно-промышленная корпорация "Научно-производственное объединение машиностроения" | Device to control spacecraft position in space with help of orbital gyrocompass |
RU141801U1 (en) * | 2013-12-13 | 2014-06-10 | Общество с ограниченной ответственностью "Научно-производственный комплекс "Электрооптика" (ООО "НПК "Электрооптика") | ASTROINERCIAL NAVIGATION SYSTEM |
-
2015
- 2015-03-18 RU RU2015109451/28A patent/RU2597015C1/en not_active IP Right Cessation
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2378616C1 (en) * | 2008-07-03 | 2010-01-10 | Открытое акционерное общество "Концерн "Центральный научно-исследовательский институт "Электроприбор" | Celestial guidance system |
RU2509690C1 (en) * | 2012-09-11 | 2014-03-20 | Открытое акционерное общество "Военно-промышленная корпорация "Научно-производственное объединение машиностроения" | Device to control spacecraft position in space with help of orbital gyrocompass |
RU141801U1 (en) * | 2013-12-13 | 2014-06-10 | Общество с ограниченной ответственностью "Научно-производственный комплекс "Электрооптика" (ООО "НПК "Электрооптика") | ASTROINERCIAL NAVIGATION SYSTEM |
Non-Patent Citations (3)
Title |
---|
Г.КВАЗИУС, Ф.МАККЭНЛЕСС. Проектирование систем астронавигации. - М.: Мир, 1970, с.127-133. * |
О.Н.АНУЧИН, И.Э.КОМАРОВА, Л.Ф.ПОРФИРЬЕВ. Бортовые системы навигации и ориентации искусственных спутников Земли. - СПб.: ГНЦ РФ ЦНИИ "Электроприбор", 2004, с.238-245. * |
О.Н.АНУЧИН, И.Э.КОМАРОВА, Л.Ф.ПОРФИРЬЕВ. Бортовые системы навигации и ориентации искусственных спутников Земли. - СПб.: ГНЦ РФ ЦНИИ "Электроприбор", 2004, с.238-245. Г.КВАЗИУС, Ф.МАККЭНЛЕСС. Проектирование систем астронавигации. - М.: Мир, 1970, с.127-133. * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2676844C1 (en) * | 2017-11-27 | 2019-01-11 | Акционерное общество "Военно-промышленная корпорация "Научно-производственное объединение машиностроения" | System of return of course orientation of space vehicle using orbital gyrocompass |
CN116295389A (en) * | 2023-05-23 | 2023-06-23 | 中国船舶集团有限公司第七〇七研究所 | Method, device, equipment and medium for stably switching strapdown compass system state |
CN116295389B (en) * | 2023-05-23 | 2023-08-04 | 中国船舶集团有限公司第七〇七研究所 | Method, device, equipment and medium for stably switching strapdown compass system state |
RU2812876C1 (en) * | 2023-07-07 | 2024-02-05 | Акционерное общество "Военно-промышленная корпорация "Научно-производственное объединение машиностроения" | Astronomical orientation system for orbital spacecraft with feedback |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Mao et al. | Design and implementation of continuous finite-time sliding mode control for 2-DOF inertially stabilized platform subject to multiple disturbances | |
Do et al. | Nonlinear formation control of unicycle-type mobile robots | |
Duchaine et al. | Computationally efficient predictive robot control | |
CN101246012B (en) | Combinated navigation method based on robust dissipation filtering | |
CN104656447A (en) | Differential geometry nonlinear control method for aircraft anti-interference attitude tracking | |
CN101655371A (en) | Position signal damping method of inertial navigation system based on variable damping coefficient | |
RU2509690C1 (en) | Device to control spacecraft position in space with help of orbital gyrocompass | |
CN106767806A (en) | A kind of physical platform for hybrid inertial navigation system | |
RU2597015C1 (en) | System for controlling spatial orientation of spacecraft using gimballess orbital gyrocompass | |
Prempain et al. | L2 and H2 performance analysis and gain-scheduling synthesis for parameter-dependent systems | |
틴휭 et al. | A study on gimbal motion control system design based on super-twisting control method | |
Liu et al. | Fuzzy PID tracking controller for two-axis airborne optoelectronic stabilized platform | |
Zhou et al. | Adaptive nonlinear synchronization control of twin-gyro precession | |
RU2112716C1 (en) | Method of control of space vehicles by means of reaction controls and system for realization of this method | |
CN112115574B (en) | High-precision pointing tracking control method for different-plane orbit satellite | |
Rosinová et al. | Teaching State-Space Control Methods Using a Floatshield Laboratory Plant | |
Iljukhin et al. | Simulation of the angular stabilization system of the artificial earth satellite in the MATLAB Simulink | |
RU2597018C2 (en) | Gyro-compass for orbital spacecraft | |
RU2206916C2 (en) | Method and device for controlling object motion path, object motion path control system (alternatives), method for determining channel-to- channel channels phase connection and transfer constant of object in object motion path control system | |
Tan et al. | High Precision Attitude Control of Space Maneuvering Platform Based on Model Predictive and Inversive Method | |
RU2583350C1 (en) | Method of orbital gyro compassing and device therefor | |
Zohrei et al. | Nonlinear Observer-Based Control Design for a Three-Axis Inertial Stabilized Platform | |
Guy et al. | Reduced order H∞ controller synthesis for flexible structures control | |
Huynh et al. | An Anti-disturbance Backstepping Control for A Two-axis Gimbal System with Euler Angle Feedback and Delayed Inputs | |
RU2812876C1 (en) | Astronomical orientation system for orbital spacecraft with feedback |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
MM4A | The patent is invalid due to non-payment of fees |
Effective date: 20200319 |