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

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

Способ определения угловых координат , , измерительной оси акселерометра относительно ортогонального базиса X, Y, Z, включающий разворот акселерометра из исходного положения, при котором плоскость XOY расположена в плоскости горизонта, вокруг первой оси OA₁, расположенной в плоскости XOY под углом ₁ к оси Х базиса и затем из исходного положения разворот акселерометра вокруг второй оси ОА ₂, расположенной в плоскости XOY под углом ₂ к оси X, отличающийся тем, что первый разворот вокруг первой оси ОА₁ проводят до момента начала изменения сигнала акселерометра в рабочей зоне, фиксируют угол поворота _P1 и сигнал акселерометра U ₁, возвращают акселерометр в упомянутое исходное положение, второй разворот акселерометра из исходного положения вокруг первой оси ОА₁ проводят до момента, при котором сигнал акселерометра становится меньше заданного значения , принадлежащего линейной рабочей зоне сигнала акселерометра, при этом фиксируют угол поворота _Р2 и сигнал акселерометра U ₂, не равный сигналу U₁, третий разворот акселерометра из исходного положения вокруг второй оси ОА ₂ проводят до момента начала изменения сигнала акселерометра в рабочей зоне, фиксируют угол _Р3 и сигнал акселерометра U ₃, возвращают акселерометр в исходное положение, четвертый разворот акселерометра из исходного положения проводят вокруг второй оси ОА₂ до момента при котором сигнал акселерометра становится меньше упомянутого заданного значения , при этом фиксируют угол _Р4 и сигнал акселерометра U ₄, не равный сигналу U₃, а угловые координаты , и вычисляют из соотношений:

где ₁, ₂ углы поворота, (соответственно, вокруг осей ОА₁ и ОА₂ ) акселерометра из исходного положения, при которых сигнал с акселерометра равен нулю.

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

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

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

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

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

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

Задача изобретения - упрощение способа и увеличение экономичности.

Эта задача достигается тем, что в способе определения угловых координат , , измерительной оси акселерометра относительно ортогонального базиса X, Y, Z, включающем разворот акселерометра из исходного положения, при котором плоскость XOY расположена в плоскости горизонта, вокруг первой оси OA₁, расположенной в плоскости XOY под углом ₁ к оси Х базиса, и затем из исходного положения разворот акселерометра вокруг второй оси ОА ₂, расположенной в плоскости XOY под углом ₂ к оси X, дополнительно первый разворот вокруг первой оси OA₁ проводят до момента начала изменения сигнала акселерометра в рабочей зоне, фиксируют угол поворота _P1 и сигнал акселерометра U ₁, возвращают акселерометр в упомянутое исходное положение, второй разворот акселерометра из исходного положения вокруг первой оси OA₁ проводят до момента, при котором сигнал акселерометра становится меньше заданного значения , принадлежащего линейной рабочей зоне сигнала акселерометра, при этом фиксируют угол поворота _Р2 и сигнал акселерометра U ₂, не равный сигналу U₁, третий разворот акселерометра из исходного положения вокруг второй оси ОА ₂ проводят до момента начала изменения сигнала акселерометра в рабочей зоне, фиксируют угол _Р3 и сигнал акселерометра U ₃, возвращают акселерометр в исходное положение, четвертый разворот акселерометра из исходного положения проводят вокруг второй оси ОА₂ до момента, при котором сигнал акселерометра становится меньше упомянутого заданного значения , при этом фиксируют угол _P4 и сигнал акселерометра U ₄, не равный сигналу U₃, а угловые координаты , и вычисляют из соотношений:

где ₁, ₂ углы поворота (соответственно вокруг осей OA₁ и ОА₂) акселерометра из исходного положения, при которых сигнал с акселерометра равен нулю.

На чертеже представлена базовая ортогональная система координат OXYZ и орт е (измерительная ось акселерометра), заданный углами , и , которые он образует с положительными направлениями осей OXYZ. В исходном положении плоскость XOY расположена в плоскости горизонта. Плоскость, заданная векторами OZ и е, образует прямой угол с плоскостью OXY. Вектор OA₁ является осью первого разворота, принадлежит плоскости OXY и образует угол ₁ с вектором ОХ. Вектор OA ₂ является осью второго разворота, принадлежит плоскости OXY и образует угол ₂ с вектором ОХ. Вектор OB ₁ показывает положение измерительной оси акселерометра после первого разворота из исходного положения вокруг оси OA ₁ на угол _P1, при котором сигнал с акселерометра равен U₁. Вектор ОВ₂ показывает положение измерительной оси акселерометра после второго разворота из исходного положения вокруг оси OA ₁ на угол _P2, при котором сигнал с акселерометра равен U₂. Вектор ОВ₃ показывает положение измерительной оси акселерометра после третьего разворота из исходного положения вокруг оси ОА ₂ на угол _P3, при котором сигнал с акселерометра равен U₃. Вектор OB₄ показывает положение измерительной оси акселерометра после четвертого разворота из исходного положения вокруг оси ОА ₂ на угол _Р4, при котором сигнал с акселерометра равен U₄. ₁ - это угол поворота акселерометра из исходного положения вокруг оси OA₁ до положения, при котором измерительная ось акселерометра будет принадлежать плоскости ХОУ (сигнал с акселерометра равен нулю). ₂ - это угол поворота акселерометра из исходного положения вокруг оси ОА₂ до положения, при котором измерительная ось акселерометра будет принадлежать плоскости ХОУ (сигнал с акселерометра равен нулю). Угол это угол между осью вращения OA₁ и измерительной осью акселерометра. Отрезок BD перпендикулярен оси вращения OA₁ и является катетом прямоугольного треугольника OBD. Дуга A₁C и дуга а являются катетами сферического прямоугольного треугольника A ₁BC с прямым углом С, а дуга с является его гипотенузой.

Определим сигнал с акселерометра в исходном состоянии. Для этого рассмотрим прямоугольный треугольник OBD с прямым углом D. В нем катет BD можно выразить через гипотенузу е как:

Таким образом, можно представить измеренный сигнал U от полного сигнала акселерометра F в случае, когда плоскость BOA₁ перпендикулярна плоскости OXY, плоскость OXY горизонтальна, а вектор е совпадает с измерительной осью акселерометра как:

В случае, когда угол между плоскостью BOAi и плоскостью OXY равен , измеренный сигнал U можно представить как:

Вместе с тем угол , образованный векторами OA₁ и е, можно выразить через направляющие косинусы как:

Где Cos90° это сомножитель, определяемый углом между векторами OZ и OA₁. Учитывая, что Cos(90°- ₁)=Sin ₁, а Cos90°=0, последнее выражение примет вид:

В прямоугольном сферическом треугольнике A ₁BC гипотенуза с определена углом , а катет - углом (90°- ). Исходя из формулы синусов для сферических треугольников (Sina/SinA₁=Sinc/SinC) получим:

Учитывая, что SinC=1, Sin(90°- )=Cos , a SinA₁=Sin ₁, выражение (6) примет вид:

Подставив Sin из соотношения (7) в выражение (3), получим:

После первого разворота вокруг оси OA ₁ на угол _P1 угол равен ₁- _P1, а сигнал с акселерометра - U ₁. Подставляя эти значения в выражение (8), получим:

Соответственно после второго разворота вокруг оси OA₁ на угол _P2 угол равен ₁- _P2, а сигнал с акселерометра - U ₂. Подставляя и эти значения в выражение (8), получим:

Разделив соотношение (10) на (9) получим:

Аналогичным образом получим соотношение для сигналов U₃ (третье измерение) и U ₄ (четвертое измерение) после соответственно третьего разворота вокруг оси ОА₂ на угол _P3 и четвертого разворота вокруг оси ОА₂ на угол _Р4.

Перепишем выражение (7) как:

И выразим Sin через Cos , в результате чего выражение (13) примет вид:

Подставим в выражение (14) Cos из соотношения (5), после чего выражение (14) примет вид:

Подставив соответствующие углы _Р2 и ₂ в данное выражение, получим следующее уравнение для определения координат измерительной оси акселерометра:

Выражения (11), (12), (15), (16) и равенство Cos² +Cos² +Cos² =1 при совместном решении позволяют определить углы , и (координаты измерительной оси акселерометра).

Определение угловых координат , и измерительной оси е акселерометра осуществляется следующим образом. Пусть поворотная установка имеет платформу, которую можно горизонтировать и устанавливать на нее акселерометр (прибор, в котором установлены акселерометры). Поворотная установка имеет две измерительные оси вращения OA₁ и ОА ₂ с точной фиксацией углов поворота, расположенные под углами ₁ и ₂ относительно оси X. Выставим плоскость OXY поворотной установки в горизонт - исходное положение. Развернем платформу относительно оси OA₁ до момента начала изменения сигнала акселерометра в рабочей зоне, зафиксируем угол поворота _P1 и сигнал акселерометра U ₁. Возвратим акселерометр в исходное положение (выставим плоскость OXY поворотной установки в горизонт). Развернем платформу (второй разворот акселерометра) вокруг первой оси OA ₁ до момента, при котором сигнал акселерометра становится меньше заданного значения , принадлежащего линейной рабочей зоне сигнала акселерометра. Зафиксируем угол поворота _P2 и сигнал акселерометра U ₂, не равный сигналу U₁. Возвратим акселерометр в исходное положение. Развернем платформу (третий разворот акселерометра) относительно оси ОА₂ до момента начала изменения сигнала акселерометра в рабочей зоне, зафиксируем угол поворота _P3 и сигнал акселерометра U ₃. Возвратим акселерометр в исходное положение. Развернем платформу (четвертый разворот акселерометра) вокруг первой оси ОА₂ до момента, при котором сигнал акселерометра становится меньше упомянутого заданного значения . Зафиксируем угол поворота _Р4 и сигнал акселерометра U ₄ (U₄ U₃).

Вычислим углы ₁ и ₂, решая уравнения:

и

Подставим полученные значения ₁ и ₂ в последние равенства системы уравнений

и, решая ее, определим угловые координаты , и измерительной оси акселерометра е в исходном базисе X, Y, Z.

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

Вместе с тем предложенный способ позволяет увеличить экономичность определения координат измерительной оси за счет того, что сокращается время на проведение работ. Так, например, в случае, если необходимо получить точность прибора на уровне 10^-5 по абсолютной величине, диапазон измеряемых ускорений составляет 10 м/с ², а вес одного разряда приращения 4 мм/с. Т.е. величина минимального измеряемого сигнала составит 10 м/с ² ×10^-5=0,1 мм/с ². И период следования информационных импульсов (кодовых посылок) от минимального полезного сигнала составит 4 мм/с: 0,1 мм/с² =40 с. Следовательно, период следования кода, формируемого за счет погрешности, должен быть больше. Учитывая, что трудно (с точки зрения стоимости) бороться с погрешностью, вызванной электронной частью прибора, желательно минимизировать погрешность от неправильной тарировки (измерения координат) датчиков. Это вызывает необходимость увеличивать период следования кода от неправильной установки, примерно, на порядок, т.е. до 400 с. С учетом особенностей работы измерительных приборов (организации цикла измерения, например, с целью защиты от "плавания" периода, вызванного синхронизацией преобразования и передачи информационного кода, вводится измерение нескольких периодов и вычисления среднего), реальное время измерения может быть значительно больше. Учитывая, что операция разворота занимает много времени, и необходимо провести измерение параметров нескольких акселерометров, установленных в приборе, при реализации способа-прототипа потребуется очень много времени, что делает его дорогим в части трудозатрат. Поэтому в случае применения акселерометров, не имеющих нулевой составляющей сигнала (сигнал акселерометра равен нулю при отсутствии ускорения), предлагаемый способ является более экономичным.

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

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

Точность у заявляемого способа определяется погрешностью измерения, а у прототипа - погрешностью измерения плюс допуск на устанавливаемый нулевой сигнал (сигнал при, котором прекращаются действия по изменению наклона для достижения еще более низкого сигнала с акселерометра). Пусть, например, необходима точность Р в определении углов ₁ и ₂, равная 5" (Р=5"). (Погрешности при вычислении углов , , зависят от погрешностей измерения углов ₁, ₂ и имеют величину одного и того же порядка (зависят от соотношения углов)). Величина искомого угла ₁=45°, линейная зона акселерометра начинается при наклоне на 35° ( _P1=35°), погрешность измерения сигнала с акселерометра 0,001 и погрешности при измерении имеют разный знак (т.е. наихудший случай - U₂ при измерении увеличивается в (1+0,001) раза, a U ₁ - уменьшается в (1-0,001) раза). Коэффициент преобразования сигнала акселерометром F=1/Sin или, согласно выражению (3), сигнал с акселерометра можно записать как U=Sin , тогда для первого измерения U₁=Sin( ₁- _P1), для второго измерения U ₂=Sin( ₁- _P2). Подставляя эти данные в выражение (11), получим:

или с учетом цифровых значений:

решая данное выражение, получим: _P2=44° 21' 3,36". Таким образом, чтобы получить точность в 5" при использовании способа-прототипа, надо проводить наклоны и измерения сигнала до тех пор, пока сигнал акселерометра станет меньше чем величина, пропорциональная Sin(5"). А при использовании предлагаемого способа надо проводить наклоны и измерения сигнала до тех пор, пока сигнал акселерометра станет меньше, чем величина, пропорциональная Sin(38' 56,64"). Что является значительно более простой задачей. Учитывая, что на практике приходится решать задачу по измерению фактических угловых координат , и измерительной оси акселерометра, получившихся при изготовлении прибора и отличающихся от заданных ₀, ₀, ₀ на некоторые небольшие значения, легко предварительно вычислить углы _O1 и _O2, соответственно определить величину сигнала для достижения необходимой точности. Уменьшение допуска на устанавливаемый нулевой сигнал ниже нескольких секунд у способа-прототипа приводит к увеличению операций разворот-измерение.

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

Для реализации данного способа необходима платформа с не менее чем двумя рамками карданного подвеса (двумя степенями свободы), например, такая как представлена в [3] с.158.

Литература

1. Патент Российской Федерации № 02117950 от 20.08.98. Способ определения параметров прецизионных акселерометров. G01P 21/00.

2. Патент Российской Федерации № 02164693 от 29.07.99. Способ определения угловых координат измерительной оси акселерометра. G01P 21/00.

3. Савант С.Дж., Ховард Р., Соллоуай С., Савант С.А. Принципы инерциальной навигации. М.: Мир, 1965 г.