НАУЧНОЕ ИЗДАНИЕ МЕТУ ИМ. Н. Э. БАУМАНА
НАУКА и ОБРАЗОВАНИЕ
Эл № ФС77 - 48211. Государственная регистрация №0421200025. КБМ 1994-0408
электронный научно-технический журнал
Координатная связь медицинского робота - манипулятора
# 12, декабрь 2012
DOI: 10.7463/0113.0520630
Банин Е.П., Барышева О.П., Батанов А.Ф., Богданова Ю.В.,
Гуськов А.М., Козубняк С.А., Нарайкин О.С., Пуценко А.А.
УДК 531, 53.072, 62-5, 617-089, 617-7
Россия, МГТУ им. Н.Э. Баумана evg.banin@gmail.com olgat@ecoinvent.ru sktb pr@mail.ru bogdanova.bmstu@gmail.com gouskov am@mail.ru sark@hexa.ru naraikin os@nrcki.ru al exey.putsenko@gmail. com
Введение
Одной из важнейших задач робототехники является задача обеспечения точного позиционирования конечной точки робота-манипулятора. При проведении операций с применением роботов - манипуляторов управление осуществляется исходя из силовых воздействий, действующих на инструмент. Данные усилия, возникающие в оперируемой ткани, в некоторых случаях являются непрогнозируемыми, и могут вызывать перемещения инструмента в направлениях, перпендикулярных направлению приложения рабочей силы. Это явление называется координатной связью.
Не учтенные отклонения инструмента от прогнозируемой траектории приводят к необходимости дополнительных управляющих воздействий, которые отрабатываются с некоторой погрешностью и могут приводить к серьезным нарушениям в оперируемой ткани. Поэтому оценка и учет координатной связи является ответственной задачей. В работе рассматривается несколько конфигураций робота, для которых производится оценка перемещения конечной точки робота-манипулятора под действием нагрузки.
В работе [1], посвященной основным вопросам проектирования роботов подобного типа, не рассматривается задача учета влияния координатной связи на систему управления. Несмотря на то, что вопрос расчета и моделирования роботов с гибкими элементами или жестких роботов - манипуляторов с учетом деформируемости отдельных элементов активно изучается в работах [2, 4], вопрос о локальных свойствах конкретных конструкций требует отдельного рассмотрения в каждом случае. В работе демонстрируется методика определения матрицы податливости в точке приложения рабочих воздействий на инструмент в зависимости от конфигурации робота. Анализ робота - манипулятора проводится методом конечных элементов.
Определение поведения робота-ассистента под действием нагрузки
Для оценки поведения точки приложения усилий под действием нагрузки производится расчет матрицы податливости для четырех различных конфигураций робота-манипулятора.
На рис. 1 изображен общий вид рассматриваемого робота-ассистента.
5
1 - зажим инструмента с установленным инструментом; 2 - блок приводов ориентации; 3
- предплечье; 4 - плечо; 5 -привод плеча; 6 - опорно-поворотное устройство.
Рисунок 1 - Робот - манипулятор
Данный робот имеет 7 степеней свободы и состоит из 6 звеньев. Первое (№ 1, Рис. 1) звено соответствует установленному инструменту. Первое звено моделируется упрощенно. Исследуемые конфигурации робота - манипулятора приведены на Рис. 2.
а) Первая конфигурация робота б) Вторая конфигурация робота
в) Третья конфигурация робота г) Четвертая конфигурация робота
Рисунок 2 - Конфигурации робота - манипулятора
Расчет полей перемещений
При расчете полей перемещений к каждому звену прикладывается нагрузка, соответствующая весу звена. Система с приложенными нагрузками показана на Рис. 3.
Рисунок 3 - Схема нагружения робота - манипулятора
Нагрузки, вызванные силами веса звеньев робота, приложены в центре масс соответствующего звена (А-Е, Рис. 3). Нагрузка от веса инструмента приложена в точке Б (Рис. 3). Вес инструмента - 10 Н.
При расчете полей перемещений робота - манипулятора под действием только силы тяжести, сила, действующая на инструмент, не учитывается.
Разбиение на конечные элементы для данной конфигурации робота-манипулятора представлено на Рис. 4.
Рисунок 4 - Разбиение на конечные элементы модели робота - манипулятора Расчет матрицы податливости
Рассматривается получение матрицы податливости. Расчет производиться для 4-х конфигураций робота - манипулятора.
При получении матрицы податливости рассматривается следующее представление:
Я = БО Є»6
Б
Й ■ о=|М, ,
и = ЛЕ + БМ Є»3
0 = ВГ F + CM Є»3
Л Б Вг С
Бг
(1)
где О - вектор нагрузок (обобщенные силы): Е - сосредоточенная сила, М
6x1
3x1
3x1
сосредоточенный момент; я - вектор, характеризующий перемещения (обобщенные
координаты): и - вектор перемещений; 0 - вектор малого поворота; Б - матрица
3x1 3x1
податливости размерностью 6 х6, состоящая из симметричных блоков А, С и блока В размерностью 3x3. Матрица Б симметричная и определенно положительная. Все матричные вычисления проводятся в абсолютном декартовом базисе {х, у, г] (см. рисунок 4).
В зависимости от конфигурации робота-ассистента, которая определяется углами
поворота в узлах робота • •}, матрица податливости Б будет различной.
Вычисление матрицы податливости производится по следующей схеме:
(1) К выбранной конфигурации робота прикладываются по очереди шесть компонент сил в точке А в направлении соответствующих осей (Рис. 5):
0^ е ., ] = 1,6, где е. - эвклидовы единичные векторы
Рисунок 5 - Положение системы координат конечной тоски робота - манипулятора
Точка А - точка приложения силы при расчете матрицы податливости, х, у, ъ - оси ортогонального базиса, расположенного в точке А.
(2) Вычисляются все шесть компонент вектора перемещений ^ для каждого
случая нагружения.
(3) заполняется соответствующая колонка матрицы податливости
(2)
Данная схема расчета повторяется для следующей модификации системы.
Контроль за корректностью полученных вычислений осуществляется проверкой того, что матрица податливости должна получиться симметричной. В большом числе случаев взаимодействие инструмента с телом происходит в малой пространственной области и сводится только к сосредоточенной силе. В этом случае достаточно определить только блок А в (1) и рассматривать усеченную задачу
и = АЕ (3)
Вычисление матрицы А производится с помощью приложения последовательно трех сил в направлении координатных осей:
'1' 0' 0'
е1 = 0 е 2 1 е 3 0
0 0 1
(4)
А
и
(]')
а
Численное решение задачи методом конечных элементов
Перемещение звеньев робота под действием силы веса для конфигурации представленной на Рис. 2а и схемы нагружения представленной на Рис.3 имеют следующий вид:
Рисунок 6 - Поле абсолютных перемещений звеньев робота - манипулятора под
действием силы веса
Поля перемещений робота имеют следующий вид (Рис. 7 - Рис. 9)
Рисунок 7 - Перемещение по оси Х инструмента робота
Рисунок 8 - Перемещение по оси Y инструмента робота
Рисунок 9 - Перемещение по оси Ъ
Значения перемещений на конце инструмента для конфигурации, изображенной на Рис. 2, а под действием силы собственного веса звеньев и веса инструмента представлены в таблице 1.
Таблица 1 - Перемещения на конце робота - манипулятора для первой конфигурации.
Перемещение Нагрузка - вес звеньев. Перемещение, м Нагрузка - вес звеньев и вес инструмента. Перемещение, м
по оси Х 4.9 • 10-5 -0 6.
по оси Y -6.6 • 10-6 -3.4 • 10-6
по оси Z -0 6. 7.6 • 10-4
Значения перемещений на конце инструмента для конфигурации, изображенной на Рис. 2, б под действием силы собственного веса звеньев и веса инструмента представлены в таблице 2.
Таблица 2 -Перемещения на конце робота - манипулятора для второй конфигурации.
Перемещение Нагрузка - вес звеньев. Перемещение, м Нагрузка - вес звеньев и вес инструмента. Перемещение, м
по оси Х 4.5 • 10-5 7.3 • 10-5
по оси Y -5.0 • 10-4 -6.3 • 10-4
по оси Z 3.7 • 10-5 5.8 • 10-5
Значения перемещений на конце инструмента для конфигурации, изображенной на Рис. 2, в под действием силы собственного веса звеньев и веса инструмента представлены в таблице 3.
Таблица 3 - Перемещения на конце робота - манипулятора для третьей конфигурации.
Перемещение Нагрузка - вес звеньев. Перемещение, м Нагрузка - вес звеньев и вес инструмента. Перемещение, м
по оси Х -6.0 • 10-5 -6.2 • 10-5
по оси Y -7.9 • 10-5 -16.0 • 10-5
по оси Z -5.2 • 10-5 -6.3 • 10-5
Значения перемещений на конце инструмента для конфигурации, изображенной на Рис. 2, г под действием силы собственного веса звеньев и веса инструмента представлены в таблице 4.
Таблица 4 - Перемещения на конце робота - манипулятора для четвертой конфигурации.
Перемещение Нагрузка - вес звеньев. Перемещение, м Нагрузка - вес звеньев и вес инструмента. Перемещение, м
по оси Х 2.4 • 10-5 4.3 • 10-5
по оси Y -3.8 • 10-4 -5.1 • 10-4
по оси Z -6.9 • 10-6 -27.0 • 10-6
Исходя из анализа данных, приведенных в таблицах, можно заключить, что при эксплуатации робота - манипулятора необходимо учитывать перемещения не только в направлении действия силы, но и в остальных направлениях.
В соответствии с проведенными расчетами ниже приводятся матрицы податливости А (3) для каждой из четырех рассматриваемых конфигураций робота -манипулятора.
Конфигурация 1:
А =
3.79 -10-7 3.34-10-7 -1.05 • 10-6
3.34 • 10-7 2.83 -10-5 -4.34 • 10-6
-1.05-10-6 -4.34 -10-7 1.69 • 10-5
Конфигурация 2:
А =
1.70 -10-5 -3.18-10-6 -5.96-10-6
-3.18-10-6 1.62-10-5 -2.37 -10-6
-5.96-10-6 -2.37 -10-6 3.55-10-5
Конфигурация 3:
А =
Конфигурация 4:
А =
4.45 -10-6 -5.85-10-8 2.06 • 10-7
-5.85 •Ю-8 1.08 •Ю-5 1.37-10-6
3.48 •Ю-6 -2.09 -10-6
2.48 •Ю-6
-2.09 •Ю-6 1.6Ы0-5 3.04 •Ю-6
2.06 •Ю-7 1.37-10-6 8.23 • 10-6
2.48 -10-6 3.04 •Ю-6 1.01-10-5
Как видно, матрицы податливости являются симметричными (в пределах допустимой ошибки вычислений), что позволяет утверждать правильность расчета. В качестве примера рассмотрим конфигурацию 3. Пусть единичный вектор сосредоточенной силы ер = г/||г|| , приложенной к инструменту равен
0.4959
0.6393
-0.5877
(5)
Тогда единичный вектор смещения (и = AF) точки приложения силы еи = и/||и|| оказывается равным
еи =
-0.1329
0.9296
-0.3437
(6)
На рисунке 10 показано относительное расположение векторов еи, ер в пространстве
Рисунок 10 - Неколлинеарность векторов силы и перемещения для конфигурации 3.
У словно начало координат помещено в точку приложения силы
Векторы еи, еГ образуют угол
/(и, Г) = агссоБ (еитеГ ) = 0.7516 = 43.0766° (7)
Как видим, в данном случае "несовпадение" направлений силы и перемещения точки приложения силы оказывается существенным, что, конечно, нужно учитывать при выборе рабочей конфигурации
Заключение
По результатам данного исследования можно заключить, что:
- при приложении усилий к инструменту смещение точки приложения усилий неколлинеарно вектору силы;
- в некоторых случаях перемещение точки приложения силы может быть направлено перпендикулярно вектору силы;
- в зависимости от положения звеньев робота, характер смещения точки приложения усилий изменяется.
При учете результатов исследования становится возможным минимизация паразитных отклонений инструмента от требуемой траектории.
Работа выполнена при поддержке Министерства образования и науки РФ в рамках федеральной целевой научно - технической программы «Исследования и разработки по приоритетным направлениям развития научно - технологического комплекса России» на 2007 - 2012 годы, номер контракта 16.523.11.3011.
Список литературы
1. Angeles J. Fundamentals of Robotic Mechanical Systems. Theory, Methods, and Algorithms. 3rd ed. Springer, 2007. 550 p.
2. Gilles B., Bousquet G., Faure F., Pai D.K. Frame-based elastic models // ACM Transaction on Graphics. 2011. Vol. 30, no. 2. Art. no. 15. DOI: 10.1145/1944846.1944855
3. Siciliano B., Khatib O., eds. Springer Handbook of Robotics. Springer, 2008. 1611 p. DOI: 10.1007/978-3-540-30301-5
4. Talbi N. Resolution du contact frottant entre objets deformables en temps reel et avec retour haptique : These. l'Universite d'EVRY VAL-d'ESSONNE, 2008. 168 p. (in French).
SCIENTIFIC PERIODICAL OF THE BAUMAN MSTU
SCIENCE and EDUCATION
EL № FS77 - 48211. №0421200025. ISSN 1994-0408
electronic scientific and technical journal
Coordinate relationship of the medical robot - manipulator
# 12, December 2012 DOI: 10.7463/0113.0520630
Banin E.P., Barysheva O.P., Batanov A.F., Bogdanova Yu.V., Gus’kov A.M., Kozubnyak S.A., Naraikin O.S., Pucenko A.A.
Russia, Bauman Moscow State Technical University
evg.banin@gmail.com olgat@ecoinvent.ru sktb pr@mail.ru bogdanova.bmstu@gmail.com gouskov am@mail.ru sark@hexa.ru naraikin os@nrcki.ru al exey.putsenko@gmail. com
During surgical operations with the use of a robot-manipulator, control actions are managed by force effects in the area of the surgical operation. The constructional design of the robot is chosen according to the technological requirements for implementation of specific movements. It turns out that when a force is applied to the tool, displacement of the force application point can be non-collinear to the force vector. If interaction between a surgical instrument and the operation object can be reduced to a concentrated force, it is necessary to choose a beneficial robot configuration to avoid lateral offset. In this configuration the force vector must be aimed to the proper direction of the robot compliance matrix in the force application point. The proposed calculation method helps to construct a working configuration of the robot with respect to minimization of possible spurious derivation of the instrument from the requested trajectory.
Publications with keywords: instrument positioning, robotic surgery Publications with words: instrument positioning, robotic surgery
References
1) Angeles J. Fundamentals of Robotic Mechanical Systems. Theory, Methods, and Algorithms. 3rd ed. Springer, 2007. 550 p.
2) Gilles B., Bousquet G., Faure F., Pai D.K. Frame-based elastic models. ACM Transaction
on Graphics, 2011, vol. 30, no. 2, art. no. 15. DOI: 10.1145/1944846.1944855
3) Siciliano B., Khatib O., eds. Springer Handbook of Robotics. Springer, 2008. 1611 p.
DOI: 10.1007/978-3-540-30301-5
4) Talbi N. Resolution du contact frottant entre objets deformables en temps reel et avec
retour haptique : These. l'Universite d'EVRY VAL-d'ESSONNE, 2008. 168 p. (in French).