Определение пространственного положения рабочего органа

УПРАВЛЕНИЕ, ВЫЧИСЛИТЕЛЬНАЯ ТЕХНИКА И ИНФОРМАЦИОННЫЕ ТЕХНОЛОГИИ

УДК 681.3

ОПРЕДЕЛЕНИЕ ПРОСТРАНСТВЕННОГО ПОЛОЖЕНИЯ

РАБОЧЕГО ОРГАНА

С. А. Будков, Е.В. Ларкин

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

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

Мобильные манипуляционные роботы в настоящее время широко применяются в промышленности, экологии, военном деле и других отраслях [1, 2]. Особенностью мобильных роботов является то, что их манипулятор размещен на подвижном подрессоренном основании, которое может перемещаться в пространстве относительно движителей во время выполнения технологических операций. С учетом того, что с помощью системы очувствления робота положение манипулятора может быть измерено относительно подвижной платформы, а объект манипуляции, как правило, располагается на поверхности Земли, возникает проблема определения Земных координат объекта с использованием информации, получаемой от бортовой сенсорной системы.

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

197

крепления подвесок. Расстояние от центра масс до правого и левого продольных рядов расположения подвесок равно Ьу . Опоры перенумерованы

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

Робот и объект труда располагаются в Земной системе координат хОуі, относительно которой определяется расположение связанной система XОу і, у которой [4]:

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

ось О і лежит в вертикальной продольной плоскости симметрии цели, перпендикулярна горизонтальной плоскости симметрии и направлена вверх;

ось О'у' ортогональна вертикальной продольной плоскости симметрии и дополняет систему до правой системы координат.

Координаты (х'к, Ук, 2'к) точки К из системы XОУі в координаты (хк, Ук, 2К) системы хОуі пересчитываются по зависимости [5]:

Ґ х Л хк ( хк 1 ( \ хр

УК = А Ук + ур

У 2к У 2 к у 2Р У

где Хр, yp, Zp - Земные координаты центра масс робота; А - матрица поворотов.

На платформе робота в продольной плоскости симметрии установлен манипулятор на расстоянии Lm от центра масс. Манипулятор расположен в плоскости x"O"z" таким образом, что ось O"z" параллельна оси Oz , а ось 0"х" поворачивается относительно оси O"z" на угол у. В плоскости манипулятора первое звено длиной а поворачивается на угол J, а второе звено длиной b поворачивается относительно первого на угол р. Вращение осуществляется с помощью соответствующих приводов, не показанных на рис. 1.

Поворот плоскости x"O"z" определяется матрицей направляющих косинусов A', определяемой в виде

' cos у sin у 0Л

- sin у cos у 0

0 0 1

\ У

где у - угол вращения относительно оси O"z", отсчитываемый против часовой стрелки от положительного направления оси Ох'.

Пространственное положение точки B в связанной системе координат определяется зависимостью

r cos J 0 0 1 0 - sin J 0 cos J

A' =

yB

V zB у

= A'

sin J Y aЛ 0

yv 0 у

+

Lm

0

0

где Ф - угол вращения относительно оси O"у", отсчитываемый против часовой стрелки от положительного направления оси С"х"; а - длина первого звена манипулятора; Lм - расстояние от центра масс до центра вращения звена.

Второе звено манипулятора длиной Ь поворачивается в плоскости манипулятора на угол Р, поэтому пространственное положение точки К в связанной системе координат определяется зависимостью

yK

zK у

V

= A'

V 0 у

+

x B y B z B

V

у

0 1 0 sin р 0 cos р

где Р - угол вращения звена манипулятора относительно оси O"y", отсчитываемый против часовой стрелки от положительного направления оси 0"х"^; b - длина второго звена манипулятора.

Рассмотрим платформу, установленную на разновысотное основание (рис. 1). Если платформа установлена на ровной горизонтальной поверхности, то оси х' и У лежат в горизонтальной плоскости. При изменении высот точек касания колес платформа меняет свое положение. Будем считать, что высоты точек касания Земной поверхности колесами левого

(правого) ряда имеют индивидуальные значения: И¡п, Игп 1£ п £ N.

Для определения приращения высоты центра масс 82, а также приращений углов 8$ и крена 8у платформы в Земной системе координат для

симметричной машины может быть получена следующая система уравнений [5]:

N

X [(dZ + Ly8g + Lxndj hln Cin + (dz Ly 8g + Lxn8J hrn C

= 0;

n=1

N

X [

n=1

N

X [(dz + Ly 8g + Lxn8J hln )lxncln + (dz Ly 8g + Lxn8J hrn ^¿xncrn

=0

n=1

где hln (Kn) - высоты точек касания Земной поверхности колесами левого (правого) ряда; cin - жесткость подвесок левого ряда опор; crn - жесткость

подвесок правого ряда опор, 1£ n £ N; Lxn, Ly - координаты подвесок в

связанной системе координат, показанные на рис. 1.

Для симметричной машины справедливы условия cin = crn = c, 1£ n £ N. В этом случае уравнения (5) принимают вид

X [8Z + Lxn8J — hln + 8z + Lxn8J — hrn .= 0 ; X \2Lydr — hln + hrn ] = 0 ;

n=1

n=1

N

X [(d z + Lxn 8J hln ^¿xn + (d z + Lxn 8J hrn ^¿xn.

0.

n=1

Решение (6) относительно 8z, 8j и 8g дает:

X (hln + hrn) _n=1 N 2 Г X - _ n=1 _ 1 1 xn rn + ln N X =n1 xn N X =n1

2 1 1 N 2 N X ¿in - n=1 ( N \2 X Lxn \n = 1 J

8j =

X (hln + hrn )^xn _n=1 _ N - г N / \" X (hln + hrn ) _ n =1 _ xn L1 NW "

2 1 1 nN nM N x а 1 Г N ^2 X Lxn \n=1 J

8g= X

N hln hrn

Y n=1 2N

Матрица поворотов связанной системы координат относительно Земной системы имеет вид:

^ СОБ80 0 бій 80Л г 1 0 Л 0

А = 0 1 0 0 88 О -Я О СЛ сл О 1 °

ч - бій 80 0 соб 80 0 V

Для определения углового положения платформы в сенсорную систему мобильного робота вводят датчики определения углового положения платформы. Одним из распространенных типов датчиков измерения углового положения является инклинометр, предназначенный для измерения угла наклона различных объектов, относительно гравитационного поля Земли. Инклинометры с электрическим выходным сигналом, пропорциональным углу наклона датчика имеют высокую точность и небольшие размеры. Для решения задач управления достаточно использовать двухосевой датчик, позволяющий измерять углы 8ф и 5у. Пример инклинометра приведен на рис. 2 а. Для определения углов поворота звеньев манипулятора используются абсолютные энкодеры (рис. 2 б).

а б

Рис. 1. Инклинометр

Сигналы с инклинометра и энкодеров вводятся в блок определения координат точки К манипулятора, где:

по показаниям энкодеров углы у, Ф и Ь пересчитываются в координаты (х'к, у к, 2'к) точки К связанной системы координат х'О'у'2 ;

по координатам (хК, у к, 2К) и по показаниям инклинометра углы 5ф и 5у пересчитываются в координаты (хк, Ук, 2К) точки К Земной

системы координат хОуі.

Точность определения координат зависит от точности инклинометра и энкодеров. Для повышения точности захвата предметов, расположенных на Земной поверхности в сенсорную систему вводят ТВ-камеры сис-

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

Список литературы

1. Ларкин Е.В., Нгхиа В.З. Трассировка движения мобильного робота по пересеченной местности // Известия ТулГУ. Сер. Технические науки. Вып. 8. Тула: Изд-во ТулГУ, 2012. С. 257 - 261.

2. Акименко Т. А., Ларкин Е.В., Лучанский О. А. Оценка «смаза» изображения в системе технического зрения мобильного колесного робота // Вестник РГРТУ. Рязань: РИЦ РГРТУ, 2008. С. 77 - 80.

3. Ларкин Е.В., Феофилов Д.О. Моделирование поперечных колебаний транспортного средства в тренажерах // Известия ТулГУ. Технические науки. Вып. 1. Тула: Изд-во ТулГУ, 2011. С. 143 - 150.

4. Будков С.А., Клинцов Г.Н., Ларкин Е.В. Математическая модель сложного мехатронного комплекса // Известия ТулГУ. Сер. Технические науки. Вып. 3. Тула: Изд-во ТулГУ, 2013. С. 320 - 328.

5. Ларкин Е.В., Рудианов Н.А. Математическая модель поперечных колебаний подвижного наземного объекта // Вестник Рязанского государственного радиотехнического университета. № 3 (Вып. 37). 2011. С. 43 -47.

Будков Сергей Анатольевич, аспирант, elarkin@,mail.ru, Россия, Тула, Тульский государственный университет

Ларкин Евгений Васильевич, зав. кафедрой, докт. техн. наук, профессор, elarkin@,mail.ru, Россия, Тула, Тульский государственный университет

DETERMINA TION OF OPERA TIONAL UNIT SPACE POSITION S.A. Budkov, E. V. Larkin

A question of execution of mechanical operations by mobile robot is investigated. Dependencies, which link angle positions of manipulator units with space position of operational unit, are obtained. The configuration of sensor system for determination of operational unit space position is worked out.

Key words: mobile robot, base, manipulator, operational unit, direction cosine matrix, inclinometer, encoder.

Budkov Segrey Anatolyevich, postgraduate, elarkin@mail.ru, Russia, Tula, Tula State University

Larkin Eugene Vasilyevich, head of chair, doctor of technical science, professor, elarkin@,mail. ru, Russia, Tula, Tula State University