Другие журналы

научное издание МГТУ им. Н.Э. Баумана

НАУКА и ОБРАЗОВАНИЕ

Издатель ФГБОУ ВПО "МГТУ им. Н.Э. Баумана". Эл № ФС 77 - 48211.  ISSN 1994-0408

Координатная связь медицинского робота - манипулятора

# 12, декабрь 2012
DOI: 10.7463/0113.0520630
Файл статьи: Гуськов_2_P.pdf (542.00Кб)
авторы: Банин Е. П., Барышева О. П., Батанов А. Ф., Богданова Ю. В., Гуськов А. М., Козубняк С. А., Нарайкин О. С., Пуценко А. А.

УДК 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

alexey.putsenko@gmail.com

 

            Введение

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

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

            В работе [1], посвященной основным вопросам проектирования роботов подобного типа, не рассматривается задача учета влияния координатной связи на систему управления. Несмотря на то, что вопрос расчета и моделирования роботов с гибкими элементами или жестких роботов – манипуляторов с учетом деформируемости отдельных элементов активно изучается в работах [2, 4], вопрос о локальных свойствах конкретных конструкций требует отдельного рассмотрения в каждом случае. В работе демонстрируется методика определения матрицы податливости в точке приложения рабочих воздействий на инструмент в зависимости от конфигурации робота. Анализ робота – манипулятора проводится методом конечных элементов.

 

Определение поведения робота-ассистента под действием нагрузки

Для оценки поведения точки приложения усилий под действием нагрузки производится расчет матрицы податливости для четырех различных конфигураций робота-манипулятора.

            На рис. 1 изображен общий вид рассматриваемого робота-ассистента.

Macintosh HD:Users:alexeyputsenko:Desktop:Манипулятор (пронумеровано).png

1 – зажим инструмента с установленным инструментом; 2 – блок приводов ориентации; 3 – предплечье; 4 – плечо; 5 –привод плеча; 6 – опорно-поворотное устройство.

Рисунок 1 – Робот – манипулятор

            Данный робот имеет 7 степеней свободы и состоит из 6 звеньев. Первое (№ 1, Рис. 1) звено соответствует установленному инструменту. Первое звено моделируется упрощенно. Исследуемые конфигурации робота – манипулятора приведены на Рис. 2.

Macintosh HD:Users:alexeyputsenko:Downloads:Расчетные конфигурации:Вар_1.png

Macintosh HD:Users:alexeyputsenko:Downloads:Расчетные конфигурации:Вар_2.png

а) Первая конфигурация робота

б) Вторая конфигурация робота

Macintosh HD:Users:alexeyputsenko:Downloads:Расчетные конфигурации:Вар_3.png

Macintosh HD:Users:alexeyputsenko:Downloads:Расчетные конфигурации:Вар_4.png

в) Третья конфигурация робота

г) Четвертая конфигурация робота

Рисунок 2 – Конфигурации робота – манипулятора

Расчет полей перемещений

При расчете полей перемещений к каждому звену прикладывается нагрузка, соответствующая весу звена. Система с приложенными нагрузками показана на Рис. 3.

 

Macintosh HD:Users:alexeyputsenko:Downloads:Иллюстрации-1:Вариант 1:Load.png

Рисунок 3 – Схема нагружения робота – манипулятора

            Нагрузки, вызванные силами веса звеньев робота, приложены в центре масс соответствующего звена (A-E, Рис. 3). Нагрузка от веса инструмента приложена в точке F (Рис. 3). Вес инструмента – 10 Н.

При расчете полей перемещений робота – манипулятора под действием только силы тяжести, сила, действующая на инструмент, не учитывается.

            Разбиение на конечные элементы для данной конфигурации робота-манипулятора представлено на Рис. 4.

Macintosh HD:Users:alexeyputsenko:Downloads:Иллюстрации-1:Вариант 1:Сетка.png

Рисунок 4 – Разбиение на конечные элементы модели робота – манипулятора

Расчет матрицы податливости

Рассматривается получение матрицы податливости. Расчет производиться  для 4-х конфигураций робота – манипулятора.

При получении матрицы податливости рассматривается следующее представление:

                        

где  – вектор нагрузок (обобщенные силы): - сосредоточенная сила,  - сосредоточенный момент;  – вектор, характеризующий перемещения (обобщенные координаты):  - вектор перемещений;  - вектор малого поворота;  - матрица податливости размерностью , состоящая из симметричных блоков  и блока  размерностью . Матрица  симметричная и определенно положительная. Все матричные вычисления проводятся в абсолютном декартовом базисе   (см. рисунок 4).

В зависимости от конфигурации робота-ассистента, которая определяется углами поворота в узлах робота , матрица податливости  будет различной.

Вычисление матрицы податливости производится по следующей схеме:

(1)  К выбранной конфигурации робота прикладываются по очереди шесть компонент сил в точке А в направлении соответствующих осей (Рис. 5): , где  – эвклидовы единичные векторы

Macintosh HD:Users:alexeyputsenko:Desktop:Ил_едсилы.png

Рисунок 5 – Положение системы координат конечной тоски робота – манипулятора

            Точка А – точка приложения силы при расчете матрицы податливости, x, y, z – оси ортогонального базиса, расположенного в точке А.

(2)  Вычисляются все шесть компонент вектора перемещений  для каждого случая нагружения.

(3)  заполняется соответствующая колонка матрицы податливости

                                                         

            Данная схема расчета повторяется для следующей модификации системы.

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

                                                             

Вычисление матрицы  производится с помощью приложения последовательно трех сил в направлении координатных осей:

                       

Численное решение задачи методом конечных элементов

Перемещение звеньев робота под действием силы веса для конфигурации представленной на Рис. 2а и схемы нагружения представленной на Рис.3 имеют следующий вид:

Macintosh HD:Users:alexeyputsenko:Downloads:Иллюстрации-1:Вариант 1:СВ.png

Рисунок 6 – Поле абсолютных перемещений звеньев робота – манипулятора под действием силы веса

            Поля перемещений робота имеют следующий вид (Рис. 7 - Рис. 9)

Macintosh HD:Users:alexeyputsenko:Downloads:Иллюстрации-1:Вариант 1:СВ(X).png

Рисунок 7 – Перемещение по оси Х инструмента робота

Macintosh HD:Users:alexeyputsenko:Downloads:Иллюстрации-1:Вариант 1:СВ(Y).png

Рисунок 8  – Перемещение по оси Y инструмента робота

Macintosh HD:Users:alexeyputsenko:Downloads:Иллюстрации-1:Вариант 1:СВ(Z).png

Рисунок 9  – Перемещение по оси Z

            Значения перемещений на конце инструмента для конфигурации, изображенной на Рис. 2, а под действием силы собственного веса звеньев и веса инструмента представлены в таблице 1.

Таблица 1 – Перемещения на конце робота – манипулятора для первой конфигурации.

Перемещение

Нагрузка – вес звеньев. Перемещение, м

Нагрузка – вес звеньев и вес инструмента.

Перемещение, м

по оси Х

4.910-5

6.110-5

по оси Y

-6.610-6

-3.410-6

по оси Z

6.110-4

7.610-4

            Значения перемещений на конце инструмента для конфигурации, изображенной на Рис. 2, б под действием силы собственного веса звеньев и веса инструмента представлены в таблице 2.

 

Таблица 2 –Перемещения на конце робота – манипулятора для второй конфигурации.

Перемещение

Нагрузка – вес звеньев. Перемещение, м

Нагрузка – вес звеньев и вес инструмента.

Перемещение, м

по оси Х

4.510-5

7.310-5

по оси Y

-5.010-4

-6.310-4

по оси Z

3.710-5

5.810-5

            Значения перемещений на конце инструмента для конфигурации, изображенной на Рис. 2, в под действием силы собственного веса звеньев и веса инструмента представлены в таблице 3.

Таблица 3 – Перемещения на конце робота – манипулятора для третьей конфигурации.

Перемещение

Нагрузка – вес звеньев. Перемещение, м

Нагрузка – вес звеньев и вес инструмента.

Перемещение, м

по оси Х

-6.010-5

-6.210-5

по оси Y

-7.910-5

-16.010-5

по оси Z

-5.210-5

-6.310-5

            Значения перемещений на конце инструмента для конфигурации, изображенной на Рис. 2, г под действием силы собственного веса звеньев и веса инструмента представлены в таблице 4.

Таблица 4 – Перемещения на конце робота – манипулятора для четвертой конфигурации.

Перемещение

Нагрузка – вес звеньев. Перемещение, м

Нагрузка – вес звеньев и вес инструмента.

Перемещение, м

по оси Х

2.410-5

4.310-5

по оси Y

-3.810-4

-5.110-4

по оси Z

-6.910-6

-27.010-6

 

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

            В соответствии с проведенными расчетами ниже приводятся матрицы податливости   для каждой из четырех рассматриваемых конфигураций робота – манипулятора.

            Конфигурация 1:

            Конфигурация 2:

            Конфигурация 3:

            Конфигурация 4:

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

                                                

Тогда единичный вектор смещения  точки приложения силы  оказывается равным

                                                

На рисунке 10 показано относительное расположение векторов  в пространстве

Рисунок 10 – Неколлинеарность векторов силы и перемещения для конфигурации 3. Условно начало координат помещено в точку приложения силы

Векторы  образуют угол

                    

Как видим, в данном случае "несовпадение" направлений силы и перемещения точки приложения силы оказывается существенным, что, конечно, нужно учитывать при выборе рабочей конфигурации

            Заключение

            По результатам данного исследования можно заключить, что:

-    при приложении усилий к инструменту смещение точки приложения усилий неколлинеарно вектору силы;

-    в некоторых случаях перемещение точки приложения силы может быть направлено перпендикулярно вектору силы;

-    в зависимости от положения звеньев робота, характер смещения точки приложения усилий изменяется.

            При учете результатов исследования становится возможным минимизация паразитных отклонений инструмента от требуемой траектории.

Работа выполнена при поддержке Министерства образования и науки РФ в рамках федеральной целевой научно - технической программы «Исследования и разработки по приоритетным направлениям развития научно – технологического комплекса России» на 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. Résolution du contact frottant entre objets déformables en temps réel et avec retour haptique : Thèse. l'Université d'EVRY VAL-d'ESSONNE, 2008. 168 p. (in French).


Тематические рубрики:
Поделиться:
 
ПОИСК
 
elibrary crossref ulrichsweb neicon rusycon
 
ЮБИЛЕИ
ФОТОРЕПОРТАЖИ
 
СОБЫТИЯ
 
НОВОСТНАЯ ЛЕНТА



Авторы
Пресс-релизы
Библиотека
Конференции
Выставки
О проекте
Rambler's Top100
Телефон: +7 (915) 336-07-65 (строго: среда; пятница c 11-00 до 17-00)
  RSS
© 2003-2024 «Наука и образование»
Перепечатка материалов журнала без согласования с редакцией запрещена
 Тел.: +7 (915) 336-07-65 (строго: среда; пятница c 11-00 до 17-00)