сотрудник
г. Москва и Московская область, Россия
УДК 60 Прикладные науки. Общие вопросы
ГРНТИ 55.49 Космическая техника и ракетостроение
ОКСО 01.04.03 Механика и математическое моделирование
ББК 30 Техника и технические науки в целом
ТБК 50 Технические науки в целом
BISAC SCI018000 Mechanics / Dynamics
Рассматривается моделирование испытания метода «конечного поворота и смещения» (МКПС) на прохождение через сингулярные точки манипуляционного робота (МР) European Robotic Arm (ERA). Моделированием испытания подтверждена работоспособность метода при прохождении сингулярных точек и показаны способы управления манипуляционным механизмом ERA при различных проявлениях сингулярности. В зависимости от вида проявления сингулярности управление манипуляционным механизмом в окрестности сингулярной точки осуществляется с помощью малых изменений его конфигурации или посредством ограничения и задания конкретных значений обобщенным координатам на программно-аппаратном уровне. Метод МКПС предназначен для решения обратной задачи кинематики (ОЗК) для манипуляционных механизмов последовательной структуры с произвольным числом звеньев, связанных кинематическими парами пятого класса. Метод основан на определении точных и оптимальных итерационных шагов, обеспечивающих максимальное приближение к заданным параметрам конечного звена, для каждой степени подвижности. По алгоритму метода разработано программное обеспечение, состоящее из подпрограмм для организации общего решения ОЗК и частного для конкретного манипуляционного механизма в виде исходных данных. Исходными данными являются векторная модель манипуляционного механизма, значения конструктивных ограничений обобщенных координат и признаки кинематических пар по виду и по классу.
метод «конечного поворота и смещения», манипулятор ERA, обратная задача кинематики, прохождение через сингулярные точки
Введение. В настоящее время манипуляционные роботы (МР) находят широкое применение во всех отраслях промышленности. Их также используют в космосе и под водой. Для проведения технологических операций, не требующих особой точности, используется ручное управление по степеням подвижности от задающего манипулятора. В случае удаленного управления оператор использует камеру наблюдения. Такая организация работы не может обеспечить выполнения всё возрастающего перечня работ с повышенными требованиями к точности и скорости их выполнения. Современное управление манипуляционными механизмами (ММ) предполагает управление конечным звеном. Такое управление позволяет организовать программное движение конечного звена и обеспечить выполнение технологических операций с высокой точностью и скоростью. При таком управлении важной задачей является определение желаемых значений обобщенных координат звеньев манипулятора посредством решения ОЗК, а в случаях использования произвольных траекторий, формируемых автоматически от систем технического зрения и распознавания, добавляется задача прохождения ММ сингулярных точек.
Из всех популярных на сегодняшний день методов, а именно: FABRIK [1, 2], Cyclic Coordinate Descent (CCD) [3, 4, 5], Jacobian Transpose [6, 7], Jacobian DLS [8, 9], Jacobian SVD-DLS [10, 11], FTL[12], Триангуляция [13], метод МКПС не уступает самому быстрому эвристическому методу FABRIK и имеет более естественную настройку для конкретного МР [14, 15].
Цель статьи – показать прохождение сингулярных точек с помощью метода МКПС на примере космического МР ERA, установленного на российском модуле международной космической станции.
Краткое описание метода «конечного поворота и смещения». Метод МКПС геометрический, использует ортогональное преобразование векторов, основан на кинематических свойствах ММ последовательной структуры, а именно: пятый класс кинематической пары, вид соединения в паре (шарнир, призма), ориентация оси и звена в абсолютной системе координат в виде единичного вектора оси и вектора звена соответственно. Углы Эйлера-Крылова используются только для удобства задания ориентации конечного звена манипуляционного механизма МР при вводе/выводе. Точные и оптимальные итерационные шаги для максимально быстрого достижения заданных параметров положения и ориентации конечного звена в методе названы конечными. Для кинематической пары в виде призмы определяется конечное смещение для вектора соответствующего звена. В случае шарнира определяется конечный угол поворота вектора соответствующего звена и всех векторов, следующих за ним согласно векторной модели ММ, показанной на рисунке 4 в общем виде, и алгоритму, изложенному в [15]. В методе используется ортогональное преобразование, которое является математической формой описания вращательного движения твердого тела. Операцию вращения можно выполнить с помощью кватерниона, который задает ортогональное преобразование своей векторной частью. Оно может быть рассмотрено как ортогональное преобразование в вещественном трехмерном пространстве. Если орты векторной части кватерниона формально совмещены с любым базисом трехмерного пространства, то ортогональное преобразование с помощью матрицы сложного поворота эквивалентно ортогональному преобразованию с помощью кватерниона. В методе для операций ортогонального преобразования векторов используется матрица сложного поворота.
В процессе решения ОЗК по алгоритму, изложенному в [15], выполнение условия для каждого i = 1,.., n, где n – число степеней подвижности ММ, Δqi – конечный угол/смещение для i‑ой кинематической пары в виде шарнира/призмы согласно теоремам 1, 2 и 3 приведенным в [14], соответствует наличию сингулярной точки для данной конфигурации ММ, что в дальнейшем называется мониторингом сингулярных точек ММ. В этой точке итерационный процесс не приближает параметры конечного звена к заданным, и начинается проявление сингулярности в виде непредсказуемого вращения группы звеньев, или поворот соседних звеньев в непредсказуемую сторону при значении угла между ними равном 180º. Для продолжения решения ОЗК, в зависимости от вида проявления сингулярности, используются разные механизмы обхода. Для обхода сингулярности, связанной с углом между звеньями равным 180º, используется механизм изменения конфигурации путем прибавления заданного малого числа δqi > εзад (εзад – заданная точность решения ОЗК) к обобщенной координате с заранее выбранным знаком для того, чтобы звенья поворачивались относительно друг друга в нужную сторону. Прохождение через сингулярные точки, вызывающие непредсказуемое вращение группы звеньев, обеспечивается «замораживанием» конкретных значений обобщенных координат или их управлением в окрестности влияния этих точек на движение звеньев ММ. После этого итерационный процесс продолжается до получения решения ОЗК согласно теоремам в [14] и алгоритму в [15]. Окончательную формулу решения ОЗК для обобщенной координаты i-й степени подвижности можно записать в виде суммы:
где qi – конечное значение i-й обобщенной координаты: qi = θi для шарнира, qi = di для призмы;
qi0 – начальное значение i-й обобщенной координаты: qi0 = θi0 для шарнира, qi0 = di0 для призмы;
Δqij – конечный угол/смещение для i-го шарнира/призмы и j-го номера конечного угла/смещения;
i – номер степени подвижности манипулятора i =1, 2, ...., n;
j – номер конечного угла/смещения для i-го шарнира/призмы;
n – число степеней подвижности схвата манипулятора;
z = z0 + z1 + z2 +…+ zm – общее число конечных поворотов и смещений;
z0 – число конечных поворотов и смещений до точки сингулярности;
zk – число конечных поворотов и смещений от k-ой сингулярности до (k+1)-ой;
m – число сингулярных точек на пути решения ОЗК;
δqik – малые значения обобщенных координат, используемые для изменения конфигурации манипулятора при обходе k-ой сингулярной точки.
Рассматриваемый метод обладает следующими свойствами: однозначностью решения ОЗК, высокой скоростью решения ОЗК, универсальностью алгоритма по отношению к числу звеньев ММ, возможностью использовать вычислители малой мощности, линейной зависимостью времени решения ОЗК от числа звеньев ММ, что даёт возможность проектировать ММ произвольной конструкции, отвечающей оптимальной конфигурации для тех или иных требований.
Описание манипулятора ERA. Семистепенной МР ERA, показанный на рисунке 1, представляет собой симметричную манипуляционную цепь последовательной структуры с кинематическими парами пятого класса в виде шарниров, где основание и конечное звено могут меняться местами для перемещения в другую рабочую зону, используя специальные контактные площадки, размещенные на обслуживаемом объекте.
Модель и кинематическая схема манипуляционного механизма ERA показаны на рисунках 2, 3. Связь основания и конечного звена с остальной кинематической цепью позволяет её ориентировать по рысканью, тангажу и крену соответственно.
Для применения метода МКПС в решении ОЗК необходимо построить в прямоугольной декартовой системе координат x0y0z0 нулевого звена математическую модель ММ, показанную в общем виде на рис. 4.
Рис. 1. Семистепенной манипуляционный робот ERA
Рис. 2. Модель манипулятора ERA
Рис. 3. Кинематическая схема манипулятора ERA
Рис. 4. Иллюстрация векторной математической
модели ММ с n степенями свободы с кинематическими парами пятого класса
Для манипуляционного механизма ERA в прямоугольной декартовой системе координат x0y0z0 нулевого звена построим с помощью векторов модель ММ, кинематическая схема которого показана на рисунке 3. Для определения звеньев ММ введем векторы , направленные вдоль каждого звена и равные по модулю длинам звеньев. Для определения ориентации осей кинематических пар введем единичные векторы
, направленные вдоль осей шарниров кинематических пар. N – характерная точка схвата,
и
– векторы, указывающие текущую ориентацию схвата,
и
– векторы, указывающие заданную ориентацию схвата. Признаки кинематических пар (1 – шарнир, 0 – призма) задаются массивом p(n) в порядке очередности от основания. Конструктивные ограничения в кинематических парах задаются массивом L(2,n). Нижний индекс i =1,...,n, где n = 7 – число звеньев ММ. Построенная таким образом векторная модель манипуляционного механизма ERA показана на рисунке 5.
Рис. 5. Векторная математическая модель манипуляционного механизма ERA
и необходимые массивы: p(n) и L(2,n)
Моделирование испытания по прохождению сингулярных точек манипулятора ERA проводим с помощью разработанного программно-аппаратного комплекса, в состав которого входит программа решения ОЗК по методу МКПС, пакет Matlab/Simulink, программа визуализации ММ, программа выводов необходимых графиков и параметров движения ММ для анализа прохождения через сингулярные точки, рукоятка 3D Connexion Space Navigator и плата STM32F407G-DISC1 с микроконтроллером STM32F407VGT6 для определения времени решения ОЗК [16].
Моделирование испытания метода на прохождение через сингулярные точки манипуляционного робота ERA. Из сингулярных точек манипуляционного робота ERA отобраны три сингулярные точки с разным проявлением сингулярности, которые полностью отображают характерные виды их проявления. Для подтверждения работоспособности метода МКПС проведено моделирование прохождения через эти точки модели манипуляционного робота ERA. Рассмотрим прохождение через эти точки по порядку.
Сингулярная точка №1. При движении конечного звена вдоль оси x0 до построения локтевых звеньев в линию, ММ попадает в первую сингулярную точку, показанную на рисунке 6. Для прохождения через эту точку в методе предусмотрено изменение конфигурации манипулятора путем изменения обобщенных координат манипулятора на малые величины (δq > εзад) с заранее настроенными знаками для каждого шарнира. Это обеспечивает центральному шарниру, соединяющему локтевые звенья, в автоматическом режиме всегда сгибаться в нужную сторону.
Рис. 6. Движение локтевых звеньев ММ через точку сингулярности:
а) движение вверх вдоль оси x0, б) точка сингулярности,
в) движение вниз вдоль оси x0.
Обобщенные координаты при прохождении первой сингулярной точки без обхода и с обходом сингулярности представлены на рисунках 7 и 8 соответственно в виде графиков.
Рис. 7. Графики обобщенных координат при прохождении первой точки без обхода
сингулярности
Рис. 8. Графики обобщенных координат при прохождении первой точки с обходом сингулярности
На рисунке 8 графики изменения обобщенных координат θ3, θ4, θ5, в отличие от графиков показанных на рисунке 7, находятся каждый в своем квадранте, что подтверждает движение локтевых звеньев в нужном направлении.
Сингулярная точка №2. При движении запястья снизу вверх параллельно оси y0 ММ попадает во вторую сингулярную точку, показанную на рисунке 9, в так называемый карданный замок. Прохождение через эту точку обеспечивается ограничением обобщенных координат q5 < 80º, q6 < 80º или q1 = Сonst, что предотвращает проявление сингулярной точки в шарнирах в виде быстрого вращения локтевых звеньев.
Рис. 9. Движение запястья ММ через точку сингулярности:
а) движение запястья параллельно оси y0 до сингулярной точки,
б) точка сингулярности, в) движение запястья параллельно оси y0 после сингулярной точки
Обобщенные координаты при прохождении второй сингулярной точки без обхода и с обходом сингулярности представлены на рисунках 10 и 11 соответственно в виде графиков.
Большие значения обобщенных координат на рисунке 10 означают проявление сингулярности вращением группы звеньев и суммированием углов, полученных при вращении.
Рис. 10. Графики обобщенных координат при прохождении второй точки без обхода сингулярности
Рис. 11. Графики обобщенных координат при прохождении второй точки с обходом сингулярности
На рисунке 11 видим плавное изменение графиков обобщенных координат, которое соответствует и плавному движению звеньев ММ.
Сингулярная точка №3. При движении плеча ММ через окрестность точки на вертикальной линии (ось x0) или вокруг неё, показанного на рисунке 12, звенья ММ 3 и 4 начинают синфазное движение вращения при движении схвата по окружности. Так проявляет себя третья сингулярная точка.
Обобщенные координаты при прохождении третьей сингулярной точки без обхода и с обходом сингулярности представлены на рисунках 13 и 14 соответственно в виде графиков.
Рис. 12. Движение плеча ММ через точку сингулярности:
а) движение плеча назад, б) точка сингулярности, в) движение плеча вперед, г) движение плеча
по окружности
Рис. 13. Графики обобщенных координат при прохождении третьей точки без обхода сингулярности
На рисунке 13 линейное увеличение углов в противоположных шарнирах ММ происходит в результате вращения группы звеньев вокруг оси, проходящей в окрестности третьей сингулярной точки.
Прохождение через третью точку сингулярности обеспечивается ограничением обобщенных координат q1 или q7 путем задания конкретного значения. Так как это ограничение препятствует движению звеньев в зонах, где нет точек сингулярности, то имеет место временная фиксация указанных значений обобщенных координат при прохождении плеча через третью точку сингулярности. При использовании метода в режиме непосредственного управления можно легко организовать динамическую фиксацию обобщенных координат при прохождении сингулярных точек и исключить их проявление в виде быстрых вращательных движений группы звеньев ММ, что и показано на рисунке 14.
Численные испытания метода проводились с помощью программного аппаратного комплекса (ПАК), включающего метод МКПС, путем прохождения через сингулярные точки, показанные на рисунках 6, 9 и 12 с выводом графиков обобщенных координат, показанных на рисунках 7, 8, 10, 11, 13, 14 и визуализацией движения звеньев ММ, показанных в [16]. Анализ графиков изменения обобщенных координат и просмотр визуализации движения звеньев манипуляционного механизма ERA подтверждают работоспособность метода при прохождении сингулярных точек.
Данное испытание показало, что в алгоритме метода предусмотрено прохождение сингулярных точек различного проявления. На примере манипуляционного робота ERA показана визуализация прохождения сингулярных точек с механизмом обхода и без него. В качестве механизма обхода сингулярности в методе используются следующие внешние параметры метода: малые приращения обобщенных координат с учетом знака, ограничения обобщенных координат в виде интервала значений или конкретного значения.
Рис. 14. Графики обобщенных координат при прохождении третьей точки с обходом сингулярности
В частности, для манипуляционного робота ERA при прохождении первой сингулярной точки (Elbow Reach Singularity), обобщенной координате центрального шарнира задается знак минус перед малым приращением δq, что всегда соответствует повороту колена в нужную сторону. Для прохождения через точки, аналогичные второй и третьей (Wrist Gimbal Lock and Shoulder Singularities), требуются ограничения части обобщенных координат в виде задания интервала значений или задания конкретных значений. Используемый механизм обхода сингулярности можно обеспечить на программном или программно-аппаратном уровне, не изменяя алгоритма метода при наличии дополнительных кнопок управления режимами изменения обобщённых координат звеньев манипулятора, например, фиксацией обобщённой координаты, или ограничением с помощью введения интервала значений. Можно учитывать существующий в алгоритме [15] мониторинг сингулярных точек, заключающийся в выполнении условия , приведенного выше, в процессе решения ОЗК и автоматически включать и выключать механизм их обхода.
Выводы. Метод успешно прошел испытания на прохождение через сингулярные точки манипуляционного робота ERA. Моделированием подтверждена работоспособность используемых в методе механизмов прохождения сингулярных точек различного проявления. Определены возможности реализации механизмов обхода сингулярных точек с учетом существующего в алгоритме мониторинга сингулярных точек в процессе итерационного решения ОЗК. Все параметры для предотвращения различных влияний на движение звеньев при прохождении сингулярных точек являются внешними задающими параметрами для метода и поэтому при его применении могут быть включены в разработку системы управления на программно-аппаратном уровне или автоматически на программном уровне с учетом существующего мониторинга.
1. Aristidou A., Lasenby J. FABRIK: A fast, iterative solver for the Inverse Kinematics problem. Graphical Models. 2011. Vol. 73. Iss. 5. Pp. 243–260. doi: 10.1016/j.gmod.2011.05.003
2. Aristidou A., Lasenby J. Inverse Kinematics: a review of existing techniques and introduction of a new fast iterative solver. Cambridge University Engineering Department (CUEDF-INFENG, TR-632). 2009. 60 p.
3. Canutescu A.A., Dunbrack Jr. R.L. Cyclic coordinate descent: A robotics algorithm for protein loop closure. Protein Science. 2003. Vol. 12, Iss. 5. Pp. 963–972. doi: 10.1110/ps.0242703
4. Wang L.-C.T., Chen C.C. A combined optimization method for solving the inverse kinematics problems of mechanical manipulators. IEEE Transactions on Robotics and Automation. 1991. Vol. 7 (4). Pp. 489–499. doi: 10.1109/70.86079
5. Welman C. Inverse kinematics and geometric constraints for articulated figure manipulation. Master Dissertation, Simon Fraser University, Department of Computer Science, 1993. 77 p.
6. Balestrino A., De Maria G., Sciavicco L. Robust control of robotic manipulators // IFAC Proceedings Series. 1985. Pp. 2435–2440.
7. Wolovich W.A., Elliott H. A computational technique for inverse kinematics. Proceedings of the IEEE Conference on Decision and Control. 1984, Pp. 1359–1363.
8. Orin D., Schrader W. Efficient computation of the jacobian for robot manipulators. The International Journal of Robotics Research. 1984. Vol. 3, Iss. 4. Pp. 66–75. doi: 10.1177/027836498400300404
9. Wampler C. Manipulator inverse kinematic solutions based on vector formulations and damped least-squares methods. IEEE Transactions on Systems, Man and Cybernetics. 1986. Vol. 16, Iss. 1, Pp. 93–101. doi: 10.1109/TSMC.1986.289285
10. Baillieul J. Kinematic programming alternatives for redundant manipulators. Proceedings - IEEE International Conference on Robotics and Automation. 1985. 1087234. Pp. 722–728. doi: 10.1109/ROBOT.1985.1087234
11. Buss S. Selectively damped least squares for inverse kinematics. Journal of Graphics Tools. 2005. Vol. 10(3). Pp. 37–49. doi: 10.1080/2151237X.2005.10129202
12. Brown J., Latombe J.-C., Montgomery K. Realtime knot-tying simulation. The Visual Computer: International J. of Computer Graphics. 2004. Vol. 20 (2). Pp. 165–179.
13. Müller-Cajar R., Mukundan R. Triangulation: A new algorithm for inverse kinematics. Proceedings of Image and Vision Computing. 2007, December, Hamilton, New Zealand. Hamilton, 2007, Pp. 181–186. Режим доступа: http://ir.canterbury.ac.nz/handle/10092/743, Дата обращения 01.02.2016.
14. Данилов А.В. Кропотов А.Н., Трифонов О.В. Общий подход к решению обратной задачи кинематики для манипулятора последовательной структуры с помощью конечного поворота и смещения // Препринты ИПМ им. М. В. Келдыша. 2018. № 81. [Электронный ресурс] Режим доступа: http://library.keldysh.ru/preprint.asp?id=2018-81 (дата обращения: 20.02.2019)
15. Данилов А.В., Кропотов А.Н., Трифонов О.В. Применение метода конечного поворота и смещения для манипулятора последовательной структуры с кинематическими парами пятого класса // Препринты ИПМ им. Келдыша. 2018. № 107. [Электронный ресурс] Режим доступа: http://library.keldysh.ru/preprint.asp?id=2018-107 (дата обращения: 20.02.2019)
16. Данилов А.В. Видеофайлы. Визуализация прохождения сингулярных точек манипулятора ERA [Электронный ресурс]. Режим доступа: www.sasha-dan.ru/era.html (дата обращения: 20.02.2019)
