RU2603767C1 - Способ автокомпенсации независящих от ускорения дрейфов гироскопического устройства - Google Patents

Abstract

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

Description

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

Назначение и область применения

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

Предшествующий уровень техники

Известны различные способы автокомпенсации не зависящих от ускорения дрейфов (корпусных дрейфов) гироскопического устройства (ГУ), обеспечивающие повышение его точности при использовании (см. книгу "Автокомпенсация инструментальных погрешностей гиросистем", авторы С.М.Зельдович и др. Изд. "Судостроение", 1976 г., УДК 531382, [1]).

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

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

Наиболее близким к заявленному решению по совокупности существенных признаков, выбранным в качестве прототипа, является способ автокомпенсации принудительным вращением карданова подвеса ГУ на основе гироскопа вокруг вектора кинетического момента, раскрытый в вышеупомянутой публикации [1, стр. 52]. В соответствии с решением, раскрытым в прототипе, способ автокомпенсации корпусных дрейфов, входящих в состав навигационной системы, установленной на объекте, ГУ, установленном вместе с триадой акселерометров на поворотной рамке, снабженной двигателем и датчиком угла, таким образом, что ось вращения рамки параллельна вектору кинетического момента ГУ, основан на принудительном вращении подвеса ГУ вокруг вектора кинетического момента. При этом при реализации указанного способа, основание, на котором закреплены подшипники наружного кольца подвеса ГУ на основе трехстепенного гироскопа, вращается при помощи двигателя, с постоянной угловой скоростью вокруг оси, параллельной исходной ориентации вектора кинетического момента гироскопа. Таким образом, корпус ГУ разворачивают в дискретные моменты времени вокруг оси, параллельной вектору кинетического момента ГУ, с помощью поворотной рамки, связанной с двигателем, с дискретной фиксацией положений.

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

Сущность изобретения.

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

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

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

_i+1, с обеспечением возможности компенсации корпусных дрейфов гироскопа, осуществляют при достижении или превышении текущим значением расчетного интегрального параметра N предустановленного порога N_max, определяемого как отношение среднеквадратичного отклонения (СКО) максимальной допустимой погрешности хранения направления σ_Amax, вызванной корпусными дрейфами, к СКО неопределенности этих дрейфов σ_τ, причем значение интегрального параметра N в каждый момент времени определяют путем математической обработки по формуле:

$${\rm N}=\sqrt{K_{\tau x}^2+K_{\tau y}^2}$$

,

где $$K_{\tau x}$$

и $$K_{\tau y}$$

- весовые коэффициенты, зависящие от угловых параметров движения объекта, определяемые путем математической обработки выходных сигналов гироскопа, показаний датчика угла (ДУ) и/или акселерометров по формулам

$$\{\begin{array}{l}{K}_{\tau x}(t)={\displaystyle \underset{0}{\overset{t}{\int }}\frac{\sin (\Psi (t)+\beta (t))}{\sin \theta (t)}dt}\\ K_{\tau y}(t)={\displaystyle \underset{0}{\overset{t}{\int }}\frac{\cos (\Psi (t)+\beta (t))}{\sin \theta (t)}dt}\end{array}$$

,

где $$\theta$$

и $$\Psi$$

- углы ориентации между корпусом объекта и горизонтной системой координат, $$\beta$$

- угол между ГУ и корпусом объекта,

а текущий поправочный угол поворота рамки $${\beta }_{i+1}$$

определяют в момент времени, когда N≥ $${\text{N}}_{\max }$$

путем математической обработки выходных сигналов гироскопа, показаний ДУ и/или акселерометров по формулам из следующей системы уравнений:

$$\{\begin{array}{l}\sin {\beta }_{i+1}=\frac{\sin {\beta }_{i}K1+\cos {\beta }_{i}K2}{N(t_i)\sqrt{{(K_{\tau x}(t_i)-K_{\tau x}(t_k))}^2+{(K_{\tau y}(t_i)-K_{\tau y}(t_k))}^2}}\\ \cos {\beta }_{i+1}=\frac{\cos {\beta }_{i}K1-\sin {\beta }_{i}K2}{N(t_i)\sqrt{{(K_{\tau x}(t_i)-K_{\tau x}(t_k))}^2+{(K_{\tau y}(t_i)-K_{\tau y}(t_k))}^2}}\end{array}$$

, (*)

где параметры К1 и К2:

$$\{\begin{array}{l}K1=K_{\tau y}(t_i)K_{\tau y}(t_k)+K_{\tau x}(t_i)K_{\tau x}(t_k)-{(}^N\\ K2=K_{\tau y}(t_i)K_{\tau x}(t_k)-K_{\tau x}(t_i)K_{\tau y}(t_k)\end{array}$$

, а $$(N(t_i))=\sqrt{{(K_{\tau x}(t_i))}^2+{(K_{\tau y}(t_i))}^2}$$

-

при этом $$t_i$$

- момент времени вычисления текущего поправочного угла $${\beta }_{i+1}$$

, когда условие N ≥ N_max стало истиной, $${\beta }_i$$

- текущее значение угла между ГУ и корпусом объекта,

$$t_{i-1}$$

- момент времени установки рамки в положение $${\beta }_i$$

.

$$t_k$$

- момент времени наблюдения за движением объекта, удовлетворяющий следующему условию: $$t_{i-1}<t_k<t_i$$

,

а N_max= σ_Amax/ σ_τ.

При этом длительность интервала времени между принудительными разворотами рамки вокруг оси, параллельной вектору кинетического момента на текущий поправочный угол поворота рамки $$\beta$$

_i+1, зависящий от угловых параметров движения объекта, может быть определена на основании текущего значения весовых коэффициентов $$K_{\tau x}$$

и $$K_{\tau y}$$

и интегрального параметра N, а также соотношения N с предустановленным пороговым значением $${\text{N}}_{\max }$$

.

В одном из вариантов осуществления изобретения в качестве ГУ используют двухосный ДУС (датчик угловых скоростей), установленный на рамке так, чтобы ось его кинетического момента была параллельна оси вращения рамки.

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

Краткое описание чертежей

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

Фиг. 1 - система координат, где ENh - горизонтная система координат, XkYkZk - система координат, связанная с объектом, XpYpZp - система координат, связанная с рамкой;

Фиг. 2 - вариант осуществления ГУ на основе двухосного ДУС.

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

Осуществимость изобретения

В качестве примера осуществления решения согласно заявленному изобретения, рассмотрим способ автокомпенсации корпусных дрейфов ГУ на примере гироскопического инклинометра на основе двухосного ДУС, используемого в качестве ГУ. При этом в рассматриваемом примере осуществления гироскопический инклинометр рассматривается в качестве объекта, на который установлен ДУС (см. фиг.2). В данной схеме осуществления изобретения, представленной на фиг.2, акселерометры 2 и ДУС 1 расположены на вращающейся рамке 3. Рамка 3 имеет возможность устанавливаться в дискретные положения относительно продольной оси гироскопического инклинометра 6 с помощью двигателя 4. Для измерения угла поворота на оси рамки размещен датчик 5 угла (ДУ), например, оптический. ДУС 1 установлен так, чтобы оси чувствительности были перпендикулярны оси вращения рамки 3. В состав как рассматриваемого ГУ, так и ГУ в любом ином исполнении, как правило, также входят блок сервисных электронных устройств и блок обработки информации, включающий, по меньшей мере, вычислитель, реализованный на базе микропроцессора (на фиг.2 не показаны), связанные по линиям связи, например телеметрической связи, с внешним или встроенным пультом управления и компьютерным устройством (на чертежах не показаны).

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

Согласно изобретению, при осуществлении способа автокомпенсации не зависящего от дрейфа корпуса гироскопического устройства, в качестве погрешности хранения базового направления принимают погрешность азимута ∆А, вызванную корпусными дрейфами ГУ (в примере осуществления - ДУС). Обозначив дрейфы ГУ $${\tau }_x$$

и $${\tau }_y$$

, углы между корпусом объекта и горизонтной системой координат - $$\theta$$

, $$\Psi$$

, а угол между ГУ и корпусом объекта - $$\beta$$

, погрешность азимута ∆А может быть определена следующим образом:

$$\Delta A=-{\displaystyle \underset{0}{\overset{t}{\int }}\frac{{\tau }_x\sin (\Psi +\beta )}{\sin \theta }dt}-{\displaystyle \underset{0}{\overset{t}{\int }}\frac{{\tau }_y\cos (\Psi +\beta )}{\sin \theta }dt}$$

(1).

Учитывая, что скорости изменения уходов(дрейфов) τ_x, τ_y представляют собой медленно меняющиеся функции времени по сравнению с другими сомножителями выражения (1), они могут быть вынесены за знаки интегралов, а оставшиеся интегральные выражения обозначены как весовые коэффициенты $$K_{\tau x}$$

и $$K_{\tau y}$$

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

$$\Delta A=-{\tau }_x\cdot K_{\tau x}-{\tau }_y\cdot K_{\tau y}$$

(2).

При этом, принимая во внимание, что закон изменения углов ориентации $$\theta$$

и $$\Psi$$

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

$$\psi +\beta =arctg\frac{a_x}{a_y}$$

; $$\theta =\arcsin \frac{\sqrt{a_x^2+a_y^2}}{a_z}$$

, где $$a_x,a_y,a_z$$

- выходные сигналы акселерометров, $$\beta$$

- выход датчика угла (угол между ГУ и корпусом объекта), очевидно, что при реализации способа автокомпенсации корпусных дрейфов ГУ согласно прототипу значения весовых коэффициентов $$K_{\tau x}$$

и $$K_{\tau y}$$

будут расти во времени, так как собственное движение прибора (определяемое значением угла ψ) складывается с принудительным движением рамки (определяемое значением угла $$\beta$$

), при этом, очевидным образом, не происходит полной модуляции дрейфов, и, как следствие, погрешность азимута возрастает. Таким образом, решение способа автокомпенсации корпусных дрейфов ГУ, раскрытое в прототипе, позволяет обеспечить модуляцию корпусных дрейфов ГУ в погрешности азимута только в случае соблюдения условия: $$\theta =c\text{onst}$$

и $$\Psi =const$$

.

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

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

Анализ зависимости (1) показывает, что для уменьшения погрешности азимута ∆А необходимо уменьшать значения каждого из весовых коэффициентов $$K_{\tau x}$$

и $$K_{\tau y}$$

, входящих в зависимость, определенную формулой (1). При этом из чертежей, представленных на фиг. 1 и 2, следует, что при помощи двигателя 4 возможно управление только углом между ГУ и корпусом объекта $$\beta$$

. При установке (развороте) рамки ГУ в определенные положения, можно добиться поддержания значений весовых коэффициентов $$K_{\tau x}$$

и $$K_{\tau y}$$

в пределах, не превышающих заданного заранее установленного значения, при достижении которого производится разворот рамки на такой расчетный угол $$\beta$$

, который вызывает смену знака подынтегральных выражений, поэтому оба интеграла, определяющих зависимости весовых коэффициентов $$K_{\tau x}$$

и $$K_{\tau y}$$

, становятся из растущих функций убывающими. Таким образом, весовые коэффициенты $$K_{\tau x}$$

и $$K_{\tau y}$$

из неограниченно растущих со временем становятся ограниченными по величине независимо от закона движения, определяемого углами $$\theta$$

и $$\Psi$$

.

Таким образом, управляя углом $$\beta$$

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

Для суммарной оценки вклада весовых коэффициентов $$K_{\tau x}$$

и $$K_{\tau y}$$

в погрешность азимута, на основании вышеизложенного, может быть определен расчетный интегральный параметр N, следующим образом:

$${\rm N}=\sqrt{K_{\tau x}^2+K_{\tau y}^2}$$

(3).

Выражение (3) для интегрального расчетного параметра N получено на основании известного в уроне техники предположения, что неопределенности дрейфов $${\tau }_x$$

и $${\tau }_y$$

являются случайными некоррелированными константами с равными дисперсиями среднеквадратичного отклонения (СКО) $${\sigma }_{\tau }^{}$$

:

$${\sigma }_A^2={\sigma }_{\tau }^2\cdot K_{\tau x}^2+{\sigma }_{\tau }^2\cdot K_{\tau y}^2$$

, то есть $${\sigma }_A^{}={\sigma }_{\tau }^{}\cdot N$$

, где σ_А - СКО погрешности хранения базового направления, вызванной корпусными дрейфами.

Следовательно, для ограничения величины СКО погрешности хранения базового направления достаточно ограничить значение интегрального параметра N выбранным пороговым значением $${\text{N}}_{\max }$$

, определяемым из соотношения $${\sigma }_{A\max }^{}={\sigma }_{\tau }^{}\cdot {\text{N}}_{\max }$$

, где $${\sigma }_{A\max }^{}$$

- максимальное допустимое значение СКО погрешности хранения базового направления, вызванное корпусными дрейфами ГУ.

Соответственно, пороговое значение расчетного интегрального параметра $${\text{N}}_{\max }$$

может быть определено как:

$${\text{N}}_{\max }={\sigma }_{A\max }^{}/{\sigma }_{\tau }^{}$$

, тогда, очевидно, что при $$\text{N}<{\text{N}}_{\max }$$

справедливо и $${\sigma }_A^{}<{\sigma }_{A\max }^{}$$

.

В общем случае, пороговое значение $${\text{N}}_{\max }$$

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

Таким образом, если в момент времени $$t_i$$

выполняется условие $$\text{N}\ge {\text{N}}_{\max }$$

, для изменения знаков интегралов, ГУ относительно объекта необходимо установить в положение $${\beta }_{i+1}$$

. С учетом вышеизложенного, весовые коэффициенты для момента времени $$t_{i+1}$$

( $$t_{i+1}$$

- момент времени, когда будет выполнено условие $$K_{\tau x}=0$$

и $$K_{\tau y}=0$$

) могут быть определены следующим образом:

$$\{\begin{array}{l}{K}_{\tau x}(t_{i+1})=K_{\tau x}(t_i)+{\displaystyle \underset{ti}{\overset{ti+1}{\int }}\frac{\sin \Psi (t)\cos {\beta }_{i+1}+\cos \Psi (t)\sin {\beta }_{i+1}}{\sin \theta (t)}dt}\\ K_{\tau y}(t_{i+1})=K_{\tau y}(t_i)+{\displaystyle \underset{ti}{\overset{ti+1}{\int }}\frac{\cos \Psi (t)\cos {\beta }_{i+1}-\sin \Psi (t)\sin {\beta }_{i+1}}{\sin \theta (t)}dt}\end{array}$$

(4).

Введя следующие обозначения:

$$\begin{array}{l}{I}_s={\displaystyle \underset{ti}{\overset{ti+1}{\int }}\frac{\sin \Psi (t)}{\sin \theta (t)}dt}\\ I_c={\displaystyle \underset{ti}{\overset{ti+1}{\int }}\frac{\cos \Psi (t)}{\sin \theta (t)}dt}\end{array}$$

(5).

Приравняв нулю весовые коэффициенты на момент времени $$t_{i+1}$$

, получим следующую систему уравнений, с учетом принятых в (5) обозначений:

$$\{\begin{array}{l}{K}_{\tau x}(t_{i+1})=K_{\tau x}(t_i)+I_s\cos {\beta }_{i+1}+I_c\sin {\beta }_{i+1}=0\\ K_{\tau y}(t_{i+1})=K_{\tau y}(t_i)+I_c\cos {\beta }_{i+1}-I_s\sin {\beta }_{i+1}=0\end{array}$$

(6).

Решение системы уравнений относительно $$\sin {\beta }_{i+1}$$

и $$\cos {\beta }_{i+1}$$

позволяет получить следующую систему зависимостей:

$$\{\begin{array}{l}\sin {\beta }_{i+1}=\frac{K_{\tau y}(t_i)I_s-K_{\tau x}(t_i)I_c}{I_s^2+I_c^2}\\ \cos {\beta }_{i+1}=\frac{-K_{\tau x}(t_i)I_s-K_{\tau y}(t_i)I_c}{I_s^2+I_c^2}\end{array}$$

(7).

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

$$I_s^2+I_c^2={(K_{\tau x}(t_i))}^2+{(K_{\tau y}(t_i))}^2={(N(t_i))}^2$$

обеспечивает минимальное время, за которое весовые коэффициенты $$K_{\tau x}$$

и $$K_{\tau y}$$

достигнут нуля.

Поскольку, при $$t_{i+1}-t_{i-1}<<t_r$$

(где $$t_r$$

- время работы навигационной системы ГУ, $$t_{i-1}$$

- момент времени, когда ГУ относительно объекта был установлен в положение $${\beta }_i$$

) закон изменения углов ориентации, а как следствие и закон изменения $$K_{\tau x}(t)$$

и $$K_{\tau y}(t)$$

можно считать неизменным. Тогда, выбрав интервал наблюдения от $$t_k$$

до $$t_i$$

( $$t_{i-1}<t_k<t_i$$

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

$$\{\begin{array}{l}{K}_{\tau x}(t_i)=K_{\tau x}(t_k)+{\displaystyle \underset{tk}{\overset{ti}{\int }}\frac{\sin \Psi (t)\cos {\beta }_i+\cos \Psi (t)\sin {\beta }_i}{\sin \theta (t)}dt}\\ K_{\tau y}(t_i)=K_{\tau y}(t_k)+{\displaystyle \underset{tk}{\overset{ti}{\int }}\frac{\cos \Psi (t)\cos {\beta }_i-\sin \Psi (t)\sin {\beta }_i}{\sin \theta (t)}dt}\end{array}$$

(8).

Введя следующие обозначения:

$$\{\begin{array}{l}{f}_s={\displaystyle \underset{tk}{\overset{ti}{\int }}\frac{\sin \Psi (t)}{\sin \theta (t)}dt}=\cos {\beta }_i(K_{\tau x}(t_i)-K_{\tau x}(t_k))-\sin {\beta }_i(K_{\tau y}(t_i)-K_{\tau y}(t_k))\\ f_c={\displaystyle \underset{tk}{\overset{ti}{\int }}\frac{\cos \Psi (t)}{\sin \theta (t)}dt}=\sin {\beta }_i(K_{\tau x}(t_i)-K_{\tau x}(t_k))+\cos {\beta }_i(K_{\tau y}(t_i)-K_{\tau y}(t_k))\end{array}$$

(9).

и определив условия для выполнения нормировки следующим образом:

$$I_s=k{f}_s,I_c=k{f}_c$$

(10).

где $$k^2=\frac{{(K_{\tau x}(t_i))}^2+{(K_{\tau y}(t_i))}^2}{f_s^2+f_c^2}=\frac{{(N(t_i))}^2}{f_s^2+f_c^2}$$

(11),

при последующей подстановке (10) в (7) получим следующие выражения для тригонометрических функций угла $${\beta }_{i+1}$$

, в который необходимо установить рамку:

$$\{\begin{array}{l}\sin {\beta }_{i+1}=\frac{\sin {\beta }_{i}K1+\cos {\beta }_{i}K2}{N(t_i)\sqrt{{(K_{\tau x}(t_i)-K_{\tau x}(t_k))}^2+{(K_{\tau y}(t_i)-K_{\tau y}(t_k))}^2}}\\ \cos {\beta }_{i+1}=\frac{\cos {\beta }_{i}K1-\sin {\beta }_{i}K2}{N(t_i)\sqrt{{(K_{\tau x}(t_i)-K_{\tau x}(t_k))}^2+{(K_{\tau y}(t_i)-K_{\tau y}(t_k))}^2}}\end{array}$$

, (12)

где параметры K1 и К2 определяют из следующих соотношений:

$$\begin{array}{l}K1=K_{\tau y}(t_i)K_{\tau y}(t_k)+K_{\tau x}(t_i)K_{\tau x}(t_k)-{(}^N\\ K2=K_{\tau y}(t_i)K_{\tau x}(t_k)-K_{\tau x}(t_i)K_{\tau y}(t_k)\end{array}$$

(13).

Таким образом, полученная зависимость для расчета угла $${\beta }_{i+1}$$

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

Осуществление способа происходит следующим образом.

Если выполняется условие N < N_max , то ГУ относительно корпуса объекта неподвижен. При N ≥ N_max из уравнений (12) вычисляется значение угла, в который необходимо установить ГУ относительно корпуса объекта. После выполнения этой операции ГУ разворачивается в это положение вокруг оси параллельной оси кинетического момента. Поскольку независимо от положения рамки, вычисление N продолжается, можно наблюдать уменьшение этого параметра со временем (до 0 в данном случае), а затем - его рост. При достижении условия $$N\ge {\text{N}}_{\text{max}}$$

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

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

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

Без потери качества способа автокомпенсации согласно изобретению, в качестве ГУ может быть использован:

- один двухосный ДУС, установленный так, чтобы ось его кинетического момента была параллельна оси вращения рамки.

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

- два одноосных ДУС, оси чувствительности которых ортогональны друг другу и оси вращения рамки.

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

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

Claims (3)

1. Способ автокомпенсации корпусных дрейфов гироскопического устройства (ГУ), установленного вместе с триадой акселерометров на поворотной рамке, снабженной двигателем и датчиком угла, таким образом, что ось вращения рамки параллельна вектору кинетического момента ГУ, заключающийся в том, что с помощью рамки, связанной с двигателем, корпус ГУ разворачивают в дискретные моменты времени вокруг оси, параллельной вектору кинетического момента ГУ, с дискретной фиксацией положений, отличающийся тем, что используют автокомпенсацию с обратной связью, при которой программно-аппаратным образом осуществляют непрерывное отслеживание уровня подавления корпусных дрейфов, для оценки которого используют текущее значение расчетного интегрального параметра N, определяемого путем математической обработки выходных сигналов гироскопа, показаний датчика угла и акселерометров, а принудительный разворот рамки вокруг оси параллельной оси кинетического момента на текущий расчетный поправочный угол поворота рамки $$\beta$$

   

   _i+1, с обеспечением возможности компенсации корпусных дрейфов гироскопа, осуществляют при достижении или превышении текущим значением расчетного интегрального параметра N предустановленного порога N_max, определяемого как отношение среднеквадратичного отклонения (СКО) максимальной допустимой погрешности хранения направления σ_Amax, вызванной корпусными дрейфами, к СКО неопределенности этих дрейфов σ_τ, причем значение интегрального параметра N в каждый момент времени определяют путем математической обработки по формуле:
   $${\rm N}=\sqrt{K_{\tau x}^2+K_{\tau y}^2}$$

   

   ,
   где $$K_{\tau x}$$

   

   и $$K_{\tau y}$$

   

   - весовые коэффициенты, зависящие от угловых параметров движения объекта, определяемые путем математической обработки выходных сигналов гироскопа, показаний датчика угла (ДУ) и/или акселерометров по формулам
   $$\{\begin{array}{l}{K}_{\tau x}(t)={\displaystyle \underset{0}{\overset{t}{\int }}\frac{\sin (\Psi (t)+\beta (t))}{\sin \theta (t)}dt}\\ K_{\tau y}(t)={\displaystyle \underset{0}{\overset{t}{\int }}\frac{\cos (\Psi (t)+\beta (t))}{\sin \theta (t)}dt}\end{array}$$

   

   ,
   где $$\theta$$

   

   и $$\Psi$$

   

   - углы ориентации между корпусом объекта и горизонтной системой координат, $$\beta$$

   

   - угол между ГУ и корпусом объекта,
   а текущий поправочный угол поворота рамки $${\beta }_{i+1}$$

   

   определяют в момент времени, когда N≥ $${\text{N}}_{\max }$$

   

   путем математической обработки выходных сигналов гироскопа, показаний ДУ и/или акселерометров по формулам из следующей системы уравнений:
   $$\{\begin{array}{l}\sin {\beta }_{i+1}=\frac{\sin {\beta }_{i}K1+\cos {\beta }_{i}K2}{N(t_i)\sqrt{{(K_{\tau x}(t_i)-K_{\tau x}(t_k))}^2+{(K_{\tau y}(t_i)-K_{\tau y}(t_k))}^2}}\\ \cos {\beta }_{i+1}=\frac{\cos {\beta }_{i}K1-\sin {\beta }_{i}K2}{N(t_i)\sqrt{{(K_{\tau x}(t_i)-K_{\tau x}(t_k))}^2+{(K_{\tau y}(t_i)-K_{\tau y}(t_k))}^2}}\end{array}$$

   

   , (*)
   где параметры К1 и К2:
   $$\{\begin{array}{l}K1=K_{\tau y}(t_i)K_{\tau y}(t_k)+K_{\tau x}(t_i)K_{\tau x}(t_k)-{(}^N\\ K2=K_{\tau y}(t_i)K_{\tau x}(t_k)-K_{\tau x}(t_i)K_{\tau y}(t_k)\end{array}$$

   

   , а $$(N(t_i))=\sqrt{{(K_{\tau x}(t_i))}^2+{(K_{\tau y}(t_i))}^2}$$

   

   -
   при этом $$t_i$$

   

   - момент времени вычисления текущего поправочного угла $${\beta }_{i+1}$$

   

   , когда условие N ≥ N_max стало истиной, $${\beta }_i$$

   

   - текущее значение угла между ГУ и корпусом объекта,
   $$t_{i-1}$$

   

   - момент времени установки рамки в положение $${\beta }_i$$

   

   .
   $$t_k$$

   

   - момент времени наблюдения за движением объекта, удовлетворяющий следующему условию: $$t_{i-1}<t_k<t_i$$

   

   ,
   а N_max= σ_Amax/ σ_τ.
   
   2. Способ по п. 1, отличающийся тем, что длительность интервала времени между принудительными разворотами рамки ГУ вокруг оси параллельной вектору кинетического момента на текущий поправочный угол поворота рамки $$\beta$$

   

   _i+1, зависящий от угловых параметров движения объекта, определяют на основании текущего значения весовых коэффициентов $$K_{\tau x}$$

   

   и $$K_{\tau y}$$

   

   и расчетного интегрального параметра N, а также соотношения N с предустановленным пороговым значением $${\text{N}}_{\max }$$

   

   .
2. 3. Способ по любому из пп. 1 и 2, отличающийся тем, что в качестве ГУ используют один двухосный ДУС, установленный так, чтобы ось его кинетического момента была параллельна оси вращения рамки.
3. 4. Способ по любому из пп. 1 и 2, отличающийся тем, что в качестве ГУ используют два одноосных ДУС, оси чувствительности каждого из которых ортогональны оси вращения рамки и друг другу.

Images