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

 

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

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

Известен способ определения истинного курса с помощью гироскопического датчика угловой скорости ( см. , например, книгу Б. И. Назарова и Г. А. Хлебникова "Гиростабилизаторы ракет" М.,1975, стр 193-196), согласно которому курсовое направление, горизонтально расположенной измерительной оси гироскопа определяют аналитически путем вычислений по результам измерений горизонтальной составляющей угловой скорости вращения Земли.

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

За прототип взят способ определения истинного курса с помощью гироскопического датчика угловой скорости, основанный на его аналитическом вычислении (см. статью V.L. Budkin, S.P. Redkin "Gyrocompassing on a Movable Object by Means of Angular Rate Sensor on the Basis of Dynamically Tuned Gyro". 5th Saint Petersbury International Conference on Integrated Navigational Systems, May 25-27,1998).

В этом способе проводят гирокомпасирование с применением датчика угловой скорости на основе динамически настраиваемого гироскопа (ДУС-ДНГ) при бесплатформенной установке его на объекте. Предварительно привязывают измерительные оси гироскопа к осям, связанным с объектом, согласовывают знаки изменения напряжений с эталонных сопротивлений гироскопа с направлением азимутального поворота его корпуса вокруг оси собственного вращения, определяют коэффициенты модели дрейфа гироскопа, широту местоположения объекта, углы наклона плоскости измерительных осей гироскопа по тангажу и крену, измеряют напряжения с эталонных сопротивлений гироскопа, работающего в режиме датчика угловой скорости, а затем азимутальный угол объекта определяют с помощью выражения: где U11, U12 - напряжения с эталонных сопротивлений гироскопа соответственно по первому и второму каналам, Кн11, Кн12 - крутизна гироскопа по напряжению по первому и второму каналам, - угловая скорость вращения Земли, - широта местоположения объекта, , - углы наклона плоскости осей чувствительности гироскопа соответственно по тангажу и крену, г1ду, г1дх - дрейф гироскопа соответственно по первому и второму каналам.

В известном способе производится аналитическая компенсация дрейфа гироскопа. Для этого дрейф гироскопа может быть представлен в виде математической модели. Стационарную модель дрейфа в условиях неподвижного объекта, учитывающую дрейф, не зависящий от ускорения, дрейф от разбаланса вдоль оси собственного вращения и квадратурный дрейф, можно представить в виде: г1дx = 1x0+1x1xgx+1xgу, г1ду = 0+1xgx+gу, (2)
где 1x0, 0 - коэфффициенты модели дрейфа, характеризующие дрейф, не зависящий от ускорения,
1x1x, - коэффициенты модели дрейфа, характеризующие дрейф от разбаланса вдоль оси собственного вращения,
1x, 1x - коэффициенты модели дрейфа, характеризующие квадратурный дрейф,
gx, gу - проекции ускорения силы тяжести g на оси, связанные с гироскопом,
gx = gsincos, gу = -gsin.
Для точной аналитической компенсации дрейфа необходимо точное знание коэффициентов модели дрейфа, которые определяются предварительно в результате калибровочных испытаний гироскопа. Однако при калибровочных испытаниях эти коэффициенты определяются с погрешностями, они также изменяются в процессе наработки гироскопа и выполнить их повторные калибровочные испытания без снятия с гироскопического устройства не представляется возможным. Ошибки в задании коэффициентов модели дрейфа обуславливают погрешности гирокомпасирования.

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

Технический результат достигается тем, что в известном способе гирокомпасирования с применением гироскопического датчика угловой скорости, включающем предварительную привязку измерительных осей гироскопа к осям, связанным с объектом, использование гироскопа в режиме обратной связи по току датчика момента, определение сигналов с эталонных сопротивлений датчика угловой скорости, согласование знаков изменения сигналов с эталонных сопротивлений гироскопа с направлением азимутального поворота его корпуса вокруг оси собственного вращения, определение коэффициентов модели дрейфа гироскопа, а в рабочем режиме нахождение широты местоположения объекта, углов наклона плоскости измерительных осей гироскопа по тангажу и крену, алгоритмическую компенсацию дрейфа гироскопа, аналитическое определение нескорректированного угла К истинного курса объекта, дополнительно предварительно устанавливают гироскоп в положение, при котором угол истинного курса равен 0 o, плоскость измерительных осей гироскопа горизонтальна, измерительные оси Хг1г1 гироскопа направлены соответственно на восток и север, выполняют аналитическое гирокомпасирование и находят погрешность гирокомпасирования 01, потом устанавливают гироскоп в положение, при котором угол истинного курса равен 270 o, горизонтально расположенные измерительные оси Хг1 и Уг1 направлены соответственно на север и запад, проводят гирокомпасирование и находят погрешность гирокомпасирования 02, затем гироскоп устанавливают в положение, в котором угол истинного курса равен 0o, измерительная ось Хг1 находится в горизонте и направлена на восток, а измерительная ось Уг1 наклонена по тангажу на угол 1, проводят гирокомпасирование и находят погрешность гирокомпасирования 1, после этого гироскоп устанавливают в положение, в котором измерительная ось Хг1 находится в горизонте и направлена на север, а измерительная ось Уг1 наклонена по тангажу на угол 1, проводят гирокомпасирование и находят погрешность гирокомпасирования 2, затем гироскоп устанавливают в положение, в котором угол истинного курса равен 0o, измерительная ось Уг1 находится в горизонте и направлена на север, а измерительная ось Хг1 наклонена по крену на угол 1, выполняют гирокомпасирование и находят погрешность гирокомпасирования 1, после этого гироскоп устанавливают в положение, в котором угол истинного курса равен 270o, измерительная ось Уг1 находится в горизонте и направлена на запад, а измерительная ось Xг1 наклонена по крену на угол 1, проводят гирокомпасирование и находят погрешность гирокомпасирования 2, а затем в рабочем режиме определяют алгоритмическую компенсацию погрешности гирокомпасирования в виде следующего аналитического выражения:

где
г1дх = 1x0+1x1xgsincos-1x1ygsin,
г1дy = 1y0+1y1xgsincos-1y1ygsin,
1x0 = cossin01,
1y0 = -cossin02,
1x1y = (1x0-cossin1)(gsin1)-1,
1y1y = (1y0+coscos1sin2)(gsin1)-1,
1x1x = -(1x0-coscos1sin1)(gsin1)-1,
1y1x = -(1y0+cossiny2)(gsin1)-1,
- угловая скорость вращения Земли,
- широта местоположения объекта,
, - углы наклона плоскости осей чувствительности гироскопа соответственно по тангажу и крену,
g - ускорение силы тяжести.

Найдем аналитическое выражение для погрешности гирокомпасирования с применением датчика угловой скорости на основе динамически настраиваемого гироскопа. Для известного способа аналитическое гирокомпасирование выполняется с использованием выражения (1).

Представим выражение (1) в виде:
tg() = AB-1, (3)
где

B = (U11Kн11cos+г1дуcos-sinsincos).
Положим, что A и B есть отклонения от точных значений А и В. Эти отклонения обусловят погрешность гирокомпасирования и выражение (3) будет иметь вид:
tg(+) = (A+A)(B+B)-1. (4)
В соответствии с тригонометрической формулой сложения
tg(+) = (tg+tg)(1-tgtg)-1. (5)
Из выражения (4) с учетом (5) погрешность гирокомпасирования можно представить в следующем виде:

где

U11, U12 - погрешность измерения напряжения с эталонных сопротивлений гироскопа соответственно по первому и второму каналам,
KН11, KН12 - погрешность задания крутизны гироскопа по напряжению по первому и второму каналам,
- погрешность задания широты местоположения объекта,
, - погрешность задания углов наклона плоскости осей чувствительности гироскопа соответственно по тангажу и крену,
г1ду, г1дх - остаточный дрейф гироскопа после его алгоритмической компенсации соответственно по первому и второму каналам,
г1дх = 1x0+1x1xgsincos-1xgsin,
г1ду = 0+1xgsincos-gsin.
Для изодромной обратной связи гироскопа измеряемые с эталонных сопротивлений напряжения можно представить в следующем виде:
U11 = a11cos+a12sin+a13,
U12 = a21cos+a22sin+a23, (7)
где a11 = coscosK-1н11,
a12 = 0,
a13 = (-г1ду+sinsin)K-1н11,
a21 = -cossinsinK-1н12,
a22 = -coscosK-1н12,
a23 = (г1дх+sinsincos)K-1н12.
Подставляя (7) в (6) и полагая
после преобразований получим:

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

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

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

Для синуса погрешности гирокомпасирования можно записать следующее выражение:

Используя выражение (10), определим коэффициенты модели остаточного дрейфа через погрешность гирокомпасирования . Для этого введем следующие системы координат: Хд Уд Zд, Хс Zс Ус, Хг1 Уг1 Zг1. Система координат Хд Уд Zд является географической. Ось Хд направлена на север, ось Уд - вертикально вверх, а ось Zд - на восток. В системе координат Хд Уд Zд проекциями угловой скорости Земли являются горизонтальная составляющая cos, направленная на Север, и вертикальная составляющая sin, где - угол широты места. С объектом связана система координат Xc Ус Zc. Ось Xc направлена вдоль продольной оси объекта, ось Ус перпендикулярна оси Ус и располагается в плоскости симметрии объекта, ось Zc - перпендикулярна этой плоскости. Система координат Xг1Уг1 Zг1 связана с гироскопом. Ось Xг1 направлена по оси
чувствительности второго канала гироскопа, ось Уг1 - по оси чувствительности первого канала, а ось Zг1 - по оси собственного вращения. Вдоль оси Zг1 направлен вектор кинетического момента Н гироскопа. Пусть привязка осей гироскопа выполнена таким образом, что они совпадают с осями объекта.

Установим гироскоп в положение 1, как показано на фиг.1. В этом положении угол истинного курса равен 0o, плоскость измерительных осей гироскопа горизонтальна, измерительные оси Xг1, Уг1 гироскопа направлены соответственно на восток и север. Выполним аналитическое гирокомпасирование известным методом и найдем погрешность гирокомпасирования 01. Подставив 01 у (10), в этом положении будем иметь
1x0 = cossin01. (11)
Установим гироскоп в положение 2, как показано на фиг.1. В этом положении угол истинного курса равен 270o, горизонтально расположенные измерительные оси Xг1г1 направлены соответственно на север и запад. Проведем гирокомпасирование известным методом и определим погрешность гирокомпасирования 02. Подставив 02 в (10), в этом положении получим
0 = -cossin02. (12)
Установим гироскоп в положение 3, как показано на фиг.1. В этом положении угол истинного курса равен 0o, измерительная ось Xг1 находится в горизонте и направлена на восток, а измерительная ось Уг1 наклонена по тангажу на угол 1. Выполним гирокомпасирование известным методом и определим погрешность гирокомпасирования 1. Подставив 1 в (10), в этом положении получим:
1x = (1x0-cossin1)(gsin1)-1. (13)
Установим гироскоп в положение 4, как показано на рис. 1. В этом положении угол истинного курса равен 270o, измерительная ось Xг1 находится в горизонте и направлена на север, а измерительная ось Уг1 наклонена по тангажу на угол 1. Проведем гирокомпасирование известным методом и найдем погрешность гирокомпасирования 2. Подставив 2 в (10), в этом положении будем иметь:
= (0-coscos1sin2)(gsin1)-1. (14)
Установим гироскоп в положение 5, как показано на фиг.1. В этом положении угол истинного курса равен 0o, измерительная ось Уг1 находится в горизонте и направлена на север, а измерительная ось Xг1 наклонена по крену на угол 1. Выполним гирокомпасирование известным методом и найдем погрешность гирокомпасирования 1. Подставив 1 в (10), в этом положении будем иметь:
1x1x = -(1x0-coscos1sin1)(gsin1)-1. (15)
Установим гироскоп в положение 6, как показано на фиг. 1. В этом положении угол истинного курса равен 270o, измерительная ось Yг1 находится в горизонте и направлена на запад, а измерительная ось Xг1 наклонена по крену на угол 1. Проведем гирокомпасирование известным методом и найдем погрешность гирокомпасирования 2. Подставив 2 в (10), в этом положении будем иметь:
= -(0+cossin2)(gsin1)-1. (16)
Таким образом, предлагаемый способ алгоритмической компенсации погрешности гирокомпасирования с применением гироскопического датчика угловой скорости имеет следующие отличия от известного способа:
- в предварительной операции находят коэффициенты модели остаточного дрейфа, обусловленного несовершенством модели дрейфа, используемого в известном способе;
- в операции гирокомпасирования вводится новое действие связанное с алгоритмической компенсацией непосредственно погрешности гирокомпасирования с использованием новой аналитической зависимости;
- коэффициенты модели остаточного дрейфа находятся новым способом на основе полученных связей между коэффициентами остаточного дрейфа и соответствующих им погрешностям гирокомпасирования.

На фиг. 1 показаны системы координат: географическая, связанная с объектом гироскопом.

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

Проводилась экспериментальная сравнительная оценка погрешностей гирокомпасирования с применением известного и предлагаемого способов.

Экспериментальные исследования проводились с помощью датчика угловой скорости на основе динамически настраиваемого гироскопа ГВК-6 392116. Предварительно в калибровочных испытаниях определялись коэффициенты модели дрейфа гироскопа. Для испытываемого гироскопа коэффициенты модели дрейфа имели следующие значения:
1x0 = 0,532 град/час,
0 = -0,659 град/час,
1x = 0,827 град/часg,
= 0,094 град/часg,
1x1x = 0,275 град/часg,
1x = 0,833 град/часg.
После этих калибровочных испытаний и наработки 500 ч гироскоп был установлен на платформу наклонно-поворотного стенда. Для проведения испытаний по точности гирокомпасирования с использованием ранее полученных коэффициентов и модели дрейфа плоскость измерительных осей гироскопа наклонялась на угол тангажа =10o и угол крена =10o. Известным способом выполнялось аналитическое гирокомпасирование на разных углах истинного курса и находилась погрешность гирокомпасирования. Погрешность гирокомпасирования, полученная при использовании известного способа, представлена зависимостью 1 на фиг.2.

После этого с помощью предлагаемого способа определялись коэффициенты остаточного дрейфа. При испытаниях делались наклоны по тангажу и крену на углы 1= 10o, 1=10o. В результате были получены следующие коэффициенты остаточного дрейфа:
1x0/ = -0,055 град/час,
0 = -0,167 град/час,
1x = -0,276 град/часg,
= -0,205 град/часg,
1x1x = 0,135 град/часg,
1x = -1,215 град/часg.
На разных углах истинного курса при наклоне гироскопа по крену и тангажу на углы = =10o выполнялось гирокомпасирование с применением предлагаемой алгоритмической компенсации погрешности гирокомпасирования и скорректированное значение истинного курса определялось с помощью выражения
Kк = K-, (17)
где К - значение истинного курса, определенное известным методом;
- предлагаемая алгоритмическая компенсация погрешности гирокомпасирования, определяемая выражением (9).

Найденная погрешность гирокомпасирования с применением предлагаемой алгоритмической компенсации представлена зависимостью 2 на фиг.2.

На фиг.2 показаны экспериментальные зависимости погрешностей гирокомпасирования на разных азимутальных углах при использовании известного и предлагаемого способов. Из зависимостей, представленных на фиг.2, видно, что применение предлагаемого способа позволяет повысить точность гирокомпасирования. Так, погрешность гирокомпасирования с применением известного способа в диапазоне курсовых углов от 0 до 360o не превысила 2,6o, а при использовании предлагаемого способа погрешность в этих условиях не превысила 0,3 o. Применение предлагаемого способа позволило уменьшить погрешность гирокомпасирования в 8,7 раза.

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


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

Способ алгоритмической компенсации погрешности гирокомпасирования с применением гироскопического датчика угловой скорости, включающий предварительную привязку измерительных осей гироскопа к осям, связанным с объектом, использование гироскопа в режиме обратной связи по току датчика момента, определение сигналов с эталонных сопротивлений датчика угловой скорости, согласование знаков изменения сигналов с эталонных сопротивлений гироскопа с направлением азимутального поворота его корпуса вокруг оси собственного вращения, определение коэффициентов модели дрейфа гироскопа, а в рабочем режиме нахождение широты местоположения объекта, углов наклона плоскости измерительных осей гироскопа по тангажу и крену, алгоритмическую компенсацию дрейфа гироскопа, аналитическое определение нескорректированного угла К истинного курса объекта, отличающийся тем, что предварительно устанавливают гироскоп в положение, при котором угол истинного курса равен 0o, плоскость измерительных осей гироскопа горизонтальна, измерительные оси Хг1, Уг1 гироскопа направлены соответственно на восток и север, выполняют аналитическое гирокомпасирование и находят погрешность гирокомпасирования 01, потом устанавливают гироскоп в положение, при котором угол истинного курса равен 270o, горизонтально расположенные измерительные оси Хг1 и Уг1 направлены соответственно на север и запад, проводят гирокомпасирование и находят погрешность гирокомпасирования 02, затем гироскоп устанавливают в положение, в котором угол истинного курса равен 0o, измерительная ось Хг1 находится в горизонте и направлена на восток, а измерительная ось Уг1 наклонена по тангажу на угол 1, проводят гирокомпасирование и находят погрешность гирокомпасирования 1, после этого гироскоп устанавливают в положение, в котором угол истинного курса равен 270o, измерительная ось Хг1 находится в горизонте и направлена на север, а измерительная ось Уг1 наклонена по тангажу на угол 1, проводят гирокомпасирование и находят погрешность гирокомпасирования 2, затем гироскоп устанавливают в положение, в котором угол истинного курса равен 0o, измерительная ось Уг1 находится в горизонте и направлена на север, а измерительная ось Хг1 наклонена по крену на угол 1, выполняют гирокомпасирование и находят погрешность гирокомпасирования 1, после этого гироскоп устанавливают в положение, в котором угол истинного курса равен 270o, измерительная ось Уг1 находится в горизонте и направлена на запад, а измерительная ось Хг1 второго канала наклонена по крену на угол 1, проводят гирокомпасирование и находят погрешность гирокомпасирования 2, а затем в рабочем режиме определяют алгоритмическую компенсацию погрешности гирокомпасирования в виде следующего аналитического выражения

где г1дx = 1x0+1x1xgsincos-1x1ygsin;
г1дy = 1y0+1y1xgsincos-1y1ygsin;
1x0 = cossin01;
1y0 = -cossin02;
1x1y = (1x0-cossin1)(gsin1)-1;
1y1y = (1y0+coscos1sin2)(gsin1)-1;
1x1x = -(1x0-coscos1sin1)(gsin1)-1;
1y1x = -(1y0+cossin2)(gsin1)-1;
- угловая скорость вращения Земли;
- широта местоположения объекта;
, - углы наклона плоскости осей чувствительности гироскопа соответственно по тангажу и крену;
g - ускорение силы тяжести.

РИСУНКИ

Рисунок 1, Рисунок 2



 

Похожие патенты:

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

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

Изобретение относится к области навигации наземных транспортных средств

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

Изобретение относится к навигации наземных транспортных средств

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

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

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

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

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

Изобретение относится к измерительной технике, а именно к комплексным преобразователям параметров движения

Изобретение относится к способам управления полетом беспилотных летательных аппаратов (БПЛА)

Изобретение относится к способу и устройству для индикации вектора скорости летательного аппарата

Изобретение относится к области навигационного приборостроения с использованием магнитного поля Земли и предназначено для построения приборов измерения магнитного курса и углов наклона подвижных объектов

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

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

Изобретение относится к измерительной технике и может использоваться в инерциальных системах ориентации и навигации
Наверх