способ гирокомпасирования с применением гироскопического датчика угловой скорости и комбинированной компенсации его дрейфа
Классы МПК: | G01C19/38 осуществляющие поиск направления на север с помощью немагнитных средств, например гирокомпасы |
Автор(ы): | Редькин С.П. |
Патентообладатель(и): | Открытое акционерное общество "Раменское приборостроительное конструкторское бюро" |
Приоритеты: |
подача заявки:
2001-07-26 публикация патента:
20.09.2002 |
Способ может быть использован при создании гирокомпасов и курсоуказывающих устройств аналитического типа. Предварительно привязывают плоскость измерительных осей гироскопа и оси собственного вращения к осям, связанным с объектом. Согласовывают знаки изменения напряжений с эталонных сопротивлений гироскопа с направлением азимутального поворота его корпуса вокруг оси собственного вращения. Определяют коэффициенты модели дрейфа гироскопа, широту местоположения объекта, углы наклона плоскости измерительных осей гироскопа по тангажу и крену. Проводят автокомпенсацию дрейфа гироскопа, не зависящего от ускорения, пропорционального ускорению вдоль оси собственного вращения, пропорционального второй степени ускорения вдоль осей гироскопа, от совместного действия ускорений по измерительным осям гироскопа, для чего совмещают измерительную ось первого канала гироскопа с продольной осью объекта и измеряют в этом первом положении напряжения с эталонных сопротивлений его двух каналов. Затем поворачивают гироскоп вокруг оси собственного вращения на 180o относительно первого положения и в этом втором положении измеряют напряжения с эталонных сопротивлений каналов гироскопа. Находят разность измеренных напряжений по двум каналам в этих положениях. Вычисляют по аналитическому выражению значение угла истинного курса, компенсируя алгоритмически оставшуюся часть дрейфа гироскопа. Обеспечивается повышение точности гирокомпасирования. 2 ил.
Рисунок 1, Рисунок 2
Формула изобретения
Способ гирокомпасирования с применением гироскопического датчика угловой скорости и комбинированной компенсации его дрейфа, включающий предварительную привязку плоскости измерительных осей гироскопа и оси собственного вращения к осям, связанным с объектом, согласование знаков изменения напряжений с эталонных сопротивлений гироскопа с направлением азимутального поворота его корпуса вокруг оси собственного вращения, определение коэффициентов модели дрейфа гироскопа, широты местоположения объекта, углов наклона плоскости измерительных осей гироскопа по тангажу и крену, отличающийся тем, что при гирокомпасировании проводят автокомпенсацию дрейфа гироскопа, не зависящего от ускорения, пропорционального ускорению вдоль оси собственного вращения, пропорционального второй степени ускорения вдоль осей гироскопа, от совместного действия ускорений по измерительным осям гироскопа, для чего совмещают измерительную ось первого канала гироскопа с продольной осью объекта и измеряют в этом первом положении напряжения с эталонных сопротивлений его двух каналов, после этого поворачивают гироскоп вокруг оси собственного вращения на 180o относительно первого положения и в этом втором положении измеряют напряжения с эталонных сопротивлений каналов гироскопа, находят разность измеренных напряжений по двум каналам в этих положениях, а затем вычисляют значение угла истинного курса, компенсируя алгоритмически оставшуюся часть дрейфа гироскопа, по следующей формуле:к= 2-arctg(b1b2 -1), если b1>0, b2>0;
к= -arctg(b1b2 -1), если b1>0, b2<0;
-arctg(b1b2 -1), если b1<0, b2<0;
1b2 -1), если b1<0, b2>0,
где
r1дx, r1ду - модель дрейфа гироскопа по осям Xr1, Yr1;
1x1x1, 1x1y1, 1y1y1, 1y1x1 - коэффициенты модели дрейфа пропорциональные ускорению в первой степени;
- коэффициенты модели дрейфа, пропорциональные ускорению во второй степени;
U111, U121 - напряжения с эталонных сопротивлений датчика угловой скорости соответственно по первому и второму каналам в исходном положении;
U112, U122 - напряжения с эталонных сопротивлений датчика угловой скорости соответственно по первому и второму каналам в положении после поворота гироскопа на 180o;
Кн11, Кн12 - крутизна гироскопа по напряжению по первому и второму каналу;
, - углы наклона плоскости осей чувствительности гироскопа соответственно по тангажу и крену;
- угловая скорость вращения Земли;
- широта местоположения объекта.
Описание изобретения к патенту
Изобретение относится к области точного приборостроения, преимущественно гироскопического, и может быть использовано при создании гирокомпасов и курсоуказывающих устройств аналитического типа. Известен способ определения истинного курса с помощью гироскопического датчика угловой скорости (см., например, книгу Б.И. Назарова и Г.А. Хлебникова "Гиростабилизаторы ракет" М., 1975, стр.193-196), согласно которому курсовое направление горизонтально расположенной измерительной оси гироскопа определяют аналитически путем вычислений по результатам измерений горизонтальной составляющей угловой скорости вращения Земли. С целью повышения точности определения курса применяют методы, направленные на уменьшение влияния дрейфа гироскопа. Так гироскопический датчик угловой скорости, измерительная ось которого расположена в плоскости горизонта, поворачивают на разные азимутальные углы и снимают на этих углах выходную информацию с гироскопа в виде электрического напряжения с эталонного сопротивления, стоящего в цепи обратной связи. На основе того, что ряд моментов гироскопа, не связанных с его корпусом, меняют знак при разворотах его в азимуте, разработаны известные методы, которые позволяют выполнить взаимную компенсацию вредных моментов. Однако эти известные методы автокомпенсации не позволяют полностью исключить погрешность определения курса от вредных моментов гироскопа, а также от других источников, например, невыставки осей чувствительности в горизонт. За прототип взят способ определения истинного курса с помощью гироскопического датчика угловой скорости, основанный на его аналитическом вычислении (см. статью V.L. Budkin, S.P. Rеdkin "Gyrocompassing on a Movable Object by Means of Angular Rate Sensor on the Basis of Dynamically Tuned Gyro". Second International Symposium on Inertial Technology in Beijing. Beijing, China, October, 1988, pp. 143-151). В этом способе проводят гирокомпасирование с применением датчика угловой скорости на основе динамически настраиваемого гироскопа (ДУС-ДНГ) при бесплатформенной установке его на объекте. Предварительно привязывают измерительные оси гироскопа к осям, связанным с объектом, согласовывают знаки изменения напряжений с эталонных сопротивлений гироскопа с направлением азимутального поворота его корпуса вокруг оси собственного вращения, определяют коэффициенты модели дрейфа гироскопа, широту местоположения объекта, углы наклона плоскости измерительных осей гироскопа по тангажу и крену, измеряют напряжения с эталонных сопротивлений гироскопа, работающего в режиме датчика угловой скорости, а затем азимутальный угол объекта определяют с помощью выражениягде U11, U12 - напряжения с эталонных сопротивлений гироскопа соответственно по первому и второму каналам,
Кн11, Кн12 - крутизна гироскопа по напряжению по первому и второму каналам,
- угловая скорость вращения Земли,
- широта местоположения объекта,
, - углы наклона плоскости осей чувствительности гироскопа соответственно по тангажу и крену,
г1ду,г1дx - дрейф гироскопа соответственно по первому и второму каналам. В известном способе производится аналитическая компенсация дрейфа гироскопа. Для этого дрейф гироскопа может быть представлен в виде математической модели. При изодромной обратной связи гироскопа в установившемся режиме стационарную модель дрейфа гироскопа можно представить в виде
где fx, fy, fz - составляющие удельной силы вдоль положительных направлений осей, связанных с гироскопом,
1x0,1y0 - коэффициенты модели дрейфа, не зависящие от ускорения,
1x1x,1x1y,1x1z,1y1x,1y1y,1y1z - коэффициенты модели дрейфа, пропорциональные ускорению в первой степени,
- коэффициенты модели дрейфа, пропорциональные ускорению во второй степени. Для неподвижного объекта уравнения (2) могут быть выражены через составляющие ускорения силы тяжести путем подстановки
fx=gx, fy=gy, fz=gz. (3)
Для точной аналитической компенсации дрейфа необходимо точное знание коэффициентов модели дрейфа, которые определяются предварительно в результате калибровочных испытаний гироскопа. Однако часть этих коэффициентов является нестабильной от запуска к запуску, а также изменяется в процессе временной наработки прибора, что обуславливает погрешность гирокомпасирования. Одними из наиболее изменяющихся коэффициентов являются коэффициенты 1x0,1y0, не зависящие от ускорения. Так в динамически настраиваемых гироскопах основным фактором, обуславливающим дрейф, не зависящий от ускорения, является газодинамический момент. Газодинамический момент возникает при вращении ротора в герметичной среде прибора, заполненной газом. В процессе эксплуатации прибора во внутреннюю полость гироскопа происходит газовыделение из его элементов, а особенно из смазки шарикоподшипниковой опоры. Это выделение изменяет параметры газовой среды, а следовательно, и вредного газодинамического момента. Изменение газодинамического момента влечет изменение коэффициентов, не зависящих от ускорения, вследствие чего появляется погрешность алгоритмической компенсации дрейфа гироскопа и ошибка гирокомпасирования. Техническим результатом, который может быть получен при осуществлении настоящего изобретения, является повышение точности гирокомпасирования с применением гироскопического датчика угловой скорости. Технический результат достигается тем, что в известном способе гирокомпасирования с применением датчика угловой скорости, включающем предварительную привязку плоскости измерительных осей гироскопа и оси собственного вращения к осям, связанным с объектом, согласование знаков изменения напряжений с эталонных сопротивлений гироскопа с направлением азимутального поворота его корпуса вокруг оси собственного вращения, определение коэффициентов модели дрейфа гироскопа, широты местоположения объекта, углов наклона плоскости измерительных осей гироскопа по тангажу и крену, дополнительно при гирокомпасировании проводят автокомпенсацию дрейфа гироскопа, не зависящего от ускорения, пропорционального ускорению вдоль оси собственного вращения, пропорционального второй степени ускорения вдоль осей гироскопа, от совместного действия ускорений по измерительным осям гироскопа, для чего совмещают измерительную ось первого канала гироскопа с продольной осью объекта и измеряют в этом первом положении напряжения с эталонных сопротивлений его двух каналов, после этого поворачивают гироскоп вокруг оси собственного вращения на 180 градусов относительно первого положения и в этом втором положении измеряют напряжения с эталонных сопротивлений каналов гироскопа, находят разность измеренных напряжений по двум каналам в этих положениях, а затем вычисляют значение угла истинного курса, компенсируя алгоритмически оставшуюся часть дрейфа гироскопа, по следующей формуле
к=2-arctg (b1b2 -1), если b1>0, b2>0;
к=-arctg (b1b2 -1), если b1>0, b2<0;
-arctg (b1b2 -1), если b1<0, b2<0;
1b2 -1), если b1<0, b2>0; (4)
где
г1дх, г1ду - модель дрейфа гироскопа по осям X, Y,
1x1x1, 1x1y1, 1y1y1, 1y1x1- коэффициенты модели дрейфа, пропорциональные ускорению в первой степени,
- коэффициенты модели дрейфа, пропорциональные ускорению во второй степени,
U111, U121 - напряжения с эталонных сопротивлений датчика угловой скорости соответственно по первому и второму каналам в исходном положении,
U112, U122 - напряжения с эталонных сопротивлений датчика угловой скорости соответственно по первому и второму каналам в положении после поворота гироскопа на 180 градусов,
Кн11, Кн12 - крутизна гироскопа по напряжению по первому и второму каналам,
, - углы наклона плоскости осей чувствительности гироскопа соответственно по тангажу и крену,
- угловая скорость вращения Земли,
- широта местоположения объекта. Рассмотрим схему аналитического гирокомпаса с применением гироскопического датчика угловой скорости, представленную на фиг.1. В гирокомпасе используется динамически настраиваемый гироскоп 1 (ДНГ). ДНГ установлен на поворотную платформу 2 устройства позиционирования гироскопа, реализующего повороты на заданные углы вокруг оси собственного вращения гироскопа. Устройство позиционирования имеет двигатель 3 и датчик угла 7 и обеспечивает повороты гироскопа на угол . На корпусе гироблока гирокомпаса установлены три акселерометра 4, 5, 6 для определения углов , наклона плоскости измерительных осей гироскопа по тангажу и крену. Гирокомпасированием определяется астрономический азимут входящей нормали оптического элемента 8, размещенного на корпусе гироблока компаса. Блок электроники 6 включает сервисную электронику гироскопа, акселерометров, устройства позиционирования и электронику измерения и обработки информации. Рассмотрим систему координат Хд Yд Zд, которая является географической. Ось Хд направлена на север, ось Yд - вертикально вверх, а ось Zд - на восток. В системе координат Хд Yд Zд проекциями угловой скорости Земли являются: горизонтальная составляющая cos, направленная на север, и вертикальная составляющая sin, где - угол широты места. С гироскопом свяжем систему координат r1 Yr1 Zr1. Ось Xr1 направлена по оси чувствительности второго канала гироскопа, ось Yr1 - по оси чувствительности первого канала, а ось Zr1 - по оси собственного вращения. Систему координат Хс Yc Zc свяжем с объектом. Ось Хс направлена вдоль продольной оси объекта, ось Yc перпендикулярна оси Yc и располагается в плоскости симметрии объекта, ось Zc - перпендикулярна этой плоскости. Входящая нормаль оптического элемента привязана к осям чувствительности гироскопа. При установке гирокомпаса на объект и привязки входящей нормали оптического элемента к его продольной оси, с помощью компаса возможно определение угла истинного курса объекта. В исходном положении 1 гироскопа при = 0 в установившемся режиме для изодромной обратной связи напряжения с эталонных сопротивлений датчика угловой скорости можно представить в следующем виде
U111 = K-1H11(г1y1-Mx11H-1),
U121 = K-1H12(-г1x1-My11H-1), (5)
где
г1y1 = coscoscos+sinsin,
a1x1 = gsincos,
a1y1 = -gsin,
a1z1 = -gcoscos.
При повороте корпуса гироскопа вокруг оси собственного вращения на угол = 180 градусов относительно исходного положения показания гироскопа можно представить в виде
U112 = K-1H11(г1y2-Mx12H-1),
U122 = K-1H12(-г1x2-My12H-1). (6)
Проекции абсолютной угловой скорости на входные оси гироскопа в этом положении 2 имеют вид
г1x2 = -г1x1,
г1y2 = -г1y1.
Вредные моменты, действующие в положении 2 по осям гироскопа, можно записать в виде
a1x2 = -gsincos,
a1y2 = gsin,
a1z2 = -gcoscos.
Вычитая из выражения (5) выражение (6), получим
U111-U112 = K-1H11[(г1y1-г1y2)-(Mx11-Mx12)H-1],
U121-U122 = K-1H12[(-г1x1-г1x2)-(My11-My12)H-1], (7)
где
г1x1-г1x2 = 2г1x1,
г1y1-г1y2 = 2г1y1,
Из выражения (7) видно, что вычитанием из показаний гироскопа в положении 1 показаний в положении 2 удалось скомпенсировать, с точностью до стабильности в этих положениях моментных коэффициентов, следующие моменты:
- моменты M1x0,M1y0, не зависящие от ускорения,
- моменты M1x1za1z,M1y1za1z, пропорциональные ускорению вдоль оси собственного вращения,
- моменты M1x1y1za21y,M1y1x1za21x, пропорциональные второй степени ускорения вдоль осей xг1, yг1,
- моменты M1x1z1ya21z,M1y1z1xa21z, пропорциональные второй степени ускорения вдоль оси zг1,
- моменты M1x1x1za1xa1y,M1y1y1za1ya1x от перекрестного влияния xz,yz при действии ускорений a1x, a1y. Практически изменение коэффициентных моментов мало при переводе гироскопа из одного положения в другое. С учетом этого величинами M1x1= M1y1 можно пренебречь. Тогда можно представить
С учетом (5), (10) уравнение (7) представим в виде
t11cos+t12sin = r1,
t21cos+t22sin = r2, (11)
где
t11 = 2coscos,
t12 = 0,
t21 = 2cossinsin,
t22 = 2coscos,
r1 = (U111-U112)Kн11+г1дy-2sinsin,
r2 = -(U121-U122)Kн12+г1дx+2sinsincos.
Решая уравнение (11), получим
Используя (12), искомый азимутальный угол определим в следующем виде
При использовании функции тангенса квадрант, в котором расположен азимутальный угол , может быть вычислен по соотношению знаков b1, b2. Зная квадрант, формулу для вычисления угла истинного курса можно представить в виде
к = 2-arctg (b1b2 -1), если b1>0, b2>0;
к = -arctg (b1b2 -1), если b1>0, b2<0;
-arctg (b1b2 -1), если b1<0, b2<0;
1b2 -1), если b1<0, b2>0;
Таким образом, предлагаемый способ гирокомпасирования с применением датчика угловой скорости и комбинированной компенсации его дрейфа имеет следующие отличия от известного способа:
- в предварительной операции по определению коэффициентов модели дрейфа гироскопа не требуется определение всех известных коэффициентов модели дрейфа, так как используется принцип автокомпенсации части составляющих модели дрейфа, таким образом применен новый комбинированный способ компенсации дрейфа, включающий автокомпенсацию наиболее нестабильной при наработке части дрейфа, которую трудно с высокой точностью скомпенсировать алгоритмически, и алгоритмическую компенсацию оставшихся составляющих дрейфа;
- в операции гирокомпасирования вводятся новые действия, связанные с поворотом гироскопа вокруг оси собственного вращения на 180 градусов при возможных больших углах его наклона и измерением показаний на этом угле, что обеспечивает выполнение автокомпенсации части составляющих дрейфа гироскопа в наклонном положении;
- определение истинного курсового угла производится по новой аналитической зависимости, в которой аналитически компенсируется только часть составляющих дрейфа, так как другая часть исключена применением режима автокомпенсации. На фиг.1 представлена схема аналитического гирокомпаса с применением датчика угловой скорости на основе динамически настраиваемого гироскопа. На фиг.2 показано изменение курсового угла от запуска к запуску с применением датчика угловой скорости на основе ГВК-6 при использовании известного и предлагаемого способов. Проводилась экспериментальная сравнительная оценка стабильности от запуска к запуску измерений курсового угла при гирокомпасировании с помощью гироскопического датчика угловой скорости с применением известного и предлагаемого способов. Экспериментальные исследования проводились с помощью датчика угловой скорости на базе динамически настраиваемого гироскопа ГВК-6 392116. Предварительно определялись коэффициенты модели дрейфа гироскопа. Затем динамически настраиваемый гироскоп ГВК-6 устанавливался на платформу наклонно-поворотного стенда таким образом, что измерительная ось гироскопа Yr1 имела курсовой угол К=1,65 град, а плоскость измерительных осей гироскопа имела наклон по тангажу =20 град и по крену =-20 град. Делалось пять запусков гироскопа по одному запуску в день. Определялся курсовой угол с применением известного и предлагаемого способов как среднее значение показаний за время измерения. При этом в предлагаемом способе использовались напряжения с эталонных сопротивлений гироскопа, полученные на исходном угле и после поворота гироскопа вокруг оси собственного вращения на 180 градусов, а в известном способе использовались те же напряжения, но только в исходном положении. Определялись изменения показаний курсового угла относительно его значения в первом запуске. На фиг.2 показано изменение курсового угла от запуска к запуску при гирокомпасировании с применением датчика угловой скорости на основе ГВК-6 при использовании известного и предлагаемого способов. Из зависимостей, представленных на фиг.2, видно, что применение предлагаемого способа позволяет повысить стабильность показаний при гирокомпасировании в различных запусках. Так изменение курсового угла при гирокомпасировании в 5 запусках находилось в пределах трубки шириной 0,53 град при использовании известного способа и в пределах трубки шириной 0,19 град при применении предлагаемого способа, что в 2,8 раза меньше. Использование предлагаемого способа гирокомпасирования с применением гироскопического датчика угловой скорости и комбинированной компенсации его дрейфа обеспечивает по сравнению с существующим способом повышение точности гирокомпасирования. Повышение точности гирокомпасирования расширяет область применения гирокомпасных устройств, например, появляется возможность применения их в геодезии, строительстве, авиации при начальной выставке по курсу бесплатформенных курсовертикалей и инерциальных систем.
Класс G01C19/38 осуществляющие поиск направления на север с помощью немагнитных средств, например гирокомпасы