Система управления беспилотным летательным аппаратом с комплексным навигационным устройством

Реферат

 

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

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

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

Известна система аналогичного назначения, содержащая радиотехническое средство для измерения координат и параметров движения цели, кинематическое звено, координатор, входным воздействием для которого являются параметры движения линии визирования управляемый объект объект назначения, выдаваемые кинематическим звеном. На другой вход координатора с управляемого объекта поступают параметры и координаты его действительного движения. В результате сравнения входных сигналов в координаторе формируются команды управления движением управляемого объекта к объекту назначения (Справочник по радиоэлектронике. Под ред. А. А. Куликовского, т. 3. М. Энергия, 1970, с. 559).

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

Наиболее близкой по технической сущности к предлагаемой является система, содержащая пункт управления, первое и второе кинематические звенья, координатор, включающий радиолокационную станцию, устройство сравнения, радиоаппаратуру, исполнительное устройство и управляемый объект (Справочник по радиоэлектронике. /Под ред. А. А. Куликовского, т. 3, М. Энергия, 1970, с. 560, рис. 27-3).

Входным воздействием для РЛС являются параметры движения линии пункт управления объект назначения, пространственное положение этой линии, на которой должен находиться центр масс управляемого объекта. Параметры движения линии пункт управления объект назначения вырабатываются первым кинематическим звеном. Эта информация является входным воздействием для РЛС, где она преобразуется в параметры движения радиолуча (равносигнального направления). Угол рассогласования между равносигнальным направлением и линией пункта управления управляемый объект, определяемый вторым кинематическим звеном, является входным воздействием для радиоаппаратуры, в которой вырабатываются сигналы, пропорциональные линейным отклонениям управляемого объекта от равносигнального направления в двух взаимно перпендикулярных плоскостях управления. Из этих сигналов в исполнительном устройстве формируются сигналы управления управляемым объектом.

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

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

Благодаря введению в предлагаемую систему блока выработки сигналов выставки гиростабилизированной платформы, блока тарировки установленных на ней трех маятниковых и двух струнных акселерометров, блока коррекции паспортных данных инерциальных блоков выставляемой гироплатформы, а также задатчика состава параметров, выдаваемых навигационным комплексом носителя, характеризующих движения последнего, задатчика положения (отстояния) точке подвеса выставляемой гироплатформы относительно точки подвеса гироплатформы навигационного комплекса носителя и задатчика паспортных данных инерциальных блоков, установленных на гироплатформе инерциального навигационного устройства, обеспечиваются: более точное горизонтирование выставляемой гироплатформы с учетом параметров движения носителя, рассогласования точек подвеса выставляемой гироплатформы и паспортных данных установленных на ней инерциальных блоков; более точная ориентация выставляемой гироплатформы в заданном азимутальном направлении, т. е. в плоскости, проходящей через точку подвеса гироплатформы и точку нахождения объекта назначения с учетом указанной выше информации, используемой при горизонтировании платформы; тарировка установленных на выставляемой гироплатформе трех маятниковых и двух струнных акселерометров.

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

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

На фиг. 1 показана структурная схема предлагаемой системы; на фиг. 2 пример схемного построения пульта управления, входящего в состав пункта управления; на фиг. 3 блок-схема алгоритма выработки сигналов блоком коррекции паспортных данных; на фиг. 4 схема блока тарировки акселерометров; на фиг. 5 схема блока выработки сигналов выставки гиростабилизированной платформы инерционального навигационного устройства; на фиг. 6 блок-схема алгоритма выработки выходных сигналов блоком формирования требуемых углов, входящим в состав блока выработки сигналов выставки; на фиг. 7 блок-схема алгоритма выработки выходных сигналов блоком формирования углов отклонения, входящим в состав блока выработки сигналов выставки; на фиг. 8 схема устройства коррекции высоты и вертикальной скорости; на фиг. 9 схема устройства выработки сигналов управления.

На фиг. 1 обозначены: устройство 1 выработки сигналов управления (УВСУ), исполнительное устройство (ИУ) 2, радиолокационный визир (РЛВ) 3, инерциальное навигационное устройство (ИНУ) 4, гиростабилизированная платформа (ГСП) 5, блок 6 маятниковых акселерометров (БМА), вычислитель 7, пункт 8 управления, блок 9 тарировки акселерометров (БТА), блок 10 выработки сигналов выставки гиростабилизированной платформы (БВСВ ГСП), блок 11 коррекции паспортных данных (БКПД), задатчик 12 состава параметров навигационного комплекса (ЗСПНК), задатчик 13 положения точки подвеса платформы (ЗПТПП), задатчик 14 паспортных данных инерциальных блоков (ЗПДИБ), радиовысотомер (РВ) 15, устройство 16 коррекции высоты и вертикальной скорости (УКВ и ВС), навигационный комплекс носителя (НКН) 17, пуль управления 18; таймер (Т-Р) 19, блок 20 струнных акселерометров (БСА).

В соответствии со схемой на фиг. 1 в системе устройство 1 выработки сигналов управления (УВСУ) выходами углов крена, курса и тангажа, а также по высоте (выходы 1-4, подключено соответственно к входам 1-4 исполнительного устройства 2, входами 9-12 к выходам 6-3 соответственно дальности, сигнала управления (СУ), углов рассогласования тангажа (v) и курса () радиолокационного визира 3 (РЛВ). Выходы 6 и 7 устройства 1 соединены соответственно с входами 5 и 6 РЛВ 3 (входы "Вкл. РЛВ" и скорость V), шестой вход устройства 1 подключен к пятому выходу пункта 8 управления, а его восьмой выход соединен с входом радиовысотомера 15, первый и второй выходы которого подключены соответственно к третьему и четвертому входам устройства 16 коррекции высоты и вертикальной скорости (УВВ и ВС), два выхода которого соединены соответственно с седьмым и восьмым входами УВСУ 1, а его первый и второй входы соединены соответственно с шестым и седьмым выходами второй группы выходов вычислителя 7 ИНУ 4. Выходы вычислителя 7 второй группы с первого по пятый соединены соответственно с входами с пятого по первый УВСУ 1, а его седьмой, восьмой и девятый входы соединены соответственно с первым, вторым и третьим выходами блока 9 тарировки акселерометров. Первая группа входов вычислителя 7 подключена соответственно к трем выходам ГСП 5, трем выходам БМА 6, двум выходам БСА 20 и соединена с второй группой из восьми входов блока 11 коррекции паспортных данных, первая группа которого подключена к соответствующим выходам задатчика 14. Выходы блока 11 с первого по пятый соединены с четвертой группой из пяти входов блока 10, а выходы блока 11 с четвертого по восьмой подключены соответственно к третьей группе из пяти входов блока 9. Пятый вход блока 9 объединен с пятым входом блока 10 и подключен к третьему выходу пункта 8 управления, а второй его вход объединен с вторым входом блока 10 и подключен к выходу задатчика 12. Третья группа из трех входов блока 10 соединена соответственно с первым, вторым и третьим выходами задатчика 13, а первая группа его входов объединена с соответствующими входами блока 9 и по магистрали подсоединена к четвертому выходу пункта 8 управления (выходы параметров движения носителя). Первый, второй и третий выходы блока 10 по сигналам выставки подключены соответственно к третьему, четвертому и пятому входам ГСП 5, а четвертый его выход соединен с входом пункта 8 управления, первый выход которого через первый вход ИНУ 4 соединен с первым входом ГСП 5, второй вход которой через второй вход ИНУ 4 подключен к второму выходу пункта 8 управления. В пункте 8 управления таймер 19 первым выходом подключен к первому входу НКН 17 и является вторым выходом пункта 8, а третьим выходом подключен к третьему входом НКН 17, второй выход таймера 19 является третьим выходом пункта 8 управления, а его управляющий вход подключен к третьему выходу пульта 18 управления, четвертый выход которого является пятым выходом пункта 8 управления, пятый выход пульта 18 является шестым выходом пункта 8 управления. Первый вход пульта 18 подключен к первому выходу пункта 8, вход которого соединен с входом пульта 18, второй выход которого подключен к второму входу НКН 17, группа выходов которого является выходами параметров движения носителя, и подключена магистрально к четвертому выходу пункта 8 управления.

Радиолокационный визир 3 (фиг. 1) содержит передатчик 21 (ПРК), подключенный выходом к входу антенны 22 (Ант), кинематически связанной с приводом 23 антенны (Пр. А), выход которой связан через последовательно соединенные приемник 24 (ПРМ), устройство 25 внутриимпульсной обработки (УВИО) и устройство 26 первичной обработки информации (УПОИ) с первым входом буферного запоминающего устройства 27 (БЗУ). Выход БЗУ 27 подключен к четвертому входу устройства 28 обмена информацией (УОИ), выходы которого с третьего по шестой являются соответствующими выходами РЛВ 3, а его пятый и шестой входы соответствующими входами РЛВ 3. Первый вход УОИ 28 подключен к первому выходу привода 23 антенны, а его третий вход объединен с входом привода 23 и соединен с вторым входом УПОИ 26, пятый вход которого подключен к второму выходу привода 23 антенны, а его третий вход соединен с шиной синхронизации, к которой также подключены вторые входы передатчика 21, приемника 24, устройства 25, устройства 28, буферного запоминающего устройства 27 и выход синхронизатора 29 (С). Второй выход устройства 25 подключен к первому входу ПРК 21, четвертый вход устройства 26 соединен с вторым выходом УОИ 28, первый выход которого подключен к второму входу буферного запоминающего устройства 27, а второй выход приемника 24 соединен с вторым входом УПОИ 26, четвертый вход которого соединен с вторым входом УОИ 28.

Блок 9 тарировки акселерометров (фиг. 4) содержит последовательно соединенные сумматор 30, интегратор 31, интегратор 32, управляемый ключ 33 (УК1) и блок 34 памяти (БП1), выход которого является первым выходом блока 9, последовательно соединенные сумматор 35, интегратор 36, интегратор 37, управляемый ключ 38 (УК2) и блок 39 памяти (БП2), выход которого является вторым выходом блока 9, и последовательно соединенные сумматор 40, интегратор 41, интегратор 42, управляемый ключ 43 (УК3) и блок 44 памяти (БП3), выход которого является третьим выходом блока 9. Блок 9 также содержит дешифратор 45 (ДШ), управляемый ключ 46 (УК4), счетчик 47 (Сч), задатчик 48 времени тарировки (ЗВТ), задатчик 49 ускорения силы тяжести (ЗУСТ) и коммутатор 50, выход которого подключен к вторым входам ключей 33, 38, 43, второй вход коммутатора 50 соединен с выходом задатчика 48, а первый его вход связан через счетчик 47 с пятым входом блока 9, первая группа входов которого соединена с вторым входом управляемого ключа 46, первый вход которого связан через дешифратор 46 с вторым входом блока 9, а его выход подключен к третьему входу сумматора 40, второй вход которого подключен к выходу задатчика 49 ускорения силы тяжести, а его первый вход соединен с четвертым из третьей группы входов блока 9, при этом первый и третий входы третьей группы подключены к входам сумматора 30, а второй и пятый входы этой группы соединены с входами сумматора 35.

Блок 10 выработки сигналов выставки гиростабилизированной платформы (фиг. 5) содержит сумматоры 51-54, блоки 55-58 переменных коэффициентов (БПК1-4), дешифраторы 59 и 60 (ДШ1-2), управляемые ключи 61, 62 и 63 (УК1-3), блок 64 формирования углов отклонения (БФУО), блок 65 формирования требуемых углов (БФТУ) и пороговые устройства 66, 67 и 68 (ПОУ1-3), выходы которых связаны через логический элемент И 69 с четвертым выходом блока 10, при этом выходы ключей 61, 62 и 63 связаны через блоки 70, 71 и 72 памяти (БП1-3) соответственно с вторым, третьим и первым выходами блока 10. Входами блоки 70, 71 и 72 подключены соответственно к выходам ключей 61, 62 и 63, вторые входы которых объединены и соединены с пятым входом блока 10, первые входы ключей 61 и 62 подключены к выходам соответственно сумматоров 52 и 54. Первый вход ключа 63 объединен с входом порогового устройства 66 и подключен к третьему выходу блока 64, первый и второй выходы которого подключены соответственно к входам порогового устройства 68 и 67 и соединены соответственно с вторыми входами блоков 57 и 58 переменных коэффициентов, выходы которых подключены соответственно к вторым входам сумматоров 52 и 54, первые входы которых соединены с выходами соответственно блоков 55 и 56 переменных коэффициентов, вторые входы которых подключены к выходам соответственно сумматоров 51 и 53. Первые входы блоков 55 и 57 соединены с выходами дешифратора 59, а первые входы блоков 56 и 58 соединены с выходами дешифратора 60. Два входа сумматора 51 соединены соответственно с шестым входом первой группы и с четвертым входом четвертой группы блока 10, а два входа сумматора 53 подключены соответственно к седьмому входу первой группы и пятому входу четвертой группы входов блока 10. Пять входов блока 65 соединены соответственно с первыми пятью входами первой группы входов блока 10, три других входа блока 65 подключены соответственно к первым трем входам третьей группы входов блока 10, первый, второй и третий выходы блока 65 соединены соответственно с первым, вторым и третьим входами блока 64, входы которого с четвертого по шестой связаны соответственно с входами с первого по третий четвертой группы входов блока 10, причем второй вход четвертой группы соединен также с девятым входом блока 65. Входы дешифраторов 59, 60 подключены к второму входу блока 10.

Устройство 16 коррекции высоты и вертикальной скорости содержит (фиг. 8) блок 73 разности, первый вход которого объединен с первым входом блока 74 разности (БР3) и является первым входом устройства 16, выход блока 74 является первым выходом устройства 16. Второй вход блока 73 является третьим входом блока 16, а его выход через управляемый ключ 75 связан с первым входом блока 76 разности, выход которого соединен с первым входом блока 77 умножителей, а второй его вход объединен с вторым входом блока 74 и подключен к выходу интегратора 78, подключенного входом к выходу сумматора 79, второй вход которого соединен с выходом интегратора 80 и подключен к второму входу блока 81 разности, первый вход которого подключен к второму входу устройства 16, а его выход соединен с вторым выходом устройства 16. Вход интегратора 80 соединен с выходом сумматора 82, первый вход которого подключен к второму выходу блока 77, первый вход которого соединен с первым входом сумматора 79. Второй вход сумматора 82 связан через интегратор 83 с третьим входом блока 77 умножителей, второй, третий и четвертый входы которого подключены к соответствующим выходам блока 84 сумматоров, первый вход которого подключен к выходу умножителя 85, подключенного первым входом к первому выходу блока 86 ключей, второй выход которого соединен с вторым входом блока 84 сумматоров, а его первый вход связан через последовательно соединенные блок 87 пороговых элементов (БПЭ) и таймер 88 с вторым входом ключа 75 и с четвертым входом устройства 16. Второй вход умножителя 85 подключен к второму входу блока 87 и к первому выходу блока 89 памяти, второй выход которого соединен с вторым входом блока 86 ключей.

Устройство 1 выработки сигналов управления (фиг. 9) содержит блоки 90-93 выработки сигналов управления соответственно по крену, курсу, тангажу и высоте, выходы которых являются соответственно первым, вторым, третьим и четвертым выходами устройства 1, два пороговых элемента 94 и 95 (ПЭ1, ПЭ2), устройство 96 обмена информацией (УОИ), ключ 97, таймер 98, программный блок 99 и два управляемых переключателя 100 и 101, при этом входы устройства 96 c первого по четвертый подключены соответственно к двенадцатому, одиннадцатому, десятому и девятому входам устройства 1, пятый вход УОИ 96 соединен с первым входом устройства 1, шестой вход связан через пороговый элемент 95 с вторым входом устройства 1, а седьмой вход УОИ 96 подключен к первому выходу таймера 98, второй выход которого соединен с восьмым выходом устройства 1. Первый и второй выходы УОИ 96 подключены соответственно к шестому и седьмому выходам устройства 1, третий и четвертый выходы УОИ 96 соединены с первыми входами соответственно первого и второго управляемых переключателей 100 и 101, пятый выход УОИ 96 связан через ключ 97, подключенный вторым входом к второму выходу блока 93 (БВСУ Hy), с вторым и третьими входами соответственно переключателей 101 и 100, а шестой выход УОИ 96 связан через пороговый элемент 94 с вторым входом программного блока 99, третий вход УВСУ 1 соединен с третьим входом переключателя 101 и с первым входом блока 93, третий и четвертый входы которого соединены соответственно с восьмым и седьмым входами устройства 1, а его второй вход соединен с четвертым выходом программного блока 99, вход которого является шестым входом устройства 1. Первый выход блока 99 подключен к второму входу блока 92 (БВСУ y), первый вход которого соединен с выходом переключателя 101, второй выход блока 99 соединен с четвертым входом переключателя 100, первый и второй выходы которого подключены к соответствующим входам блока 91. Третий выход блока 99 соединен с третьим входом блока 90, первый вход которого подключен к пятому входу устройства 1, а второй его вход объединен с вторым входом переключателя 100 и подключен к четвертому входу устройства 1.

Пульт 18 управления (фиг.2) содержит клавишный регистр 102, программатор 103, ключ 104, табло 105, а также кнопки 106 и 107, при этом входы клавишного регистра 102, программатора 103, ключа 104, а также контакты кнопок 106 и 107 связаны с источником питания, выходы регистра 102 подключены к второй выходной магистрали пульта 18, выходы программатора 103 к четвертой магистрали, управляющий вход ключа соединен с входом пульта 18, а его выход подключен к входу табло 105. Кнопки 106 и 107 связаны с управляющими выходами пульта 18.

Предлагаемая система работает следующим образом. По априорно известным данным в задатчик 12 записывается код, соответствующий составу параметров движения носителя, выдаваемых навигационным комплексом 17. В задатчик 13 записываются координаты x, y, z точки подвеса гиростабилизированной платформы 5 относительно точки подвеса платформы навигационного комплекса 17 носителя, а в задатчик 14 заносятся паспортные данные систематических погрешностей масштабных коэффициентов и систематических погрешностей установки маятниковых и струнных акселерометров 6, 20, установленных на ГСП 5. Из программатора 103 пульта 18 управления в программный блок 99 устройства 1 выработки сигналов управления заносятся программные значения углов курса пр, тангажа пр и крена пр, а также высоты Hпр. Нажатием кнопки 106 пульта 18 по первому выходу выдается команда на разгон гироскопов ГСП 5, а по третьему выходу команда на запуск таймера 19. Время разгона гироскопов ГСП 5 задается таймером 19 путем выдачи последним на второй вход ГСП 5 соответствующего сигнала. По сигналам с третьего выхода таймера 19 навигационный комплекс 17 периодически выдает на группу выходов 11-1j сигналы, соответствующие параметрам движения носителя, в частности угла рыскания Kc, угла качки по дифференту k, угла качки по крену Qk и угла тангажа n1. Кроме того, по одному из выходов указанной группы выдается сигнал, соответствующий заданному пеленгу Пн наведения ГСП 5. Эти сигналы поступают на соответствующие входы блока 10 выработки сигналов выставки ГСП и блока 9 тарировки акселерометров. Сигналы с датчиков углов ГСП 5, а также сигналы с выходов блоков 6 и 20 маятниковых и струнных акселерометров выдаются в вычислитель 7 инерциального навигационного устройства и в блок 11 корректировки паспортных данных датчиков углов и акселерометров. В блоке 11 в соответствии с блок-схемой алгоритмов, приведенной на фиг. 3, сначала в показаниях датчиков углов n, n, n учитываются паспортные данные погрешностей по, по, по установки этих датчиков на соответствующих осях карданова подвеса ГСП 5, а затем в показаниях маятниковых Q, Q и в показаниях струнных Q, Q, Qакселерометров компенсируются систематические погрешности соответственно M, M, M, M и M их масштабных коэффициентов, после чего компенсируются систематические погрешности x, z, п1, п2, п3, п4и п5 установки маятниковых и струнных акселерометров. Откорректированные показания датчиков углов п1, п1, п1 и показания маятниковых акселерометров Qxм2, Qzм2 поступают на соответствующие входы блока 10 выработки сигналов выставки ГСП. На второй вход блока 10 из задатчика 12 выдается код, соответствующий составу навигационных параметров, поступающих на первую группу входов блока 10. На третью группу входов 31-33 из задатчика 13 поступают сигналы x, y, z, соответствующие положению точки подвеса ГСП 5 относительно начала системы координат, связанной с носителем. По сигналам, поступающим на пятый вход блока 10 с таймера 19, начинается выработка сигналов D, D и D выставки гиростабилизированной платформы 5 в необходимое положение в пространстве. Выработка этих сигналов осуществляется в соответствии с блок-схемой алгоритмов, приведенной на фиг. 6. В частности, сигналы пеленга наведения Пн, угла рыскания носителя Kс, угла качки к по дифференту, по крену Qк и тангажу п1, а также сигналы систематических погрешностей x, y, z поступают на входы блока 65 формирования требуемых углов (фиг. 5). По указанной информации в соответствии с блок-схемой алгоритма, приведенной на фиг. 6, определяются значения требуемых углов *, *, * разворота колец карданова подвеса, а именно по следующим математическим зависимостям: *н-Kc+arcsin + x + y , *=arcsin(cosкsinQк)+xcos-ysin, *=arcsin + xsintg*+ycostg*+z.

Эти сигналы совместно с сигналами п1, п1, п1, полученными из блока 11, поступают в блок 64 формирования углов отклонения (фиг. 5), где в соответствии с блок-схемой алгоритмов, приведенной на фиг. 7, формируются сигналы D, D, D отклонения ГСП 5 от стартовой системы координат Oxс, Oyс, Ozс, оси которых фиксируются следующим образом: OYс вверх по местной вертикали; OXс перпендикулярно оси OYс в плоскости, проходящей через ось OYси точку, в которую должен быть выведен управляемый объект; OZс дополняет систему координат до правой.

Значения углов D, D, D определяются по следующим выражениям: D= (п1- *)sin п1-(п1- *) cos п1cos п1, D=-(п1- *)cos п1-(п1- *) sin п1cos п1, D=-( п1- *)+ ( п1- *)sin п1.

Если в НКН 17 вырабатывается и выдается информация только об углах Kс, к и Qк, то в соответствии с кодом номера состава выдаваемых параметров, записанным в задатчике 12, дешифраторы 59 и 60 вырабатывают сигналы, по которым в блоках 57 и 58 установятся коэффициенты, равные единице, а в блоках 55 и 56 равные нулю. При этом на выходах сумматоров 52 и 54 и третьем выходе блока 64 сформируются сигналы, пропорциональные управляющим сигналам Gx, Gz, Gy, поступающим на соответствующие датчики момента ГСП 5. По запускающему импульсу, поступающему на пятый вход блока 10 с таймера 19 пункта 8 управления, открываются управляемые ключи 63, 61, 62 и в блоки 72, 70, 71 памяти происходит запись управляющих сигналов Gy, Gx, Gz, которые не изменяются до момента поступления на пятый вход блока 10 выработки сигналов выставки очередного запускающего импульса.

Значения углов D, D, D сравниваются в пороговых устройствах 66, 67, 68 с заданными эталонными значениями и в момент одновременного достижения всеми указанными сигналами значений, меньших эталонных, с элемента И 69 на четвертый выход блока 10 в пульт 18 управления