Корректор угла крена для уточнения траектории летательного аппарата

Изобретение относится к авиации, в частности к области устройств помощи в навигации для уточнения траектории летательного, в частности в пилотажно-навигационном оборудовании летательных аппаратов (ЛА). Устройство содержит датчик угловой скорости (ДУС), датчик линейных ускорений (ДЛУ), бесплатформенную инерциальную навигационную систему (БИНС), первое пороговое устройство, блок определения мгновенного значения крена, блок определения скользящей средней оценки крена и его среднеквадратического отклонения, второе пороговое устройство, первое логическое устройство, второе логическое устройство, соединенные определенным образом. Выходным сигналом устройства являются скорректированный угол крена БИНС. Данное устройство позволяет уточнить текущую траекторию полета, осуществить уточнение текущего значения угла крена, для чего выполняется проверка выхода угловой скорости относительно продольной оси (ω_x) за ограничение пределов измерений датчика ДУС, автономное уточнение угла крена после устранения вращения ЛА, нахождение «площадки» для определения крена и вычисление крена методом скользящей средней. Технический результат – повышение точности формирования текущей траектории автономно управляемого ЛА путем определения угла крена управляемого ЛА после отделения его от носителя, используя сигналы его бортовых инерциальных датчиков, в случае возникновения вращения ЛА. 2 ил.

 

Изобретение относится к области авиации, в частности к области устройств помощи в навигации для уточнения траектории летательного аппарата. Изобретение предназначено для применения в области авиационного приборостроения в пилотажно-навигационном оборудовании летательных аппаратов (ЛА).

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

Известен способ коррекции угла крена и корректор угла крена, патент РФ №2362108, МКП F41G 7/00, опубликован 20.07.2009 г., бюл. №20.

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

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

Известен также способ помощи в навигации для определения траектории летательного аппарата, патент № RU 2523183, МКП G08G 5/02, G05D 1/06, приоритет от 28.04.2009 г. FR 09/02066, опубликован 20.07.2014 г., бюл. №20, выбранный нами за прототип.

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

В приведенном выше изобретении отсутствует режим автономной коррекции углов ориентации при потере сигнала от спутниковых систем коррекции ИНС, что может привести к отклонению ЛА от заданной траектории.

Целью заявляемого изобретения является повышение точности формирования текущей траектории ЛА путем автономной коррекции угла крена.

Поставленная цель достигается за счет того, что в корректор угла крена для уточнения траектории летательного аппарата, содержащий датчики угловых скоростей (ДУС), датчики линейных ускорений (ДЛУ), бесплатформенную инерциальную навигационную систему (БИНС), первый и второй входы которого подключены соответственно к выходам ДУС и ДЛУ, дополнительно введены первое пороговое устройство, последовательно соединенные блок определения мгновенного значения крена, блок определения скользящих средних крена и его среднеквадратического отклонения (СКО), второе пороговое устройство, первое логическое устройство и второе логическое устройство, причем вход первого порогового устройства подключен ко второму выходу ДУС, первый вход блока определения мгновенного значения крена подключен к первому выходу ДЛУ, второй вход этого же блока подключен ко второму выходу БИНС, второй вход блока определения скользящей средней оценки крена и его СКО подключен к первому выходу БИНС, а его выход подключен ко второму логическому устройству, второй вход первого логического устройства подключен к первому выходу БИНС, а третий вход - к выходу первого порогового устройства, первый вход БИНС подключен к первому выходу ДУС, выход второго логического устройства соединен с третьим входом БИНС, выходом устройства является третий выход БИНС.

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

Устройство содержит датчик 1 угловой скорости, датчик 2 линейных ускорений, БИНС 3, первое пороговое устройство 4, блок 5 определения мгновенного значения крена, блок 6 определения скользящей средней оценки крена и его СКО, второе пороговое устройство 7, первое логическое устройство 8, второе логическое устройство 9. Выходным сигналом устройства является скорректированный угол крена БИНС.

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

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

Момент коррекции определяют по СКО оценки крена на скользящем интервале наблюдения с заданной длительностью.

По истечении времени t₁, после отделения и при условии того, что СКО оценки крена на скользящем интервале меньше «П», корректирующее значение определяют соотношением:

черта сверху означает усреднение на скользящем интервале.

Учитывают интервал времени, на котором происходит интенсивное вращение изделия после его отделения от носителя. Для этого задают время t₁, отсчитываемое от момента команды на отделение изделия, в течение которого происходит основное вращение изделия: - в течение t₁ определяют наличие выхода ω_x на ограничение; - по истечении t₁ находят «площадку» крена, на которой он достаточно стабилен для использования статической оценки крена - поскольку поиск «площадки» необходимо выполнять в процессе счисления ориентации, то коррекция включается в «Быстрый цикл» решения навигационного алгоритма БИНС по Δt.

Момент обнаружения «площадки» крена фиксируют по величине скользящего СКО крена - σ(γ), которое вычисляют на скользящем интервале с заданной длиной. Момент обнаружения «площадки» заранее не определен и может варьироваться в зависимости от продолжительности и интенсивности вращения, но этот момент всегда больше t₁.

Конкретное значение момента времени обнаружения «площадки» фиксируют в виде номера отсчета измерений от команды на отделение до убывания скользящего СКО крена σ(γ) ниже заданного порога «П». Обнаружение «площадки» свидетельствует о достаточно стабильном положении изделия по крену, при этом само значение крена может быть различным в зависимости от того, насколько удачно оно стабилизировалось в данном полете.

Параллельно с вычислением скользящего СКО крена σ(γ) вычисляют скользящее среднее статической оценки крена Для этого мгновенные значения статической оценки крена усредняют на текущем положении скользящего интервала. Для коррекции используют скользящее среднее статической оценки крена на отсчете момента обнаружения «площадки», которое обозначают как Заметим, что успех использования формулы обеспечивается только совместно с правильным обнаружением «площадки» и при усреднении мгновенных статических оценок на заданном интервале.

Как только скользящее СКО крена σ(γ) становится меньше порога «П», фиксируют корректирующее значение крена которое присваивают текущей оценке крена γ в алгоритме ориентации БИНС при условии, что за время t₁ был зафиксирован выход ω_х на ограничение.

Таким образом, коррекцию выполняют на «площадке» установившегося углового положения по крену. Само угловое положение по крену при этом может быть произвольным. Момент времени обнаружения «площадки» определяют по скользящему СКО крена - σ(γ), где γ - оценка крена, вычисляемая в БИНС изделия. «Площадка» характеризуется тремя величинами:

- номером отсчета ее обнаружения -

- величиной скользящего СКО крена - σ(γ) < «П»;

- величиной скользящего среднего статической оценки крена на момент обнаружения «площадки» -

Коррекция крена заключается в присваивании оценке крена значения при условии, что в течение t₁ имел место выход угловой скорости ω_x на ограничение. Если же «площадка» крена не обнаруживается, то это означает, что изделие постоянно вращается и коррекция крена по ДЛУ невозможна, тогда необходимо дождаться остановки вращения.

Описание работы устройства коррекции. Время основного вращения изделия t₁, отсчитывается от команды на отделение. Датчик 1 угловых скоростей измеряет величину угловой скорости по оси X. В первом пороговом устройстве 4 выполняется проверка выхода ω_x на ограничение: - если модуль |ω_x|>ω_зад превысил ограничение, устанавливается признак

Датчик 2 линейных ускорений измеряет перегрузку вдоль оси Z ЛА.

В блоке 5 определения мгновенного значения крена определяются мгновенные значения крена согласно выражению на интервале времени t₁-t_n.

В блоке 6 определяется скользящее среднее оценки значения крена за определенное время t_n и его СКО согласно выражению Выполняется сдвиг буфера для скользящего СКО крена σ(γ) и буфера для скользящего среднего оценки крена На массивах этих буферов вычисляется скользящее СКО крена σ(γ) и скользящее среднее оценки крена

Во втором пороговом устройстве 7 скользящее СКО крена σ(γ) сравнивается с порогом «П» для обнаружения площадки для коррекции.

Первое логическое устройство 8 собирает все признаки:

- Порог скользящего СКО крена σ(γ) для обнаружения «площадки»;

- Начальное значение признака обнаружения «площадки» крена γ_i=0;

- Начальное значение признака выхода на ограничение

Если скользящее среднее СКО крена σ(γ)_ct меньше порога «П» и текущее время от момента команды на отделение больше t₁, тогда:

- устанавливает признак обнаружения «площадки» крена γ_i=1;

- запоминает номер отсчета обнаружения «площадки» крена

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

Во втором логическом устройстве 9 при наличии признака обнаружения площадки крена γ_i=1 происходит запоминание корректирующего значения крена Если скользящее среднее СКО крена σ(γ)_ct меньше порога «П» и номер текущего отсчета равен и признак выхода на ограничение установлен в единицу тогда в алгоритме ориентации СПО изделия выполняется замена текущей оценки крена ЛА γ на корректирующее значение

Результаты моделирования коррекции угла крена при наличии признака выхода на ограничение представлены на фиг. 2, где: ряд 1 - угловая скорость ω_x; ряд 2 - оценка крена по СПО изделия; ряд 3 - оценка крена, вычисленная по данным мультиплексного канала информационного обмена (МКИО) с учетом коррекции; ряд 4 - СКО оценки крена по СПО изделия на скользящем интервале. По истечении 5 секунд СКО оценки крена убывает и в момент времени 9.6 секунды становится меньше 0.5 градуса. Корректирующее значение, вычисленное по (1) равно -8.88 градуса. Без коррекции оценка крена в этот момент равна 2.60 градуса. Коррекция компенсирует ограничение отрицательной полуволны угловой скорости ω_x.

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

Корректор угла крена для уточнения траектории летательного аппарата, содержащий датчики угловых скоростей (ДУС), датчики линейных ускорений (ДЛУ), бесплатформенную инерциальную навигационную систему (БИНС), первый и второй входы которого подключены соответственно к выходам ДУС и ДЛУ, отличающийся тем, что в него дополнительно введены первое пороговое устройство, последовательно соединенные блок определения мгновенного значения крена, блок определения скользящих средних крена и его среднеквадратического отклонения (СКО), второе пороговое устройство, первое логическое устройство и второе логическое устройство, причем вход первого порогового устройства подключен ко второму выходу ДУС, первый вход блока определения мгновенного значения крена подключен к первому выходу ДЛУ, второй вход этого же блока подключен ко второму выходу БИНС, второй вход блока определения скользящей средней оценки крена и его СКО подключен к первому выходу БИНС, а его выход подключен ко второму логическому устройству, второй вход первого логического устройства подключен к первому выходу БИНС, а третий вход - к выходу первого порогового устройства, первый вход БИНС подключен к первому выходу ДУС, выход второго логического устройства соединен с третьим входом БИНС, выходом устройства является третий выход БИНС.