Введение 3
Постановка задачи 4
Введение в предметную область 4
Обзор литературы 5
Глава 1. IMU датчики 6
1.1. Постановка задачи 6
1.2. Описание оборудования и программных средств 6
1.3. Фильтр Маджвика 8
1.4. Описание исследований 11
1.5. Результаты опытов 15
Глава 2. ArUco openCV 17
2.1. Постановка задачи 17
2.2. Описание оборудования и программных средств 17
2.3. Калибровка камеры 17
2.4. ArUco маркеры 21
2.5. Описание исследований 23
2.6. Результаты опытов 25
Глава 3. Комплексный подход 26
3.1. Постановка задачи 26
3.2. Описание оборудования и программных средств 26
3.3. Описание исследований 29
3.4. Результаты опытов 32
Выводы 33
Заключение 34
Список литературы 35
Приложение 37
Глава A. Переход в заданную точку для робота Fanuc 37
Глава B. Код клиента Python 38
Для любого робототехнического комплекса, будь то шестизвенный робот- манипулятор, работающий в недетерминированной среде, или автономная тележка, одним из лучших вариантов для управления является система копирующего управления с обратной связью — билатеральное управление. Одним из подходов для обучения робота действиям внутри детерминированной среды является задание координат точек, по которым ему необходимо пройти, однако более удобным является показ необходимых действий. Примером реализации данного метода являются модели, представленные компанией Rozum Robotics [1].
Подход с "показом необходимых действий" возможно использовать при наличии робота в доступном месте - то есть человеку необходимо находиться в непосредственном контакте с оборудованием. Однако, такое далеко не всегда возможно - например, в случаях использования роботов в недоступных для людей местах (пещеры, завалы, подводная среда и прочее), опасных средах или в космосе. Таким образом, важной задачей является дистанционное копирующее управление роботом, опционально - с наличием обратной связи. Сегодня для такого используются системы, состоящие из управляемого робота и управляющего устройства, представляющего из себя копию робота, которую можно двигать, тем самым задавая положение реального экземпляра. Однако, у таких систем есть ряд недостатков:
• высокая стоимость;
• отсутствие гибкости для различных моделей роботов;
• значительное время создания для конкретной модели робота;
• значительное время разворачивания системы.
Таким образом, важной задачей является разработка и создание прототипа системы копирующего управления, которая лишена данных недостатков. В данной работе проанализировано несколько методов, с помощью которых возможно спроектировать данную систему:
• метод, основанный на использовании инерциальной навигационной системы;
• метод, основанный на использовании системы технического зрения;
• метод, совмещающий два предыдущих.
В результате данной работы были изучены принципы работы акселерометра, гироскопа, магнитометра, подходы к фильтрации данных, в частности, методы вычисления углов вращения. Был создан прототип системы позиционирования, в основе которого находится IMU датчик. Затем определены его слабые стороны и изучены подходы к решению данной задачи посредством системы технического зрения и алгоритмов openCV, изучен вопрос калибровки камеры, построен прототип. Итогом работы стало создание третьего прототипа системы позиционирования, в основе которого лежат сильные стороны предыдущих двух подходов, и который отвечает всем поставленным требованиям к разрабатываемой системе в начале работы.
[1] Rozum Robotics [Электронный ресурс] - URL: https://rozum.com/
[2] An efficient orientation filter for inertial and inertial/magnetic sensor arrays: Rep. / University of Bristol; Executor: Sebastian O.H. Madgwick.
[3] S. O. H. Madgwick, A. J. L. Harrison and R Vaidyanathan, "Estimation of IMU and MARG orientation using a gradient descent algorithm," 2011 IEEE International Conference on Rehabilitation Robotics, Zurich, 2011, pp. 1-7, doi: 10.1109/ICORR.2011.5975346
[4] R. Mahony, Tarek Hamel, Jean-Michel Pflimlin. Nonlinear Complementary Filters on the Special Orthogonal Group. IEEE Transactions on Automatic Control, Institute of Electrical and Electronics Engineers, 2008, 53 (5), pp.1203-1217. doi: 10.1109/TAC.2008.923738
[5] Kalman, R.E. (1960). «A new approach to linear filtering and prediction problems». Journal of Basic Engineering 82 (1): pp.35-45
[6] Moiseev, O.S., Sarsadskikh, A.S., Povalyaev, N.D., Gorbunov, V.I., Kulakov, F.M., Vasilev, V.V. (2018). Force-sensed interface for control and training space robot. Представлено на THE EIGHTH POLYAKHOV’S READING: Proceedings of the International Scientific Conference on Mechanics. doi: 10.1063/1.5034735
[7] МЭМС акселерометры, гироскопы и геомагнитные датчики - революционно новый функционал потребительских устройств // Радиолоцман - июнь 2012. [Электронный ресурс] - URL: https://www.rlocman.ru/review/article.html?di=134058
[8] Моисеев О. С., Горбунов В. И. Система копирующего управления роботом-манипулятором // Control Processes and Stability vol.4. СПб.: Publishing house Fedorova G. V., 2017. С. 186-191.
[9] Joel Li, Van Yang Strapdown Inertial Navigation System Based on an IMU and a Geomagnetic Sensor // Analog Dialogue. 53-03, March 2019.
[10] An Gwon, Lee Siyeong, Seo Min-Woo, Yun Kugjin, Cheong Won- Sik, Kang Suk-Ju. (2018). Charuco Board-Based Omnidirectional Camera Calibration Method. Electronics. doi: 10.3390/electronics7120421
[11] S. Garrido-Jurado, R. Munoz-Salinas, F.J. Madrid-Cuevas, R. Medina- Carnicer, Generation of fiducial marker dictionaries using Mixed Integer Linear Programming, Pattern Recognition, Volume 51, 2016, Pages 481-491, ISSN 0031-3203, doi: 10.1016/j.patcog.2015.09.023
[12] Francisco J. Romero-Ramirez, R. Munoz-Salinas, R Medina-Carnicer, Speeded up detection of squared fiducial markers, Image and Vision Computing, Volume 76, 2018, Pages 38-47, ISSN 0262-8856, doi: 10.1016/j.imavis.2018.05.004