Научная статья на тему 'РЕШЕНИЕ ЗАДАЧИ ОПРЕДЕЛЕНИЯ ОРИЕНТАЦИИ ОБЪЕКТИВОВ БИНОКЛЯ С ПОМОЩЬЮ ИНЕРЦИАЛЬНЫХ ДАТЧИКОВ'

РЕШЕНИЕ ЗАДАЧИ ОПРЕДЕЛЕНИЯ ОРИЕНТАЦИИ ОБЪЕКТИВОВ БИНОКЛЯ С ПОМОЩЬЮ ИНЕРЦИАЛЬНЫХ ДАТЧИКОВ Текст научной статьи по специальности «Математика»

CC BY
65
9
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
ТРЕКИНГ / ВИРТУАЛЬНАЯ РЕАЛЬНОСТЬ / АКСЕЛЕРОМЕТР / ДАТЧИК УГЛОВЫХ СКОРОСТЕЙ / МАГНИТОМЕТР / ФИЛЬТР МАДЖВИКА

Аннотация научной статьи по математике, автор научной работы — Латонов Василий Васильевич, Беляков Никита Викторович, Петров Александр Андреевич, Семенихин Тимофей Александрович

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

i Надоели баннеры? Вы всегда можете отключить рекламу.

Похожие темы научных работ по математике , автор научной работы — Латонов Василий Васильевич, Беляков Никита Викторович, Петров Александр Андреевич, Семенихин Тимофей Александрович

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.
i Надоели баннеры? Вы всегда можете отключить рекламу.

DETERMINING BINOCULAR LENSES ORIENTATION USING INERTIAL SENSORS: PROBLEM SOLUTION

The paper considers a binocular-shaped device, which consists of two solid bodies - lenses connected by a common axis of rotation, and introduces a solution to the problem of the absolute and relative positioning of each of the lenses of the device using accelerometers, angular velocity sensors and Hall sensors installed in each of the lenses. To solve the problem, we developed an algorithm based on the Madgwick filter. The algorithm uses data from all sensors and determines the orientation of both lenses from this data. In addition to the information received from the sensors, the solution of the problem uses information about the geometric relationship imposed on the system - the common axis of rotation of both lenses. The ARTrack video analysis system was used to verify the obtained algorithm. The results of the filter operation were verified using the records received from the video analysis system.

Текст научной работы на тему «РЕШЕНИЕ ЗАДАЧИ ОПРЕДЕЛЕНИЯ ОРИЕНТАЦИИ ОБЪЕКТИВОВ БИНОКЛЯ С ПОМОЩЬЮ ИНЕРЦИАЛЬНЫХ ДАТЧИКОВ»

УДК 629.056.6

DOI: 10.18698/2308-6033-2022-2-2154

Решение задачи определения ориентации объективов бинокля с помощью инерциальных датчиков

12 2 2

© В.В. Латонов , Н.В. Беляков , А.А. Петров , Т.А. Семенихин

1НЦМУ «Сверхзвук», Москва, 119234, Россия, 2МГУ имени М.В. Ломоносова, Москва, 119234, Россия

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

Ключевые слова: трекинг, виртуальная реальность, акселерометр, датчик угловых скоростей, магнитометр, фильтр Маджвика

Введение. Устройства визуальной имитации необходимы для подготовки операторов сложных систем [1, 2]. Они позволяют имитировать зрительные образы, которые возникают перед глазами оператора при выполнении различных сложных задач.

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

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

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

Обзор существующих работ. Для решения задачи ориентации в обоих объективах установлены трехосный датчик угловых скоростей (ДУС), трехосный акселерометр и трехосный магнитометр (датчик Холла). Определение ориентации объективов относительно друг друга сводится к задаче выставки бескарданной инерциальной навигационной системы (БИНС) на подвижном основании, которая была детально исследована многими авторами. Эта задача часто рассматривается в работах, посвященных навигационным системам, предназначенным для авиации. Однако в авиационной индустрии нередко используются внешние измерения в дополнение к инерциальным датчикам. Например, в работе [3] для выставки БИНС на борту самолета используются измерения спутниковой навигационной системы, а в [4] — также системы воздушных сигналов и астросистемы.

Рис. 1. Схема фильтра Маджвика

Кроме того, задача определения взаимной ориентации объективов сводится к задаче ориентации двух тел, связанных одной или двумя общими степенями свободы. Существует ряд работ, посвященных трекингу дву- и трехзвенников, в том числе в приложении к УЯ-задачам. В частности, в работе [5] рассмотрена задача трекинга трехзвенника со степенями свободы, свойственными человеческому пальцу, а в работе [6] изложена разработка перчатки, отвечающей за отслеживание положения руки человека. В решении применялся известный фильтр — фильтр Маджвика (Madgwick), схема которого приведена на рис. 1. В предлагаемой работе сделан акцент на статьи,

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

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

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

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

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

Данные с используемых датчиков GY-80 и GY-801 получены с помощью плат Arduino Nano, запрограммированных в соответствующей среде Arduino IDE. Анализ данных и моделирование проводились в математическом пакете Wolfram Mathematka. Фильтр Мадж-вика был написан на языке C++.

Схема датчика GY-80 (взята с сайта электронных компонент AVRobot.ru) приведена на рис. 2. Он состоит из трехосных акселерометра ADXL345В, магнитометра HMC5883L и ДУС L3G4200D. В состав GY-80 также входят датчик атмосферного давления и термометр, не используемые в задаче.

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

Рис. 2. Схема датчика вУ-80 и его компонент

Вывод уравнений. Рассмотрим фильтр, который можно применять к данным с датчиков каждого объектива отдельно. Учитывая, что в системах датчиков есть акселерометр, магнитометр и ДУС, можно вычислить две траектории кватернионов двумя способами: первый — по векторам гравитации и магнитной индукции, которые в силу непараллельности однозначно задают ориентацию относительно некоторой глобальной системы координат (ГСК); второй — с помощью уравнения Пуассона, учитывающего угловые скорости с ДУС. В качестве ГСК возьмем систему, обладающую следующими свойствами: вектор гравитации сонаправлен 02, вектор магнитной индукции лежит в плоскости 0x2. Благодаря перечисленным условиям эта система координат определяется единственным образом.

Фильтр Маджвика. Введем обозначения для кватернионов: Ук — итоговая оценка кватерниона ориентации в момент 4; Хк — оценка кватерниона ориентации, вычисленная по данным ДУС; 2к — оценка кватерниона ориентации, вычисленная по данным акселерометра и магнитометра, также в момент

Оценка 2к определяется через векторы гравитации ак и индукции шк. Для определения 2к вычислим матрицу поворота Мк, соответствующую кватерниону 2к. Соответствующие столбцы этой матрицы обозначим мк1, мк2, Мк3 в силу выбора ГСК можем записать

м\ = ; м\ = II ак 112

, ш, Мк х-к-

I т 112 J

; М1 = \_М\ хМ\].

Из матрицы поворота нетрудно получить соответствующий кватернион.

Положим У0 = 20. Вектор угловых скоростей обозначим юк. Запишем численное приближение уравнения Пуассона:

Хк = ^ Юк° Ук.

Для применения фильтра также найдем 2к. Рассмотрим поле векторов гравитации и магнитной индукции и некоторую вектор-функцию /к от аргументов ак и шк, такую, что 2к будет параллелен V/'

-.—(V- градиент). Поскольку нет различий в рассуждениях для

гМ

гравитационного и магнитного полей, функцию /к для некоторого поля ёк определим следующим образом:

/к = 22- 1 4° 2к - ёк.

При идеально выбранных 2к эта функция равна векторному нулю, так как по определению — 2--1°^о° 2к является записью ^ в системе координат после поворота, т. е. ёк, в случае отсутствия шумов. В работе [8] показано, что нуль — точка экстремума этой функции, поэтому решение можно найти градиентным методом. Для следующих вычислений предварительно нормируем векторы гравитации и индукции в каждый момент времени. Исходя из выбора ГСК, после нормировки получим а0 = ( 0,0,1), ш0 =(Ъх ,0, ). Учитывая это, запишем в один вектор компоненты определенной выше функции /к, раскрыв кватернионное произведение, для гравитационного и магнитного полей, подставив вместо 2к вычисленные на предыдущем шаге Ук:

/к -

-272к 27Хк о -2Ьх7зк -2Ьх7зк + 2Ь7к 2Ьх72к "

27зк 27о к -47к ВДк 2Ьх72 к + 2Ь27ок 2Ьх7зк - 4Ь7к

-27о к 27зк -472к -4Ьх72к - 2Ь7ок 2Ь7к + 2Ь7зк 2Ьх7ок - 4ЬЛк

27[к 272к о -4Ьх7зк + 2Ь7к -2Ь7 к + 2Ь72 к 2Ьх7Хк )

( 2(71к7зк 7о к72к) ахк

2(7ок71к + 72к7зк ) - аук 2(1/2-712к-722к )-агк 2ЬХ(1/2-722к -7з2к) + 2Ьг(71к7зк -7ок72к)-2Ьх(71к72к -7ок7зк) + 2Ьг(7^ + 72к7зк)-шук 2Ьх(7ок72к + 71к7зк) + 2Ьг(1/2-^ -722к)-ш*

Определим Jk для удобства вычислений и градиент /к, после чего, нормировав результат, найдем направление 2к:

Jk -

• _ 1 У/к

У/к - Jкfк; •к |77Г|; 7к - Хк - Р^к,

Р \У1к\

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

После определения р вычислим 7к:

7к - 7к-1 + ^к - ^к-1)7к.

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

1. Обозначим через е ось симметрии в системе координат ведущего объектива. Предположим, что она известна. Следовательно, в каждый момент времени можно составить выражение, равное нулю при отсутствии погрешности:

Ч1к

( ( соб

(

-бШ

Л

42 к 2.

Здесь % к — угол раствора между объективами (относительно начального положения окуляров), на который следует повернуть ведущий

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

Г Л

К -(cos (хк/2) -sin (хк/2)e))к| 12 ^ minхк6

V к )

^ mineeS3

Аргументы е и к- , на которых достигается минимум этого выражения, — ось симметрии и угол раствора в каждый момент времени.

После этого вычислим кватернион для ведущего объектива

(( +((к-/2),-^п(к-/2)е)° ^2к)/2

и нормируем его. Ориентацию второго объектива найдем в результате доворота ведущего объектива вокруг оси симметрии на вычисленный угол раствора.

2. Второй алгоритм полностью повторяет первый, за исключением того, что заранее известна ось симметрии. Для ее поиска предварительно проведен опыт, в котором вращение бинокля и объективов происходило только вокруг искомой оси. Ее можно найти двумя независимыми способами, по показаниям акселерометра и магнитометра. Идея в обоих случаях одинакова: так как вектор, измеряемый ими, постоянен, то при вращении ведущего окуляра вокруг фиксированной оси эти векторы образуют боковую поверхность некоторого конуса. Тогда ось симметрии есть перпендикуляр к основанию этого конуса и ее можно найти методом наименьших квадратов:

XI АХк + ВУк + Czk + 1Н min

А,В,СеБ

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

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

t

к

(

V к

чк

ч ° ч1

л

^ Ш1П

Че>?4 •

где ч\, чк — вычисленный по датчикам и эталонный кватернионы соответственно.

Два типа движения, из которых складывалось произвольное вращение, приводимое в эксперименте, показаны на рис. з: первое — относительное движение объективов, однозначно определяемое углом раствора; второе — вращение бинокля, определяемое кватернионом.

Относительное

Рис. 3. Схема движений для верификации алгоритма

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

опыта получали N пар. Далее рассчитывали сумму скалярных произведений соответствующих пар кватернионов как обычных четырех-1 2

мерных векторов (чк, Чк ). Такая сумма равнялась максимум N, если

совпадение было абсолютным, и минимум —N. В целях обобщения данного значения для любого опыта его нормировали делением на 2N и прибавлением 1/2. Тогда

х-2 *

, ¿(ч,1,?,2)

1-1.1-1_

2 N

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

причем х £ [о, 1], х _ 1 — при наилучшей точности вычисления кватернионов, х < 1/2 — при плохой.

Для иллюстрации результатов итоговой верификации приведем графики: эталонный и вычисленный углы раствора (рис. 4) и соответствующие компоненты кватерниона для ведущего объектива (рис. 5).

Угол, рад 6

Рис. 4. Углы раствора относительно ведущего объектива:

( ) — эталонный; ( ) — вычисленный

-1,0 I-

Рис. 5. Компоненты кватерниона для ведущего объектива:

а — итоговый скаляр; б — итоговая первая координата мнимой части; в — итоговая вторая координата мнимой части; г — итоговая третья координата мнимой части; ( ) — эталонный;

( ) — вычисленный

Из итоговых результатов можно получить кватернион ориентации для второго объектива (д\к, q2k — кватернионы для ведущего и второго объектива соответственно):

q2 к = ( ( к- /2) ^п ( к- /2)е)).

Для каждого объектива была вычислена характеристика точности по приведенным ранее формулам. При использовании фильтра Маджвика итоговая точность для каждого оказалась одинаковой (с точностью до десятых долей процента), равной примерно 91 %. Это свидетельствует о том, что алгоритм можно использовать в реальных задачах.

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

Публикация подготовлена в рамках реализации Программы создания и развития научного центра мирового уровня «Сверхзвук» на 2020—2025 годы при финансовой поддержке Минобрнауки России (распоряжение Правительства РФ от 24 октября 2020 г. № 2744-р).

ЛИТЕРАТУРА

[1] Кручинина А.П., Латонов В.В., Чертополохов В.А. Обзор технологий визуальной имитации в тренажерных системах. Пилотируемые полеты в космос, 2019, № 3, с. 89-107.

[2] Роганов В.Р., Филиппенко В.О. Сравнительный анализ систем имитации визуальной обстановки. Современные информационные технологии, 2014, № 19, с. 162-166.

[3] Салычев О.С., Мкртчян В.И. Подходы к выставке на подвижном основании для бесплатформенной инерциальной навигационной системы авиационного типа различного класса точности. Инженерный журнал: наука и инновации, 2018, вып. 11. http://dx.doi.org/10.18698/2308-6033-2018-11-1823

[4] Савельев В.М., Антонов Д.А. Выставка бесплатформенной инерциальной навигационной системы беспилотного летательного аппарата на подвижном основании. Электронный журнал «Труды МАИ», 2011, № 45. URL: http://trudymai.ru/published.php?ID=25497&PAGEN_2=2

[5] Kaczmarek P., Tomczyrnski J., Marnkowski T. EKF-based method for kinematic configuration estimation of finger-like structure using low grade multi-IMU system. IEEE Intemational Conference on Multisensor Fusion and Integration for Intelligent Systems (MFI), 2016, pp. 552-557. DOI: 10.1109/MFI.2016.7849546

[6] Henderson E.N. An inertial measurement system for hand and finger tracking: Thesis for the degree of Master of Science in Electrical Engineering. Boston State University, 2011. URL: https://scholarworks.boisestate.edu/td/233/

[7] Zihajehzadeh S., Loh D., Lee M., Hoskinson R., Park E.J. A Cascaded Two-Step Kalman Filter for Estimation of Human Body Segment Orientation Using MEMSIMU. 36th Annual International Conference of the IEEE Engineering in Medicine and Biology Society, 2014.

URL: https://ieeexplore.ieee.org/document/6945062

[8] Madgwick S.O.H. An efficient orientation filter for inertial and inertial/magnetic sensor arrays. Report x-io and University of Bristol (UK), 2010, no. 25, pp. 113-118.

[9] Kaiqiang Feng, Jie Li, Xiaoming Zhang, Chong Shen, Yu Bi, Tao Zheng, Jun Liu. A New Quaternion-Based Kalman Filter for Real-Time Attitude Estimation Using the Two-Step Geometrically-Intuitive Correction Algorithm. Sensors, 2017. URL: https://www.mdpi.com/1424-8220/17/9/2146/html

[10] Bruckner H.P., Spindeldreier C., Blume H. Modification and fixed-point analysis of a Kalman filter for orientation estimation based on 9-D inertial measurement unit data. Conf. Proc. IEEE Eng. Med. Biol. Soc., Osaka, Japan, Jul. 2013, pp. 3953-3956.

[11] Аль Битар Н., Гаврилов А.И. Интеграция бесплатформенной инерциальной и спутниковой навигационных систем на основе слабосвязанной схемы комплексирования с использованием расширенного фильтра Калмана.

Инженерный журнал: наука и инновации, 2019, вып. 4. http://dx.doi.org/10.18698/2308-6033-2019-4-1870

Статья поступила в редакцию 18.10.2021

Ссылку на эту статью просим оформлять следующим образом: Латонов В.В., Беляков Н.В., Петров А.А., Семенихин Т.А. Решение задачи определения ориентации объективов бинокля с помощью инерциальных датчиков.

Инженерный журнал: наука и инновации, 2022, вып. 2. http://dx.doi.org/10.18698/2308-6033-2022-2-2154

Латонов Василий Васильевич — канд. физ.-мат. наук, старший научный сотрудник НЦМУ «Сверхзвук». e-mail: WLatonov@gmail.com

Беляков Никита Викторович — студент ФКИ МГУ имени М.В. Ломоносова. e-mail: bloood555glory@yandex.ru

Петров Александр Андреевич — студент ФКИ МГУ имени М.В. Ломоносова. e-mail: a.petrov1232@yandex.ru

Семенихин Тимофей Александрович — студент ФКИ МГУ имени М. В. Ломоносова. e-mail: ofmafowo@gmail.com

Determining binocular lenses orientation using inertial sensors: problem solution

© V.V. Latonov1, N.V. Belyakov2, A.A. Petrov2, T.A. Semenikhin2

1 World-class research center "Sverkhzvuk", Moscow, 119234, Russia, 2 Lomonosov Moscow State University, Moscow, 119234, Russia

The paper considers a binocular-shaped device, which consists of two solid bodies — lenses connected by a common axis of rotation, and introduces a solution to the problem of the absolute and relative positioning of each of the lenses of the device using accel-erometers, angular velocity sensors and Hall sensors installed in each of the lenses. To solve the problem, we developed an algorithm based on the Madgwick filter. The algorithm uses data from all sensors and determines the orientation of both lenses from this data. In addition to the information received from the sensors, the solution of the problem uses information about the geometric relationship imposed on the system — the common axis of rotation of both lenses. The ARTrack video analysis system was used to verify the obtained algorithm. The results of the filter operation were verified using the records received from the video analysis system.

Keywords: tracking, virtual reality, accelerometer, AVS, magnetometer, Madgwick filter

The paper was prepared within the of the Program of creation and development of the world-class research center "Sverkhzvuk" in 2020-2025 under financial support

of the Ministry of Science and Higher Education of the Russian Federation (Order

of the Government of the Russian Federation dated 24 October 2020 No. 2744^).

references

[1] Kruchinina A.P., Latonov V.V., Chertopolokhov V.A. Pilotiruemye polety v kosmos — Manned Spaceflight, 2019, no. 3, pp. 89-107.

[2] Roganov V.R., Filippenko V.O. Sovremennye informatsionnye tekhnologii (Modern information technologies), 2014, no. 19, pp. 162-166.

[3] Salychev O.S., Mkrtchyan V.I. Inzhenerny zhurnal: nauka i innovatsii — Engineering Journal: Science and Innovation, 2018, iss. 11. http://dx.doi.org/10.18698/2308-6033-2018-11-1823

[4] Savelev V.M., Antonov D.A. Trudy MAI (MAI Proceedings), 2011, no. 45. Available at: http://trudymai.ru/published.php?ID=25497&PAGEN_2=2

[5] Kaczmarek P., Tomczyrnski J., Marnkowski T. EKF-based method for kinematic configuration estimation of finger-like structure using low grade multi-IMU system. IEEE lntemational Conference on Multisensor Fusion and Integration for Intelligent Systems (MFI), 2016, pp. 552-557. DOI: 10.1109/MFI.2016.7849546

[6] Henderson E.N. An inertial measurement system for hand and finger tracking, Thesis for the degree of Master of Science in Electrical Engineering. Boston State University, 2011. Available at: https://scholarworks.boisestate.edu/td/233/

[7] Zihajehzadeh S., Loh D., Lee M., Hoskinson R., Park E.J. A Cascaded Two-Step Kalman Filter for Estimation of Human Body Segment Orientation Using MEMSIMU. 36th Annual International Conference of the IEEE Engineering in Medicine and Biology Society, 2014. Available at: https://ieeexplore.ieee.org/document/6945062

[8] Madgwick S.O.H. An efficient orientation filter for inertial and inertial/magnetic sensor arrays. Reportx-io and University of Bristol (UK), 2010, no. 25, pp.113-118.

[9] Kaiqiang Feng, Jie Li, Xiaoming Zhang, Chong Shen, Yu Bi, Tao Zheng, Jun Liu. A new quaternion-based Kalman filter for real-time attitude estimation using the two-step geometrically-intuitive correction algorithm. Sensors, 2017. Available at: https://www.mdpi.eom/1424-8220/17/9/2146/html

[10] Bruckner H.P., Spindeldreier C., Blume H. Modification and fixed-point analysis of a Kalman filter for orientation estimation based on 9-D inertial measurement unit data. Conf. Proc. IEEE Eng. Med. Biol. Soc. Osaka, Japan, Jul. 2013, pp. 3953-3956.

[11] Al Bitar N., Gavrilov A.I. Inzhenerny zhurnal: nauka i innovatsii — Engineering Journal: Science and Innovation, 2019, iss. 4. http://dx.doi.org/10.18698/2308-6033-2019-4-1870

Latonov V.V., Cand. Sc. (Phys.-Math.), Senior Research Fellow, World-class research center "Sverkhzvuk". e-mail: WLatonov@gmail.com

Belyakov N.V., student, Faculty of Cosmic Research, Lomonosov Moscow State University. e-mail: bloood555glory@yandex.ru

Petrov A.A., student, Faculty of Cosmic Research, Lomonosov Moscow State University. e-mail: a.petrov1232@yandex.ru

Semenikhin T.A., student, Faculty of Cosmic Research, Lomonosov Moscow State University. e-mail: ofmafowo@gmail.com

i Надоели баннеры? Вы всегда можете отключить рекламу.