патент
№ RU 2667320
МПК G01C23/00

СПОСОБ УПРАВЛЕНИЯ ЦИФРОВОЙ ПЛАТФОРМОЙ В БЕСПЛАТФОРМЕННОЙ ГИРОВЕРТИКАЛИ И УСТРОЙСТВО ДЛЯ ЕГО РЕАЛИЗАЦИИ

Авторы:
Галкин Виктор Иванович
Номер заявки
2017138282
Дата подачи заявки
02.11.2017
Опубликовано
18.09.2018
Страна
RU
Как управлять
интеллектуальной собственностью
Чертежи 
1
Реферат

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

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

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

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

Описание

[1]

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

[2]

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

[3]

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

[4]

Прототипом заявленного изобретения является способ управления бесплатформенной гировертикалью с радиальной коррекцией и устройство для реализации этого способа (Патент РФ №2574379, МПК: G01C 23/00, опубл. 10.02.2016 г.).

[5]

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

[6]

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

[7]

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

[8]

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

[9]

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

[10]

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

[11]

На Фиг. представлена структурно-функциональная блок-схема предложенной бесплатформенной гировертикали, где:

[12]

1 - трехосный блок датчиков угловых скоростей;

[13]

2 - трехосный блок датчиков линейных ускорений;

[14]

3 - блок цифровой платформы;

[15]

4 - блок пересчета линейных ускорений из связанной системы координат в инерциальную;

[16]

5 - блок управления цифровой платформой с возможностью отключения управления цифровой платформой при превышении допустимых для управления значений величин линейных ускорений в инерциальной системе координат и включения управления цифровой платформой при достижении допустимых для управления значений величин линейных ускорений в инерциальной системе координат;

[17]

6 - блок вычисления углов крена и тангажа;

[18]

7 - блок включения приведения цифровой платформы;

[19]

8 - блок приведения цифровой платформы для вычисления и компенсации ошибок положения цифровой платформы при превышении допустимых для управления значений величин линейных ускорений в инерциальной системе координат;

[20]

9 - блок фильтрации линейных ускорений в связанной системе координат;

[21]

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

[22]

Заявленные способ и устройство работают следующим образом.

[23]

Информация об угловых скоростях в связанной системе координат по трем ортогональным осям летательного объекта передается из трехосного блока микромеханических датчиков угловых скоростей 1 в блок 3 цифровой платформы, в котором производится преобразование приращения углов из связанной системы координат в инерциальную и расчет углового положение цифровой платформы в виде коэффициентов aN матрицы направляющих косинусов. Коэффициенты матрицы направляющих косинусов передаются в блок 4 и в блок 6.

[24]

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

[25]

Информация о линейных ускорениях в связанной системе координат по трем ортогональным осям летательного объекта передается из трехосного блока микромеханических акселерометров 2 в блоки 4 и 9.

[26]

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

[27]

Результаты расчета в виде проекций ускорений на инерциальные оси Ах,у передаются в блоки 5, 8, 10.

[28]

В блоке 5 рассчитывается угловая скорость управления цифровой платформой , корректирующая положение цифровой платформы в блоке 3 по перекрестным инерциальным осям:

[29]

,

[30]

где ky - коэффициент усиления сигнала управления.

[31]

Если углы крена и тангажа определены с ошибкой, вызванной, например, дрейфом гироскопов или угловой скоростью облета вокруг Земли, то проекции ускорений на инерциальные оси не будут равны нулю Ах,у≠0. В результате, в блоке 5 будет сформирован корректирующий сигнал , с помощью которого в блоке 3 будет скомпенсирована ошибка углового положения цифровой платформы.

[32]

Действие линейных ускорений по связанным осям летательного объекта axl,yl,zl≠0 также будет вызывать появление в блоке 4 ускорений по инерциальным осям Аx,y, а, следовательно, и сигналы обратной связи . Однако в этом случае они будут не компенсировать ошибки определения углового положения цифровой платформы, а, наоборот, создавать их.

[33]

Величина допустимого значения Аa,y≤АД определяется заданными ошибками определения углов крена и тангажа.

[34]

При больших линейных ускорениях, когда Аx,y становится равной или больше АД, обратная связь системы управления разрывается - . В этот момент ошибки определения углов крена и тангажа будут возрастать из-за дрейфа гироскопов и скорости облета Земли.

[35]

При исчезновении линейных ускорений, вызванных разгонными двигателями летательного аппарата или виражами и координированными разворотами, величина накопленной ошибки определения углов, определяемая величиной Ах,у, может оказаться больше допустимой (Ax,yД), что не позволит включиться обратной связи в блоке управления цифровой платформой 5.

[36]

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

[37]

В блоке 7 по информации, поступающей из блока 9, анализируется величина, действующих по связанным осям линейных ускорений в виде:

[38]

,

[39]

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

[40]

При в блоке 7 вырабатывается признак С=0, передаваемый в блок 10 и разрешающий включение приведения цифровой платформы в область значений Аx,y, допустимых для управления цифровой платформой. При вырабатывается признак С=1, запрещающий включение приведения гировертикали. Значение допустимого определяется коэффициентом δ, который устанавливается в соответствии с техническим заданием.

[41]

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

[42]

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

[43]

Минимизация ошибок, вызванных запаздыванием выработки признака С, осуществляется следующим образом. В блоке 10 анализируются ускорения по инерциальным осям Аx,y, текущее значение признака С и предыдущее значение Спред. В блоке 10 установлены следующие условия, которые определяют три возможных режима обратной связи.

[44]

Если признак С=1, то управление цифровой платформой не производится (обратная связь отключена).

[45]

Если признак С=0, Спред=0 и Аx,yд, то приведение цифровой платформы производится с ограниченной скоростью ωмин, обеспечивающей компенсацию дрейфа гироскопа.

[46]

Если признак С=0, Спред=1 и Аx,yд, то приведение цифровой платформы осуществляется со скоростью, выработанной в блоке 8:

[47]

[48]

где kп - коэффициент усиления сигнала приведения.

[49]

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

Как компенсировать расходы
на инновационную разработку
Похожие патенты