способ определения угловых координат измерительной оси акселерометра
Классы МПК: | G01P21/00 Испытания и калибровка приборов и устройств, отнесенных к другим группам данного подкласса |
Автор(ы): | Лаврищев Андрей Борисович (RU), Леденев Геннадий Яковлевич (RU) |
Патентообладатель(и): | Открытое акционерное общество "Ракетно-космическая корпорация "Энергия" им. С.П. Королева" (RU) |
Приоритеты: |
подача заявки:
2005-10-14 публикация патента:
27.01.2008 |
Изобретение относится к области измерения и может быть использовано для настройки и калибровки акселерометров и приборов, содержащих акселерометры. Способ включает измерение сигнала в исходном положении и после двух разворотов вокруг двух горизонтальных осей, положение которых известно относительно ортогонального базиса, на определенные углы с последующим измерением сигналов с акселерометра. Углы разворота и угловые координаты определяются из соответствующих соотношений, что упрощает способ и, следовательно, позволяет использовать простое технологическое оборудование (с меньшим числом степеней свободы) для калибровки приборов, содержащих акселерометры. 1 ил.
Формула изобретения
Способ определения угловых координат измерительной оси акселерометра относительно ортогонального базиса X, Y, Z, включающий первый и второй развороты вокруг горизонтальной оси, расположенной в плоскости горизонта XOY, при этом первый разворот акселерометра из начального положения вокруг первой оси OA1 , расположенной под углом 1 к оси Х базиса, проводят на угол P1, после чего из начального положения производят второй разворот акселерометра вокруг второй оси ОА 2, расположенной в плоскости XOY под углом 2 к оси X, на угол P2, отличающийся тем, что измеряют сигналы акселерометра U1 в исходном положении, U2 после первого и U3 после второго разворотов на углы P1 и P2, а угловые координаты , и определяют из соотношений:
U2 /U1=Sin( 1- P1)/Sin 1,
U3 /U1=Sin( 2- P2)/Sin 2,
Cos2 +Cos2 +Cos2 =1,
Sin2 1=Cos2 :[1-(Cos 1·Cos +Cos ·Sin 1)2],
Sin2 2=Cos2 :[1-(Cos 2·Cos +Cos ·Sin 2)2],
при этом величину углов P1 и P2 выбирают из соотношений:
Sin2 P1=Cos2 P:[1-(Cos 1·Cos P+Cos P·Sin 1)2],
Sin2 P2=Cos2 P:[1-(Cos 2·Cos P+Cos P·Sin 2)2],
где P [ 0- , 0+ ], P [ 0- , 0+ ], P [ 0- , 0+ ];
0, 0, 0 - заданные угловые координаты измерительной оси;
, , - максимально возможная погрешность фактического расположения измерительной оси относительно заданного положения;
1, 2 - углы поворота акселерометра из начального положения, при которых сигнал с акселерометра равен нулю.
Описание изобретения к патенту
Предлагаемое изобретение относится к области измерения и может быть использовано для настройки и калибровки акселерометров и приборов, содержащих акселерометры.
Известен способ определения параметров прецизионных акселерометров, в частности погрешности базовых установочных элементов и угловой деформации основания в плоскости, перпендикулярной оси его вращения, описанный в [1], включающий развороты акселерометра, закрепленного на вертикальном основании, вокруг горизонтальной оси и вокруг измерительной оси на некоторые, заранее заданные углы с одновременным наблюдением выходного сигнала.
Однако для реализации данного способа необходимо осуществлять вращение вокруг измерительной оси акселерометра, что не всегда возможно легко реализовать, т.к. требуется сложное оборудование.
Известен способ определения угловых координат измерительной оси акселерометра - прототип, описание которого приведено в [2]. Сущность данного способа заключается в том, что проводят два разворота акселерометра вокруг первой и второй горизонтальной оси на углы, при которых сигнал акселерометра равен нулю, и после этого, зная углы между осями вращения и осями ортогонального базиса и углы разворотов, вычисляют координаты измерительной оси акселерометра.
Однако способ требует проведения вращения до получения нулевого сигнала с акселерометра. При развороте акселерометра требуется проводить несколько последовательных поворотов (приближений) и замеров сигнала с акселерометра для того, чтобы определить момент нулевого сигнала, что требует больших затрат времени.
Задача изобретения - упрощение способа и увеличение экономичности.
Эта задача достигается тем, что в способе определения угловых координат , , измерительной оси акселерометра относительно ортогонального базиса X, Y, Z, включающем первый и второй развороты вокруг горизонтальной оси, расположенной в плоскости горизонта XOY, при этом первый разворот акселерометра из начального положения вокруг первой оси OA1, расположенной под углом 1 к оси Х базиса, проводят на угол P1, после чего из начального положения производят второй разворот акселерометра вокруг второй оси ОА 2, расположенной в плоскости XOY под углом 2 к оси X, на угол P2, дополнительно измеряют сигналы акселерометра U1 в исходном положении, U2 после первого и U3 после второго разворотов на углы P1 и P2, а угловые координаты , и определяют из соотношений:
U2 /U1=Sin( 1- P1)/Sin 1
U3/U 1=Sin( 2- P2)/Sin 2
Cos2 + Cos2 +Cos2 =1
Sin2 1=Cos2 :[1-(Cos 1×Cos +Cos ×Sin 1)2]
Sin2 2=Cos2 :[1-(Cos 2×Cos +Cos ×Sin 2)2]
при этом величину углов P1 и P2 выбирают из соотношений:
Sin2 P1=Cos2 P:[1-(Cos 1×Cos P+Cos P×Sin 1)2]
Sin2 P2=Cos2 P:[1-(Cos 2×Cos P+Cos P×Sin 2)2]
где P [ 0- , 0+ ], P [ 0- , 0+ ], Р [ 0- , 0+ ], а 0, 0, 0 - заданные угловые координаты измерительной оси, , , - максимально возможная погрешность фактического расположения измерительной оси относительно заданного положения, 1, 2 - углы поворота акселерометра из начального положения, при которых сигнал с акселерометра равен нулю.
На чертеже представлена базовая ортогональная система координат OXYZ и орт е (измерительная ось акселерометра), заданный углами , и , которые он образует с положительными направлениями осей OXYZ. Плоскость, заданная векторами OZ и е, образует прямой угол с плоскостью OXY. Вектор OA1 является осью первого разворота, принадлежит плоскости OXY и образует угол 1 с вектором ОХ. Вектор ОА 2 является осью второго разворота, принадлежит плоскости OXY и образует угол 2 с вектором OX. 1 - это угол поворота акселерометра из начального положения вокруг оси OA1 до положения, при которых сигнал с акселерометра равен нулю. 2 - это угол поворота акселерометра из начального положения вокруг оси ОА2 до положения, при которых сигнал с акселерометра равен нулю. Угол - это угол между осью вращения ОА1 и измерительной осью акселерометра. Отрезок BD перпендикулярен оси вращения ОА1 и является катетом прямоугольного треугольника OBD. Дуга A1C и дуга а являются катетами сферического прямоугольного треугольника А 1ВС с прямым углом С, а дуга с является его гипотенузой. Определим сигнал с акселерометра в исходном состоянии. Для этого рассмотрим прямоугольный треугольник OBD с прямым углом D. В нем катет BD можно выразить через гипотенузу е как
Таким образом, можно представить измеренный сигнал U от полного сигнала акселерометра F в случае, когда плоскость BOA1 перпендикулярна плоскости OXY, плоскость OXY горизонтальна, а вектор е совпадает с измерительной осью акселерометра как U=F×Sin . В случае, когда угол между плоскостью ВОА 1 и плоскостью OXY равен , измеренный сигнал U можно представить как
В прямоугольном сферическом треугольнике A 1BC гипотенуза с определена углом , а катет а - углом (90°- ). Исходя из формулы синусов для сферических треугольников (Sina/SinA1=Sinc/SinC) получим:
Учитывая, что SinC=1, Sin(90°- )=Cos , a SinA1=Sin 1, выражение (3) примет вид:
Подставив Sin из соотношения (4) в выражение (2), получим:
Учитывая, что в исходном состоянии = 1, получим выражение для первого замера сигнала с акселерометра:
Сигнал с акселерометра после первого разворота вокруг оси OA1 на известный угол P1 (второй замер) будет:
Разделив соотношение (7) на (6), получим:
Аналогичным образом получим соотношение для сигналов U3 (третий замер) и U 1 (первый замер) после второго разворота вокруг оси ОА 2 на известный угол P2:
Определение угловых координат , и измерительной оси е акселерометра осуществляется следующим образом. Пусть поворотная установка имеет платформу, которую можно горизонтировать и устанавливать на нее акселерометр (прибор, в котором установлены акселерометры). Поворотная установка имеет две измерительные оси вращения OA1 и OA 2 с точной фиксацией углов поворота, расположенные под углами 1 и 2 относительно оси X. Выставим плоскость OXY поворотной установки в горизонт. Проведем первый замер сигнала U1 с акселерометра в исходном состоянии. Вычислим углы P1 и P2 из соотношений:
Sin 2 P1=Cos2 P:[1-(Cos 1×Cos P+Cos P×Sin 1)2]
Sin2 P2=Cos2 P:[1-(Cos 2×Cos P+Cos P×Sin 2)2]
где P [ 0- , 0+ ], P [ 0- , 0+ ], P [ 0- , 0+ ], 0, 0, 0 - заданные угловые координаты измерительной оси, , , - максимально возможная погрешность фактического расположения измерительной оси относительно заданного положения. Повернем платформу относительно оси ОА1 на угол P1. Проведем второй замер сигнала U2 с акселерометра. Установим акселерометр (прибор) в исходное положение (выставим плоскость OXY поворотной установки в горизонт). Повернем платформу относительно оси ОА 2 на угол P2. Проведем третий замер сигнала U3 с акселерометра. Вычислим углы 1 и 2, решая уравнения (8) и (9). Подставим значения 1, 1 и 2, 2 в два последние равенства системы уравнений
Cos2 +Cos2 +Cos2 =1
Sin2 1=Cos2 :[1-(Cos 1×Cos +Cos ×Sin 1)2]
Sin2 2=Cos2 :[1-(Cos 2×Cos +Cos ×Sin 2)2]
и, решая ее, определим угловые координаты , и измерительной оси акселерометра е в исходном базисе X, Y, Z.
Оценим влияние выбора угла P ( P1 и P2) на точность измерения сигнала с акселерометра и вычисления угла ( 1 и 2). Выберем P1 и P2 из соотношений:
Sin 2 P1=Cos2 P:[1-(Cos 1×Cos P+Cos P×Sin 1)2]
Sin2 P2=Cos2 P:[1-(Cos 2×Cos P+Cos P×Sin 2)2]
где p [ 0- , 0+ ], P [ 0- , 0+ ], P [ 0- , 0+ ], 0, 0, 0 - заданные угловые координаты измерительной оси, , , - максимально возможная погрешность фактического расположения измерительной оси относительно заданного положения. Покажем, что такой выбор дает лучшую точность измерения. Результат измерения сигнала с датчика UП с учетом относительной погрешности можно будет представить как:
U П=K×U, где K - коэффициент, определяющий погрешность. С учетом выражения (7) получим:
Это измерение с погрешностью приведет к неточному вычислению угла , который будет иметь погрешность Р, или
Приравнивая правые части выражений (10) и (11) и преобразовывая, получим:
K×Sin( - P)/Sin =Sin( +Р- P)/Sin( +Р)
Данное выражение является функцией зависимости Р от P (Р=f( P)), представленной в неявном виде. Проводя исследование данной функции (например, численным методом), видим, что
LimP=0
Т.е. чем ближе P к , тем меньше величина ( - P), соответственно, меньше величина Sin( - P). Следовательно, меньше сигнал с акселерометра и меньше сигнал с учетом относительной погрешности. Это приводит к уменьшению погрешности Р при вычислении угла . Выбор P1 и P2 из соотношений, приведенных в предлагаемой формуле изобретения, обеспечивает близость значений P1 и P2 к значениям 1 и 2 соответственно.
Эффект от использования предлагаемого способа заключается в том, что он проще известного, т.к. для определения угловых координат акселерометра требуется всего три измерения сигнала с акселерометра и два поворота последнего на определенные углы. В то время как в прототипе требуется проводить несколько последовательных поворотов с последующими замерами сигнала с акселерометра до тех пор, пока сигнал не уменьшится до определенной величины. При этом для уменьшения числа итераций по последовательному приближению требуется наличие хорошей квалификации у оператора.
Вместе с тем предложенный способ позволяет увеличить экономичность определения координат измерительной оси за счет того, что сокращается время на проведение работ. Так, например, в случае, если необходимо получить точность прибора на уровне 10-5 по абсолютной величине, диапазон измеряемых ускорений составляет 10 м/с 2, а вес одного разряда приращения 4 мм/с. Т.е. величина минимального измеряемого сигнала составит 10 м/с 2×10-5=0,1 мм/с 2. И период следования информационных импульсов (кодовых посылок) от минимального полезного сигнала составит 4 мм/с:0,1 мм/с2=40 с. Следовательно, период следования кода, формируемого за счет погрешности, должен быть больше. Учитывая, что трудно (с точки зрения стоимости) бороться с погрешностью, вызванной электронной частью прибора, желательно минимизировать погрешность от неправильной тарировки (измерения координат) датчиков. Это вызывает необходимость увеличивать период следования кода от неправильной установки примерно на порядок, т.е. до 400 с. С учетом особенностей работы измерительных приборов (организации цикла измерения, например, с целью защиты от "плавания" периода, вызванного синхронизацией преобразования и передачи информационного кода, вводится измерение нескольких периодов и вычисления среднего), реальное время измерения может быть значительно больше. Учитывая, что операция разворота занимает много времени и необходимо провести измерение параметров нескольких акселерометров, установленных в приборе, при реализации способа-прототипа, потребуется очень много времени, что делает его дорогим в части трудозатрат. Поэтому в случае применения акселерометров, не имеющих нулевой составляющей сигнала (сигнал акселерометра равен нулю при отсутствии ускорения), предлагаемый способ является более экономичным.
Точность определения угловых координат у предложенного способа будет не хуже, чем у прототипа для датчиков с линейным коэффициентом преобразования. У заявляемого способа она определяется погрешностью измерения, а у прототипа - погрешностью измерения плюс допуск на устанавливаемый нулевой сигнал (сигнал, при котором прекращаются действия по изменению наклона для достижения еще более низкого сигнала с акселерометра). При этом абсолютные погрешности измерений у предлагаемого способа могут быть больше. Рассмотрим их влияние на вычисление углов . На практике приходится решать задачу по измерению фактических угловых координат , и измерительной оси акселерометра, получившихся при изготовлении прибора и отличающихся от заданных 0, 0, 0 на некоторые небольшие значения ± i (i= , , ). Вычисленное значение углов P будет отличаться от углов (при повороте на который сигнал с акселерометра равен нулю) на величину того же порядка, что и допуска ± i (будет изменяться в зависимости от соотношения углов , и ). Пусть, например, эта разница составляет 20 , искомый угол 1=45°, вычисленный угол P1=44° 40 , относительная погрешность измерения сигнала с акселерометра 0,001. Вычислим угол 1, подставляя выбранные значения в уравнение (8) и решая его, при этом примем, что U 2=(1+0,001)×Sin45°, a U1 =(1-0,001)×Sin20' (т.е. наихудший случай, когда погрешности при измерении имеют разный знак). В результате получим 1=44,999330°, т.е. погрешность составляет всего 2,42". В случае уменьшения относительной погрешности при измерении сигнала с акселерометра погрешность при вычислении будет еще меньше. Уменьшение допуска на устанавливаемый нулевой сигнал ниже нескольких секунд у способа-прототипа приводит к увеличению операций разворот-измерение.
Предлагаемая совокупность признаков в рассмотренных авторами решениях не встречалась для решения поставленной задачи и не следует явным образом из уровня техники, что позволяет сделать вывод о соответствии технического решения критериям "новизна" и "изобретательский уровень".
Для реализации данного способа необходима платформа с не менее чем двумя рамками карданного подвеса (двумя степенями свободы), например, такая, как представлена в [3] страница 158.
Литература
1. Патент Российской Федерации №02117950 от 20.08.98. Способ определения параметров прецизионных акселерометров. G01P 21/00.
2. Патент Российской Федерации №02164693 от 29.07.99. Способ определения угловых координат измерительной оси акселерометра. G01P 21/00.
3. Савант С.Дж., Ховард Р., Соллоуай С., Савант С.А. Принципы инерциальной навигации. Издательство "Мир", 1965 г.
Класс G01P21/00 Испытания и калибровка приборов и устройств, отнесенных к другим группам данного подкласса