В настоящее время задача определения пространственного положения частей тела человека является актуальной. Системы захвата движения находят применение в таких областях как робототехника, создание интерфейсов человек-машина, в кино индустрии и системах виртуальной реальности. Также стоит отметить важность данных систем в медицине для исследования динамики человека и создания более совершенных протезов.
Существуют различные виды систем захвата движения: механические, оптические, активные магнитные и инерциально-магнитные. Комплексы на основе инерциальных и магнитных датчиков являются относительно новыми и с применением микроэлектромеханических (МЭМС) датчиков обретают огромную популярность. В отличие от других они не нуждаются в искусственных источниках и не имеют ограничений по дальности работы, обладают малыми габаритами и легкостью в использовании.
Принцип работы инерциальных систем основан на интегрировании угловых скоростей - показаний гироскопа. Однако из-за шумов и нестабильности смещения нуля при интегрировании происходит накопление ошибки. Поэтому возникает необходимость использовать дополнительные датчики такие как акселерометры и магнитометры. Задача объединения показаний трех датчиков и формирования оптимальной оценки положения объекта в пространстве успешно решается применением фильтра Калмана.
Целью данной работы является построение программно-аппаратного комплекса захвата движения человека с использованием МЭМС гироскопа, акселерометра и магнитометра.
Для достижения данной цели необходимо решить следующие задачи:
• Разработка системы сбора данных с датчиков на базе микроконтроллера.
• Проведение процедуры калибровки датчиков
Разработка и реализация фильтра Калмана в программном пакете MATLAB/Simulink
• Построение тестового стенда и проведение на нем экспериментов по оценке параметров полученной системы
• Реализация в MATLAB/Simulink модуля 3D визуализации данных о движении человека
Данная работа состоит из введения, четырех разделов основной части, заключения, приложения и списка литературы.
В первом разделе изложены теоретические и технические основы, необходимые для определения пространственного положения объекта.
Во втором разделе подробно описана программно-аппаратная реализация разработанной системы с необходимыми иллюстрациями и таблицами.
Третий раздел посвящен такой важной задаче как калибровка датчиков. Дана информация о методологии и особенностях калибровки применяемых датчиков.
В последнем разделе работы подробно описана процедура и результаты тестирования системы. Определены точностные характеристики и эффективность при натурных испытаниях захвата движения руки человека.
В ходе данной работы был построен программно-аппаратный комплекс захвата движения человека на основе МЭМС гироскопа, акселерометра и магнитометра. Исследованы методы и алгоритмы оптимальной обработки показаний датчиков для определения ориентации объекта. Разработан и реализован в MATLAB расширенный фильтр Калмана на основе кватернионов. Подробно описана и проведена процедура калибровки датчиков. Построен тестовый стенд и на нем определены точностные характеристики разработанной системы. В MATLAB/Simulink реализован модуль 3D визуализации данных о движении человека.
В результате работы показано, что разработанный фильтр Калмана успешно борется с таким источником ошибок как нестабильность нуля гироскопа и позволяет улучшить точность определения угла на длительных промежутках времени:
• в 16 раз по оси Х
• в 18 раз по оси Y
• в 1,8 раза по оси Z
Результирующая точность определения углов, найденная в ходе проведенных экспериментов на тестовом стенде, равняется:
• ось Х - ± 2°
• ось Y - ± 2°
• ось Z - ± 6°
Проведены натурные эксперименты по захвату движения руки человека с визуализацией 3D модели в режиме реального времени. Данные эксперименты показали практическую применимость разработанного программно-аппаратного комплекса.
1. Хакимуллин Р.М. Моделирование адаптивного цифрового предистортера на рядах Вольтерра / Р.М. Хакимуллин, В.В. Бочкарев // Вестник компьютерных и информационных технологий, 2015, №7.
С.52 - 56.
2. Berner P. Orientation, rotation, velocity, and acceleration and the SRM [Электронный ресурс] / R. Toms, K. Trott, F. Mamaghani, 2007. URL: http://sedris.org/wg8home/Documents/WG80485.pdf (дата обращения: 20.01.2015)
3. Van Verth J. Essential mathematics for games and interactive applications: a programmer’s guide / James M. Van Verth, Lars M. Bishop. Burlington: Elsevier Inc., 2004, 672 p.
4. Leandra Vicci. Quaternions and rotations in 3-space: The algebra and its geometric interpretation. [Электронный ресурс] - 2001.
5. Jay A. Farrell. Aided Navigation: GPS with high rate sensors / Jay A. Farrell. -McGraw Hill, 2008, 530 p.
6. Eric W. Weisstein. CRC concise encyclopedia of mathematics / Eric W. Weisstein. - Chapman & Hall, 2nd edition, 2003, - 3242 p.
7. Mohinder S. Grewal. Global Positioning Systems, Inertial Navigation, and Integration / Mohinder S. Grewal, Lawrence R. Weill, Angus P. Andrews. - New Jersey: Wiley, 2001 - 525 p.
8. J. Merayo. Scalar calibration of vector magnetometers / J. Merayo, P. Brauer, F. Primdahl, J. Petersen, O. Nielsen // Measurement Science and Technology. - 2000, №11/2 - P.120-132.
9. Tomas Svoboda. Least-squares solution of homogeneous equations. [Электронный ресурс] -2005.
10. Alain Barraud and Suzanne Lesecq. Magnetometer calibration. [Электронный ресурс] - 2008.
11. Chris Hall. Attitude determination chapter 4. [Электронный ресурс] -
2003.
12.Ildeniz Duman. Design, implementation and testing of a real-time software system for a quaternion-based attitude estimation filter. Master's thesis, Naval Postgraduate School. [Электронный ресурс] - 1999.
13. Joao L. Marins. An extended kalman filter for quaternion-based attitude estimation. Master's thesis, Naval Postgraduate School. [Электронный ресурс] - 2000.
14. Allan Variance: Noise Analysis for Gyroscopes. [Электронный ресурс] -
2015.