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

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

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

К = 2-arctg(a₁a₂ ^-1), если a₁>0, a₂>0;

К = -arctg(a₁a₂ ^-1), если a₁>0, a₂<0;-arctg(a₁a₂ ^-1), если a₁<0, a₂<0;1a₂ ^-1), если a₁<0, a₂>0;

где



^г1_дx, ^г1_ду - модель дрейфа гироскопа соответственно по осям Х, Y;

U₁₁, U₁₂ - напряжения с эталонных сопротивлений датчика угловой скорости соответственно по первому и второму каналам;

К_н11, К_н12 - коэффициенты крутизны гироскопа по напряжению соответственно для первого и второго каналов;

, - углы наклона плоскости осей чувствительности гироскопа соответственно по тангажу и крену;

- угловая скорость вращения Земли;

- широта местоположения объекта;

V - путевая скорость объекта;

R - радиус Земли;

h - высота объекта.

Описание изобретения к патенту

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

Известны способы определения истинного курса с помощью гироскопического датчика угловой скорости (см., например, книгу Назарова Б.И. и Хлебникова Г. А. Гиростабилизаторы ракет. - М., 1975, с.193-196 и патент RU 2098766 С1 по кл. G 01 С 21/14 от 10.12.1997), согласно которым курсовое направление горизонтально расположенной измерительной оси гироскопа на неподвижном основании определяют аналитически с использованием показаний с гироскопа, полученных на разных азимутальных углах.

За прототип взят способ определения курса с помощью двухканального гироскопического датчика угловой скорости (см. патент RU 2176708 по кл. G 01 C 21/12 от 10.12.2001).

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

K = 2-arctg a, если b₁>0, b₂>0;

K = -arctg a, если b₁>0, b₂<0;-arctg a, если b₁<0, b₂<0; (1)

K = -arctg a, если b₁<0, b₂>0;

где a = b₁b₂ ^-1,



b₂ = U₁₁К_н11cos+^г1_дуcos-sincossin,

^г1_дх,^г1_дy - модель дрейфа гироскопа по осям X, Y,

U₁₁, U₁₂ - напряжения с эталонных сопротивлений датчика угловой скорости соответственно по первому и второму каналам,

K_н11, K_н12 - крутизна гироскопа по напряжению для первого и второго каналов,

, - углы наклона плоскости осей чувствительности гироскопа соответственно по тангажу и крену,

- угловая скорость вращения Земли,

- широта местоположения объекта.

Гирокомпасирование с применением известного способа возможно в условиях неподвижного объекта. Линейное движение объекта с гироскопом относительно поверхности Земли обуславливает погрешность гирокомпасирования.

Пусть объект с гироскопом движется относительно сферической Земли с радиусом R на высоте h с линейной скоростью V, как показано на фиг.1. Объект в этом случае имеет северную V_N и восточную V_E составляющую путевой скорости. Используя азимутальный угол , характеризующий азимутальное положение вектора путевой скорости V в сопровождающей системе координат Дарбу Х_дУ_дZ_д, можно представить

V_N = Vcos,

V_E = -Vsin. (2)

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





Вследствие линейного движения объекта мгновенную угловую скорость _дн сопровождающей системы координат Х_дУ_дZ_д в проекциях на ее оси можно представить

^д_днх = -V(R+h)^-1sin,

^д_днy = -V(R+h)^-1tg,

^д_днz = -V(R+h)^-1cos. (4)

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

^г1_днх = V(R+h)^-1(sintgsincos-cos),

^г1_днy = V(R+h)^-1sintgsin. (5)

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



где





U₁₁, U₁₂ - погрешность измерения напряжений с эталонных сопротивлений датчика угловой скорости соответственно по первому и второму каналам,

K_н11, / К_н12 - погрешность задания коэффициентов крутизны гироскопа по напряжению для первого и второго каналов,

, - погрешность задания углов наклона плоскости осей чувствительности гироскопа соответственно по тангажу и крену,

- погрешность задания широты местоположения,

^г1_дх,^г1_ду - погрешность задания модели дрейфа,

V - погрешность задания путевой скорости,

h - погрешность задания высоты объекта,

R - погрешность задания радиуса Земли.

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

U₁₁ = U₁₂ = 0,15 мВ,

К_н11 = К_н12 = 3,510^-7 1/с мВ,

K_н11 = K_н12 = 3,510^-10 1/c мВ,

^г1_дх = ^г1_ду = 1 град./ч,

^г1_дх = ^г1_ду = 0,01 град./ч,

= 55,5 град.,

= 0,05 град.,

= = 0,017 град.,

= = 30 град.,

= 15 град./ч,

R = 0, h = 0,

R = 6371, 032 км, h = 5 км,

V = 100 км/ч.

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

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

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

K = 2-arctg (a₁a₂ ^-1), если a₁>0, a₂>0;

K = -arctg (a₁a₂ ^-1), если a₁>0, a₂<0;-arctg (a₁a₂ ^-1), если a₁<0, a₂<0;1a₂ ^-1), если a₁<0, a₂>0;

где





^г1_дх, ^г1_ду - модель дрейфа гироскопа соответственно по осям X, Y;

U₁₁, U₁₂ - напряжения с эталонных сопротивлений датчика угловой скорости соответственно по первому и второму каналам,

K_н11, K_н12 - коэффициенты крутизны гироскопа по напряжению соответственно для первого и второго каналов,

, - углы наклона плоскости осей чувствительности гироскопа соответственно по тангажу и крену,

- угловая скорость вращения Земли,

- широта местоположения объекта,

V - путевая скорость объекта,

R - радиус Земли,

h - высота объекта.

Схема гирокомпасирования с применением гироскопического датчика угловой скорости при бесплатформенной установке на объекте представлена на фиг.2.

При анализе этой схемы рассмотрим несколько систем координат, представленных на фиг.1 и 2.

На фиг. 1 показана геоцентрическая навигационная система координат Х_нУ_нZ_н, сопровождающая система координат Дарбу Х_дУ_дZ_д, траекторная система координат Х_тУ_тZ_т и связанная с объектом система координат. На фиг.2 дополнительно показана система координат, связанная с гироскопом X_г1У_г1Z_г1. Геоцентрическая система координат X_нУ_нZ_н связана с Землей, которая принимается за шар, в центре которого расположено начало системы координат. Оси У_н и Z_н расположены в плоскости экватора, при этом ось У_н находится на линии пересечения плоскости, образованной Гринвическим меридианом и экватором. Ось Х_н направлена по оси вращения Земли. Отсчет геоцентрической широты производится между плоскостью экватора и направлением на объект радиуса-вектора. Геоцентрическая долгота определяется как двухгранный угол между плоскостями, образованными Гринвическим меридианом и меридианом, проходящим через точку, характеризующую местоположение объекта. Система координат Дарбу Х_дУ_дZ_д является сопровождающей географической системой координат: ось Х_д направлена на север, ось У_д - вертикально вверх, а ось Z_д - на восток. Траекторная система координат X_тУ_тZ_т связана с линией пути объекта, которая является проекцией на Земную поверхность пространственной траектории его движения. Ось Х_т направлена по касательной к линии пути в направлении вектора путевой скорости V, ось У_т направлена вертикально вверх, ось Z_т направлена так, чтобы система координат была правой. В связанной с объектом системе координат Х_сУ_сZ_с начало системы помещено в центр масс объекта, оси Х_с и У_с расположены в вертикальной плоскости симметрии объекта, при этом ось Х_с направлена вдоль оси корпуса объекта, а ось У_с - по перпендикуляру к оси Х_с, лежащему в вертикальной плоскости симметрии объекта, ось Z_c перпендикулярна плоскости симметрии объекта и образует правую систему координат. В системе координат X_г1У_г1Z_г1 оси X_г1 и У_г1 расположены в измерительной плоскости гироскопа, при этом ось X_г1 направлена по измерительной оси второго канала, а ось У_г1 по измерительной оси первого канала гироскопа, ось OZ_г1 направлена вдоль оси собственного вращения гироскопа.

Гироскоп работает в режиме обратной связи по токам датчиков момента и является двухканальным датчиком угловой скорости. Первый канал гироскопа содержит датчик угла 1, измеряющий поворот корпуса гироскопа относительно измерительной оси У_г1, усилитель 2, эталонное сопротивление 3, датчик момента 4, создающий момент вокруг оси Х_г1. Второй канал содержит датчик угла 5, измеряющий поворот корпуса гироскопа относительно измерительной оси X_г1, усилитель 6, эталонное сопротивление 7, датчик момента 8, создающий момент вокруг оси У_г1. Напряжения U₁₁ и U₁₂, снимаемые с эталонных сопротивлений по первому и второму каналам, подаются в вычислитель 9.

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

U₁₁ = (^г1_y-^г1_дy)K^-1_н11,

U₁₂ = (-^г1_x-^г1_дx)K^-1_н12, (8)

где ^г1_х, ^г1_у - проекции абсолютной угловой скорости корпуса гироскопа соответственно по осям X_г1 и У_г1,

^г1_дх, ^г1_{ду =} - дрейф гироскопа соответственно по осям X_г1, У_г1.

При только линейном движении объекта с гироскопом относительно поверхности Земли на гироскоп будет действовать угловая скорость вращения Земли и угловая скорость, возникшая вследствие линейного движения, которая представлена выражением (5). Тогда при азимутальном повороте объекта на угол и наклоне по тангажу на угол и по крену на угол проекции абсолютной угловой скорости корпуса гироскопа по осям X_г1 и У_г1 можно представить в следующем виде





Подставив значения ^г1_х и ^г1_у из (9) в выражение (8), получим

C₁₁cos+C₁₂sin = d₁,

C₂₁cos+C₂₂sin = d₂,

где C₁₁ = coscos,

C₁₂ = -V(R+h)^-1tgsin,

C₂₁ = cossinsin,

C₂₂ = coscos+V(R+h)^-1tgsincos,

d₁ = U₁₁K_н11-sinsin+^г1_дy,

d₂ = -U₁₂K_н12+sinsincos+V(R+h)^-1cos+^г1_дх.

Решая уравнение (10), определяем выражение для cos и sin. В практике гирокомпасирования с применением датчика угловой скорости вычисление курсового угла проводят через функцию арктангенс. Тогда аналитическое выражение для определения азимутального угла можно представить в следующем виде:

= arctg (a₁a₂ ^-1), (11)

где





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

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

K = 2-arctg (a₁a₂ ^-1), если a₁>0, a₂>0;

K = -arctg (a₁a₂ ^-1), если a₁>0, a₂<0;-arctg (a₁a₂ ^-1), если a₁<0, a₂<0;1a₂ ^-1), если a₁<0, a₂>0.

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

- в операции гирокомпасирования введены новые действия по определению путевой скорости и высоты объекта,

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

На фиг.1 показано взаимное расположение систем координат.

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

На фиг.3 показана погрешность гирокомпасирования с применением гироскопического датчика угловой скорости при линейном движении объекта по разным азимутальным направлениям с путевой скоростью 100 км/ч.

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

U₁₁ = U₁₂ = 0,15 мВ,

К_н11 = К_н12 = 3,510^-7 1/с мВ,

K_н11 = / K_н12 = 3,510^-101/c мВ,

^г1_дх = ^г1_ду = 1 град./ч,

^г1_дх = ^г1_ду = 0,01 град./ч,

= 55,5 град.,

= 0,05 град.,

= = 0,017 град.,

= = 30 град.,

= 15 град./ч,

R = 0, h = 0,

R = 6371, 032 км, h = 5 км,

V = 100 км/ч.

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

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

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