№ 11 2007
621.865.8
ВЛИЯНИЕ ЗАЗОРОВ НА ПРОСТРАНСТВЕННУЮ ПОГРЕШНОСТЬ
ПОЗИЦИОНИРОВАНИЯ МАНИПУЛЯТОРА С ВРАЩАТЕЛЬНЫМИ
КИНЕМАТИЧЕСКИМИ ПАРАМИ
Асп. НАСЕР АЛЛА ЕДИН, канд. техн. наук, доц. А. М. РОМАШКО
Рассматривается влияние зазоров на погрешность позиционирования для телеуправляемого мобильного робота. Разработана геометрическая модель «зазора» во вращательной кинематической паре. Показано, как внешние нагрузки влияют на перемещение элементов вращательной кинематической пары в зазоре. Разработан метод определения погрешности позиционирования рабочего органа манипулятора, возникаюгцей вследствие наличия зазоров во вращательных кинематических парах.
Influence of clearances on an error of positioning for the long-distance mobile robot is examined The geometrical model of "clearance " in a rotational kinematicalpair is developed. If is displayed how external loadings influence migration ofthe rotational kinematical pair elements in the clearance. The method of an error definition at the positioning of the end-effecter of the manipulator, arising due to presence of clearances in rotational kinematical pairs is developed.
В [1] сформулировано понятие погрешности позиционирования для телеуправляемого мобильного робота как величины, характеризующей отклонение положения центра захвата от теоретического положения, рассчитываемого для манипулятора с абсолютно жесткими звеньями и идеальными кинематическими парами. Это отклонение возникает по различным причинам, в частности, на погрешность позиционирования влияют упругие деформации звеньев манипулятора и зазоры в подвижных соединениях звеньев, причем предварительный анализ показал, что их влияние примерно одинаково. В [1] задача рассматривалась в упрощенной постановке с целью приближенной оценки погрешности позиционирования рабочего органа. В известных методах [1, 2] задача обычно рассматривается как плоская, поэтому расчет не позволяет определить пространственные характеристики погрешности позиционирования и, соответственно, реальное положение рабочего органа в пространстве. В [3] предложен метод определения пространственной погрешности позиционирования рабочего органа, возникающей вследствие зазоров в кинематических парах манипулятора. К сожалению, сделанные нами по этому методу расчеты не всегда приводили к положительным результатам.
Ниже приводятся результаты разработанного нами метода определения пространственной погрешности позиционирования рабочего органа, возникающей из-за наличия зазоров во вращательных кинематических парах манипулятора. Влияние зазора на погрешность позиционирования определялось сравнением координат центра рабочего органа (захвата), рассчитанных для идеальной кинематической цепи с координатами этой же точки рассчитанными по предлагаемому методу.
Модель зазора
Обычно в манипуляторах применяются два вида кинематических пар 5-го класса, оставляющих звеньям одну степень свободы в относительном движении: вращательные и поступательные кинематические пары. В реальных вращательных кинематических парах между элементами пары имеется зазор А (рис. 1), который является причиной смещения одного звена относительно другого под действием нагрузки.
№11
2007
В идеальной модели кинематической пары начала систем координат, связанных с двумя смежными звеньями, совпадают между собой и с идеальным центром кинематической пары (рис. 2, а).
Рис, 2. Модели вращательной кинематической пары для геометрического анализа манипулятора; а — идеальная модель вращательной кинематической пары; б — модель вращательной кинематической пары с зазором
В модели кинематической пары, учитывающей зазор, наличие зазора можно рассматривать как введение дополнительных степеней подвижности [4] (рис. 2, б). Преобразование координат при переходе от системы координат, связанной с одним из звеньев, к системе координат, связанной с другим звеном, оказывается более сложным.
Для кинематической пары, в которой величина зазора намного меньше размеров оси и втулки, ось кинематической пары диаметром с/можно заменить отрезком прямой линии. При этом диаметр отверстия втулки О принимается равным 2Д (рис. 3), где Л — это величина зазора между осью и втулкой при их соосном положении в кинематической паре.
- звено 2
Рис. 1. Схема вращательной кинематической пары с зазорами
№11
2007
I ь I
А
2А+Й
Рис. 3. Схематизация зазора в кинематической паре
В шарнирах манипуляторов размеры осей и втулок примерно таковы: ¿/ = (10... 200) мм, при этом I = (2...5)с1, где </ — диаметр оси шарнира, Ь — длина оси шарнира; меньшие значения множителя в выражении для длины осей обычно соответствуют осям большего диаметра. Расчеты показывают, что для таких размеров в шарнирах, выполненных по 11 квалитсту точности при схематизации по рис. 3, ошибка в определении угла поворота оси в зазоре очень мала и не превышает 0,05 %,
Направления относительного смещения элементов вращательной кинематической пары, возникающего вследствие зазоров в паре, совпадают с направлениями реакций в кинематической паре [5]. Поэтому для определения направления смещения необходимо предварительно определить все реакции в кинематической паре (например: кинетостати-ческим методом, графоаналитическим методом). Их можно определить, приведя к центру кинематической пары силы и моменты сил К, Мх, Му, Мг9 действующих на
захвате (рис. 4).
Для манипулятора с незамкнутой кинематической цепью (рис. 4, а) можно привести указанные силовые факторы к центру кинематической пары, например, к точке В, рассматривая уравнения статического равновесия сил в шарнире (рис. 4, б):
-~Р~ - п ~Р~
1 Р и МО* Л/ '
где
" г* ' 1 0 0 0 0 0" Г F 1 ш
Г,, 0 1 0 0 0 0 р 1 Му
Р» = - Г* ' В ми ~ 0 0 0 'К,: 1 Н Му 0 1 0 0 0 0 • р = ' 1 м 1 Мж Мш
Мпу "л* 0 0 1 0
Мп: ~НМу НШ 0 0 0 1
№11 2007
Здесь Нш, НМу, НМу — координаты точки М в системе координат с началом в точке £>.
Для манипулятора с замкнутой кинематической цепью (рис. 4, б) считаем, что в кинематической паре Е действует только сила, направленная вдоль прямой, проходящей через точки Е и ТУ, так как гидроцилиндр соединяется с конструкцией шаровыми кинематическими парами.
Для определения силы , действующей в гидроцилиндре, составляется уравнение моментов относительно оси, проходящей через шарнир В. Так как эта ось параллельна оси X, то момент относительно оси Хв шарнире будет равен нулю
+ РМуИш + ЕшНЫу + ЕСНС = 0; Рс = ~ЕИуНМ2-РшНщ)1 Нс .
МВг
б)
Рис. 4. Схема к приведению сил: а — манипулятор с незамкнутой кинематической цепью; б — манипулятор с
замкнутой кинематической цепью
Для приведения сил и моментов сил к шарниру В используются уравнения статического равновесия (проекции сил на осьХне рассматриваем, так как ось Л" совпадает с осью шарнира и соответствующие силы не влияют на выбор зазора Л)
№11
2007
%FoyD= 0; FDv = Fc;>. - Fu> ;
£M)vD - 0; M/5V + - FHxHhfz + - 0
MDv^-MXfv + FUxHAt-F,tHMx;
F H ± F H
1 Six11 Mv ^ 1 My Air '
Полученные значения сил и моментов сил в шарнире используются для анализа направлений перемещения оси шарнира во втулке. Перемещение звена, при наличии зазора во вращательной кинематической паре, характеризуется уже не одной, а несколькими обобщенными координатами [6].
Для определения реакций в опорах оси шарнира анализируем силы и моменты сил, действующие на ось в двух плоскостях (рис. 5). Уравнения статического равновесия оси имеют вид
1
О —
- О
О —
- 0
х
" F»< 1
MAX
fD:
F,y
MDy Fvz
L fby _
Решая эту систему уравнений, получаем значения реакций в опорах А и В.
Направления смещения элементов кинематической пары в зазоре определяются углами аА, ав (рис. 5) ^ р
а в = arctg
в.
а
arctg
Реакция PAi влияет только на смещение оси шарнира вдоль оси X ив данной модели, это смещение не рассматриваем.
В соответствии с рис. 6 можно записать выражения для перемещений оси шарнира и ее концов Л' и В'
L
zA. - Д sin аА, уА. = Д cos аА, хА. = — ;
zB. = Asinae ув. = Acosa^, хв* = -
L
OlA ~ [¿/2 0 0 1] >АА' = [0 Дcosa/t Asina
OtB = [~L/2 0 0 1], ВВ' = [О Acosae Asina
№ 11
2007
0,А' = 0,А + АА', О,В' = О,В + ВВ'
Т7Т7
Л
[X
Плоскость КОЪ
ПлоскостьХОГ
В
Бх
*Вж
Ь"Ах / А Ыь/ .ЯПу ■У В
/ /
*Ъх
Т7?77
Га
Рис. 5. Расчетная схема для определения реакций во вращательной кинематической паре
Положение точки Ог (начала системы координат, связанной со звеном 2) определяет-
ся вектором 0,0,
Хл.+Хв. УА.+УВ. 2а,+2в,
1
, а преобразование координат при
2 2 2
параллельном переносе исходной системы координат в точку 02 реализуется с помощью матрицы преобразования
хА' + хВ'
Т =
10 0-0 10-
0 0 1-
0 0 0
уА' + уВ' 2
гА' + гВ'
Далее, для перехода к системе координат, связанной с осью шарнира, определяем углы у, р и матрицы соответствующих преобразований поворота. Поворот на угол у осуществляется относительно оси г : у = шЩуА /В . Поворот на угол р относительно оси У:
Ь
гА'-гВ'
Р - ап^---. Соответствующие матрицы преобразований поворота имеют вид
№11
2007
Плоскость X1 ОiYi
'Звено
Плоскость XiOjZj
Рис. 6, Расчетная схема для перемещений во вращательной кинематической паре с учетом зазоров
Т.
cosy sin у О О
-sin у cosy О О
О 0 10
0 0 0 1
Г„
cos 3 0
о
sin (3 О
-sinJ3 0 О о
cosp О
0
Для окончательного перехода к системе координат, связанной со звеном 2, необходимо выполнить преобразование поворота соответствующее обобщенной координате . Матрица преобразования поворота имеет вид
0
Т =
</i
COSC/j
■sin
о
0
sin <у, cos 0
Таким образом, при повороте звена 2 на угол соответствующий обобщенной коорди-нате без учета зазора, функция положения точки Мопределяется выражением (рис. 6): ОхМ - Т~]О^М.
С учетом зазора выражение для функции положения имеет вид
Отклонение фактического (с учетом зазора) положения точки Мот идеального (без зазоров) определяется вектором погрешности 8 = (ОхМ)' — ОхМ . В однородных координатах 5= [8х 5у Ъг 1] .
Проверку правильности метода расчета проводили, задавая силы и моменты сил, действующие на рабочий орган, такими, чтобы смещение оси в шарнире было очевидным и в определенном направлении. Расчеты проводили для реального манипулятора. Кинематическая схема шарнира с соответствующими положениями оси шарнира показана на рис. 7. Результаты расчета приведены в таблице.
По предлагаемому методу рассчитывалось влияние зазоров на погрешность позиционирования рабочего органа манипулятора мобильного робота грузоподъемностью 500 кг и вылетом 8 м (рис. 4, б). Максимальное отклонение положения центра захвата от
№ 11
2007
идеального теоретического положения при расчете с учетом зазоров составляет около 50 мм. Конкретные значения отклонения положения зависят от нагрузки на рабочем органе и от конфигурации манипулятора.
эвено 1
Рис. 7. Схемы перемещения оси в шарнире с зазором.
Таблица
Расчетные положения оси шарнира Вектор погрешности
а,, град а„,град <7.>град рисунок 6 = [&с 5у 6г]Г, [мм]
0 0 0 8 = [0 0,2 0]г
90 90 0 7,6 5 = [0 0 0,21г
0 0 45 7;б 5 = [0 0,141 —0,141]г
90 -90 0 7, г 8 = [0 0 0]г, (р = 0,057°)
180 0 0 7, д 5 = [8 -0 О]7
СПИСОК ЛИТЕРАТУРЫ
1. Н а с е р А. Е. Оценка погрешности позиционирования рабочего органа манипулятора тяжелого мобильного робота // Известия ТулГУ, Подъемно-транспортные машины и оборудование. — Вып. 7.--■ 2006. — 297 с.
2. Б р у е в и ч Н. Г. Современное состояние и задачи теории точности // Известия АН СССР. ОТН. —1946. — № 8.
3. Ш и с м а н В. Е. Точность роботов и робототехиических систем. — Харьков: Вища школа, 1988. — 153 с.
4. К о б р и н с к и й А. А., К о б р и и с к и й А. Е. Маиипуляционные системы роботов; основы устройства, элементы теории. — М,: Наука. Главная редакция физико-математической литературы, 1985. — 344 с.
5. К р а с к о в с к и й Е. Я, Д р у ж и н и н Ю. А., Ф и л а т о в а Е. М. Расчет и конструирование механизмов приборов и вычислительных систем. — М,: Высшая школа, 1991. — 480 с.
6. Зенкевич С. Л., Ю щ емко А. С, Основы управления манипуляционными роботами: Учебник для
вузов. — М.: Изд-во МГТУ им. Н. Э. Баумана, 2004. — 480 с.