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

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

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

_0,к=0,25·(n_кm_к-1-m _кn_к-1)+ _0,к-1,

где









С_фп,к - приборная синфазная составляющая сигнала датчика угла гироскопа по косинусному каналу на к-м такте вычислений;

С_квп,к - приборная квадратурная составляющая сигнала датчика угла по косинусному каналу на к-м такте;

S_фп,к - приборная синфазная составляющая сигнала датчика угла по синусному каналу на к-м такте;

S_квп,к - приборная квадратурная составляющая сигнала датчика угла по синусному каналу на к-м такте;

С _фп,к-1 - приборная синфазная составляющая сигнала датчика угла по косинусному каналу на к-1-ом такте;

С_квп,к-1 - приборная квадратурная составляющая сигнала датчика угла по косинусному каналу на к-1-ом такте;

S_фп,к-1 - приборная синфазная составляющая сигнала датчика угла по синусному каналу на к-1-ом такте;

S_квп,к-1 - приборная квадратурная составляющая сигнала датчика угла по синусному каналу на к-1-ом такте;

С_ф - коэффициент, корректирующий постоянную ошибку определения синфазной составляющей сигнала датчика угла по косинусному каналу;

С_кв - коэффициент, корректирующий постоянную ошибку определения квадратурной составляющей сигнала датчика угла по косинусному каналу;

S_ф - коэффициент, корректирующий постоянную ошибку определения синфазной составляющей сигнала датчика угла по синусному каналу;

S_кв - коэффициент, корректирующий постоянную ошибку определения квадратурной составляющей сигнала датчика угла по синусному каналу;

_0,к-1 - угол ориентации волны относительно резонатора, определенный на к-1-ом такте.

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

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

В современном гироскопическом приборостроении известны способы определения стоячей волны относительно резонатора твердотельного волнового гироскопа, в котором измеряют сигналы ₁=Acos tcos2 ,

₂=Acos tsin2 с датчиков угла гироскопа,

где А - амплитуда колебаний резонатора,

- угол ориентации стоячей волны,

- круговая частота колебаний рабочей формы, t - время. Используя эти сигналы ,угол ориентации волны определяют из выражения 2 =arctg ₂/ ₁ (см., например, книгу В.А.Матвеева, В.И.Липатникова, А.В.Алехина «Проектирование волнового твердотельного гироскопа». - М., 1998, стр.50).

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

За прототип взят способ определения ориентации стоячей волны в твердотельном волновом гироскопе, использующий приращение на к-том такте вычислений угла ориентации волны к вычисленному углу на предыдущем к-1 такте (см. отчет ИПМ РАН № 1274 «Теоретические исследования, разработка методик, программно-методического обеспечения, регулировки и испытаний твердотельного волнового гироскопа». - М., 1998).

В этом способе для определения ориентации стоячей волны в твердотельном волновом гироскопе по «измерительным» каналам косинуса «С» и синуса «S» измеряют сигналы датчиков углов гироскопа, выделяют синфазные С_ф, S_ф и квадратурные С_кв, S_кв составляющие этих сигналов. Определяют тригонометрические функции синуса и косинуса угла ориентации стоячей волны, используя синфазные и квадратурные составляющие сигналов датчиков углов

;

где

;

.

Для расчета угла 4 ₀ запоминают его значение и значения его тригонометрических функций на предыдущем шаге съема показаний к-1 4 _0,к-1, соз4 _0,к-1, sin4 _0,к-1.

Вычисляют новые значения тригонометрических функций на к-м шаге cos4 ₀, sin4 _0,к.

Новое значение угла 4 _0,к рассчитывают по формуле

где (4 ₀)_к=sin (4 ₀)_к=sin4 _0,кcos4 _0,к-1-cos4 _0,кsin4 _0,к-1.

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

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

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

где

С_ф,к, S_ф,к, С_ф,к-1, S_ф,к-1 - истинные значения синфазных составляющих по каналам косинуса «С» и синуса «S» на к и к-1 тактах вычислений;

С_кв,к, S_кв,к, С_кв,к-1, S _кв,к-1 - истинные значения квадратурных составляющих по каналам «С» и «S» на к и к-1 тактах;

С_ф,к, S_ф,к, С_ф,к-1, S_ф,к-1 - погрешности выработки синфазных составляющих по каналам «С» и «S» на к и к-1 тактах;

С_кв,к, S_кв,к, _Скв,к-1, S_кв,к-1 - погрешности выработки квадратурных составляющих по каналам «С» и «S» на к и к-1 тактах.

Вырабатываемые приборные значения углов на к-м и к-1 такте и приращение угла на к-м такте:

где

4 _0,к,4 _0,к-1 - истинные значения углов на к и к-1 тактах;

(4 ₀)_к - истинное значение приращения угла на к такте;

4 _0,к; 4 _0,к-1 - погрешности выработки углов на к и к-1 тактах;

(4 ₀)_к - погрешность выработки угла на к-м такте.

С учетом (4) погрешность определения угла ориентации волны на к-м такте можно представить

Рассмотрим погрешность определения угла, вызванную погрешностью приращения угла (4 ₀)_к.

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

В выражениях (3) истинные значения синфазных и квадратурных составляющих по измерительным каналам косинуса и синуса можно представить:

где

a - большая полуось эллипсовидной траектории точки в плоскости CS, изображающей состояние резонатора, b - малая полуось эллипсовидной траектории точки в плоскости CS, изображающей состояние резонатора.

Используя выражения (1), (2), (3), (6), погрешность приращения угла можно представить в виде:

где

(4 ₀)_к=sin4 _0,кcos4 _0,к-1-cos4 _0,кsin4 _0,к-1.

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

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

1 - скорость прецессии волны 12,4°/ч;

2 - скорость прецессии волны 24,8°/ч;

3 - скорость прецессии волны 37,2°/ч.

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

Ширина трубки изменения этой погрешности на угле периодичности также обусловлена величиной скорости прецессии волны.

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

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

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

где

где

С_фп,к - приборная синфазная составляющая сигнала датчика угла гироскопа по косинусному каналу на к-м такте вычислений;

С_квп,к - приборная квадратурная составляющая сигнала датчика угла по косинусному каналу на к-м такте;

S_фп,к - приборная синфазная составляющая сигнала датчика угла по синусному каналу на к-м такте;

S_квп,к - приборная квадратурная составляющая сигнала датчика угла по синусному каналу на к-м такте;

С_фп,к-1 - приборная синфазная составляющая сигнала датчика угла по косинусному каналу на к-1-ом такте вычислений;

С_квп,к-1 - приборная квадратурная составляющая сигнала датчика угла по косинусному каналу на к-1-ом такте вычислений;

S_фп,к-1 - приборная синфазная составляющая сигнала датчика угла по синусному каналу на к-1-ом такте вычислений;

S_квп,к-1 - приборная квадратурная составляющая сигнала датчика угла по синусному каналу на к-1-ом такте вычислений;

С_ф - коэффициент, корректирующий постоянную ошибку определения

синфазной составляющей сигнала датчика угла по косинусному каналу;

C_кв - коэффициент, корректирующий постоянную ошибку определения квадратурной составляющей сигнала датчика угла по косинусному каналу;

S_ф- коэффициент, корректирующий постоянную ошибку определения

синфазной составляющей сигнала датчика угла по синусному каналу;

S_кв - коэффициент, корректирующий постоянную ошибку определения квадратурной составляющей сигнала датчика угла по синусному каналу;

_0,к-1 - угол ориентации волны относительно резонатора, определенный на к-1-ом такте.

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

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

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

где

_до( ₀+ ₁) - систематическая составляющая скорости дрейфа волны, не зависящая от угловой скорости платформы и зависящая от угла ориентации волны ₀ с начальной фазой ₁;

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

_п1 - первое значение эталонной угловой скорости, задаваемой платформе;

_д1( ₁+ ₂, _п) - систематическая составляющая эквивалентной скорости дрейфа, зависящая от входной угловой скорости _п угла ориентации волны ₀ с начальной фазой ₂;

₂ - начальная фаза зависимости показаний гироскопа.

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

где

_п2 - второе значение эталонной угловой скорости, задаваемой платформе;

_д2( ₁+ ₂) - систематическая составляющая эквивалентной скорости дрейфа, зависящая от входной угловой скорости _п и угла ориентации волны ₀ с начальной фазой ₂.

Экспериментальные исследования показали, что систематическая составляющая _до( ₀+ ₁) имеет синусоидальную зависимость от угла ₀ с периодичностью 180°. Составляющие _{3В, п1, п2} в выражениях (10) (11) являются постоянными составляющими. Составляющие _д1( ₀+ ₂), _д2( ₀+ ₂), как показано на фиг.1, имеют синусоидальную зависимость от угла ₀. Фазы ₁ и ₂ могут быть разными и быть обусловлены конструкционными параметрами и погрешностями выработки синфазных и квадратурных составляющих сигнала датчика угла гироскопа.

Таким образом, зависимости ₁( ₀+ ₃, _п) и ₂( ₀+ ₃, _п) являются синусоидальными и периодическими. Их изменения на заданном угловом диапазоне ориентации волны при измерениях можно характеризовать шириной трубок соответственно ₁ и ₂.

Учитывая, что _д1( ₀+ ₂, _n) и _д2( ₀+ ₂, _n) также зависят от погрешностей выработки синфазных и квадратурных составляющих сигналов по информационным каналам косинуса и синуса, то подбирают корректирующие коэффициенты к этим синфазным и квадратурным составляющим таким образом, чтобы обеспечить минимальную разницу между ₁ и ₂, что происходит, когда _д1( ₀+ ₂, _n) и _д2( ₀+ ₂, _n) стремятся к нулевой величине.

Используя соотношения (7) с учетом (6) и (9), получаем рабочую формулу (8) предлагаемого способа определения угла ориентации стоячей волны.

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

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

а) новые действия по установке гироскопа на платформу поворотного стола и заданию с помощью платформы последовательно двух значений угловых скоростей по входной оси гироскопа;

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

в) новое действие по определению разности в ширине трубок изменения показаний гироскопа при двух угловых скоростях по входной оси гироскопа;

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

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

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

На фиг.2 изображены показания гироскопа в зависимости от угла ориентации относительно резонатора волны при входной угловой скорости 10°/ч.

На фиг.3 изображены показания гироскопа в зависимости от угла ориентации волны относительно резонатора при входной угловой скорости 20°/ч.

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

Расчет проводился с применением соотношений (7) и использованием следующих параметров:

- частота обновления информации f=50 Гц;

- длительность такта обновления информации Т=0,02 с;

- нормированное значение большой полуоси эллипсовидной траектории точки в плоскости CS, изображающей состояние резонатора, на к-ом и к-м тактах а_к-1=а _к=1;

- нормированное значение малой полуоси эллипсовидной траектории точки в плоскости CS, изображающей состояние резонатора, b_к-1=b_к=0,1а_к;

- погрешности выработки синфазных составляющих по каналам косинуса и синуса С_ф,к, С_ф,к-1, S_ф,к, S_ф,к-1 и квадратурных составляющих С_кв,к, С_кв,к-1, S_кв,к, S_кв,к-1 составляет 1% соответственно от а _к и b_к;

- собственная скорость дрейфа, не зависящая от угловой входной скорости .

На фиг.1 оси имеют обозначения: х1= ₀, Y1= ( ₀).

Выполнено компьютерное моделирование предлагаемого способа.

При моделировании использовали представленные выше параметры и ошибки гироскопа. По входной оси гироскопа задавали первое значение угловой скорости _п=10°/ч.

При этом задавали также в соответствии с (10)

_Д0=-1·sin(2 ₀+ ₁) °/ч, где ₁=0; _зв=12,4 °/ч.

Результаты расчетов представлены на фиг.2 зависимостью 1.

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

_п2=20 °/ч представлены на фиг.3 зависимостью 1.

На фиг.2 и фиг.3 оси имеют обозначение Х2=ХЗ= ₀, Y2= ₁, Y3= ₂.

Из сравнения зависимостей 1 на фиг.2 и фиг.3 определяли разность в ширине трубок изменения показаний, которая составила 0,25 °/ч.

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

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

Погрешности выработки приращения угла ориентации волны на такте рассчитывались при разных угловых скоростях, направленных по входной оси гироскопа, которые представлены на фиг.1 в виде зависимостей 1, 2, 3 соответственно для угловых скоростей 12,4 °/ч, 24,8 °/ч, 37,2 °/ч.

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

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

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