УДК 621.757
Махмутов М.М. - кандидат технических наук, старший преподаватель
E-mail: maratmax@yandex.ru
Сахапов Р.Л. - доктор технических наук, профессор
E-mail: rustem@sakhapov.ru
Земдиханов М.М. - кандидат технических наук, доцент
E-mail: mr.minsur@mail.ru
Казанский государственный архитектурно-строительный университет
Адрес организации: 420043, Россия, г. Казань, ул. Зеленая, д. 1
Прямая и обратная задача кинематической точности строительных роботов
Аннотация
В статье рассмотрены вопросы кинематической точности манипуляционных промышленных роботов. Получены зависимости, связывающие суммарную погрешность позиционирования робота через погрешности координат, параметры программируемого манипулятора и его положение в рабочей зоне.
Для заданного положения захватного устройства робота рассчитаны обобщенные координаты, но эти значения обычно находятся путем решения обратных задач о положениях манипулятора. Поставлена и решена прямая и обратная задача кинематической точности манипуляционных роботов.
Ключевые слова: кинематическая точность, погрешность позиционирования, линейная и угловая ошибка программирования, прямая и обратная задачи кинематической точности.
Введение
Реализация заданных положений схвата с необходимой точностью имеет важное значение при работе манипулятора.
Точность позиционирования манипулятора оценивается его погрешностью позиционирования, отклонением фактического положения выходного звена исполнительного механизма от установившегося значения.
Погрешность позиционирования оценивается в линейных и угловых величинах [1, 2].
Точность позиционирования промышленных роботов является его важнейшей и комплексной характеристикой, от которой непосредственно зависит выполнение заданной технологической операции.
Погрешность позиционирования робота зависит от многих факторов: от точности обработки системой управления [3, 4], управляемых, обобщенных координат исполнительного механизма, от точности обработки деталей конструкции, от деформации звеньев основного и передаточного механизмов и других факторов.
В различных условиях функционирования робота наиболее важную роль могут играть различные факторы. Ниже рассмотрим одну из важнейших составляющих -кинематическую точность робота.
Основная часть
Кинематическая точность робота - эта погрешность положения выходного звена исполнительного механизма робота, возникающего за счет ошибок обработки приводами и системы управления программных значений обобщенных управляемых координат.
Для большинства промышленных роботов средней грузоподъемности от 10 до 50 кг эти ошибки являются основными, влияющими на основную погрешность позиционирования [4, 5].
Под программируемыми значениями обобщенных координат будем понимать их значения, найденные для заданного положения захватного устройства робота, но эти значения обычно определяются путем решения обратных задач о положениях манипулятора [6, 7].
Действительные значения обобщенных координат манипулятора отличаются от программных на величину Ад! (1=1,...,п), где п - число степеней свободы системы, поэтому действительное положение схвата будет отличаться от заданного.
Для определения линейных ошибок с захватным устройством свяжем систему координат Ох и г и ее заданное программное положение 0пхпуп2п будет отличаться от действительного положения 0дхдудгд (рис. 1).
Рис. 1. К расчету ошибки позиционирования робота
Величину Дг = гп — гд будем называть линейной ошибкой манипулятора, а угол на который следует повернуть систему 01х1у1г1, чтобы сделать ее оси параллельными соответствующим осям системы О^у^, называется угловой ошибкой робота. Эйлера-Даламбер [3] на основе теоремы доказал возможность поворота.
Произвольной точки захватного устройства с радиус-вектором определится:
г = г (ф), 1=1,.. .,п, (1)
где п - число степеней подвижности манипулятора.
Продифференцировав последнее выражение, получим:
*т = . (2)
Решая дифференциалы, найдем линейную ошибку:
^ = ^, (3) где д - ошибки обобщенных координат.
Координаты вектора г в неподвижной системе координат можно определить путем использования умножения координат точки схвата в системе координат, связанной со схватом на матрицы, определяющие относительное положение звеньев, следующим образом:
||г|| = М1,М2.....Мп, И, _ (4)
где ||г|| - столбец координат вектора г в неподвижной системе координат, ЦГдУ - столбец координат точки схвата в системе координат, связанного со схватом М1 (1 = 1,., п) -матрицы перехода четвертого порядка от звена 1 и звена 1-1.
При большом числе степеней свободы выражение для координат вектора г оказываются весьма громоздкими. Кроме того, для получения выражения линейной ошибки эти выражения необходимо дифференцировать, что весьма трудоемко. Далее по формуле определим линейную ошибку не содержащую операцию дифференцирования. Считая векторы относительных угловых скоростей скользящими, запишем выражение вектора линейной скорости точки схвата в виде:
Г" + X(5)
] I
где j - номер вращательной пары; 1 - номер поступательной пары.
Но
® I = /V • (6)
где еу, - орты соответственно вращательных и поступательных пар, ф - углы поворотов и перемещения в поступательных парах соответственно, определяемые по
фоРмУлам: = ^; $( =
Тогда на основе (4) получим:
йг = ^ dф • е • г^ + ^ dsi • , (7)
7 '
или в конечной форме выражение для линейной ошибки манипулятора:
Дг = ^ Дф7- • е • г; + ^ Д^ • ё, (8)
7 '
где AфJ, Д8; - ошибки соответственно во вращательных и поступательных парах.
Рис. 2. Схема компоновки манипулятора
В частности погрешность положения выходного звена модульного робота РПМ-25, показанного на рис. 2 может быть представлена в виде:
Щ = Др~б • • Ъб) + Д^2 • ё2 + Дб3 •е + Др1 • (е4 • г£> + ДР5 • • Ты) + Д(р6 • (е6 • г6), где г6 - радиус-векторы, определяющие положение точки схвата, относительно
центров пар Б, Е и Б соответственно.
Считая угол поворота малым, погрешность угла поворота запишем:
Дф = ^ Д^ = ^ ДЦ] • , (9)
7 )
где А^ - ошибка обобщенной координаты во вращательной кинематической пары, ё} - орт оси шарнира )
Так как векторы и е] заданы, то последнюю формулу запишем в виде:
Дф = £ Д^ Г ъ , (10)
7
где Ь) - матрица перехода третьего порядка от системы номера) к системе )-1.
Возможность выполнения роботом заданной технологической операции определяется соотношением ошибки позиционирования задаваемой операцией и ошибкой позиционирования реализуемой работы.
Практически важной является задача распределения ошибки позиционирования обычно задаваемой выполняемой технологической операцией на допустимые ошибки отработки приводами и системы управления.
В случае модульных промышленных роботов речь идет о назначении допустимых ошибок позиционирования модулей. Эта задача является достаточно неопределенной, так как заданную точность позиционирования робота можно обеспечить, устанавливая по-разному предельные ошибки модулей.
Одно из решений может быть построено на основе принципа равного влияния ошибок модулей на ошибку позиционирования схвата.
Пусть величина предельной абсолютной погрешности робота задана, тогда:
дг
Лг < !?= !
дqi
I Л я ] | .
(11)
Все слагаемые суммарной погрешности позиционирования от ошибок модулей должны равняться. Тогда
дг дг дг дг Лг
— • Л <?! = — ■ Л ц2 = — ■ Л(?з = -— ■ Лцп =—, (12)
<Э<?1 д <?2 5(?3 дцп _ п
где Ад], Ад2, Ад3, Адп- ошибки обобщенных координат, Г- радиус-вектор произвольной
точки захватного устройства.
Откуда:
Л Ч г =
Л
дг
п • дЧп
, (I = 1,...,п).
(13)
Последняя формула позволяет назначить требование по точности на обработку приводами значений обобщенных координат.
Заключение
Возможность выполнения роботом заданной технологической операции определяется соотношением ошибки позиционирования задаваемой операцией и ошибкой позиционирования реализуемой работы.
Для расчета позиционирования модульных промышленных роботов нужно правильно назначить допустимые ошибки позиционирования модулей. Данная задача является достаточно неопределенной, так как установленные по-разному предельные ошибки модулей меняют заданную точность позиционирования.
Список библиографических ссылок
1. Козырев Ю.П., Воробьев Е.И. Промышленные роботы агрегатно-модульного типа. - М.: Изд-во Машиностроение, 1988. - 240 с.
2. Демидович Б.П., Марон И.А. Основы вычислительной математики. - М.: Изд-во Физматгиз, 1963. - 660 с.
3. Козырев Ю.П. Промышленные роботы: справочник. - М.: Изд-во Машиностроение, 1983. - 376 с.
4. Лурье А.И. Аналитическая механика: справочник. - М.: Изд-во Физматгиз, 1961. - 824 с.
5. Махмутов М.М. Определение передаточной и переходной функций ходовой системы агрегата // Техника и оборудование для села, 2013, № 5. - С. 21-23.
6. Махмутов М.М. Оптимизация параметров конусности стойки устройства противоскольжения // Тракторы и сельхозмашины, 2013, № 6. — С. 31-33.
7. Махмутов М.М., Сахапов Р.Л., Обзор исследований по взаимодействию снежного покрова с различными рабочими органами коммунальных машин // Известия Самарского научного центра РАН, 2016, том 18, № 1. - С. 432-434.
8. Сахапов Р. Л., Махмутов М.М. Теория функционирования механической энергии в строительных машинах // Механизация строительства, т. 77, 2016, № 8. - С. 17-21.
9. Габдуллин Т.Р., Загретдинов Р.В. Повышение производительности систем управления дорожно-строительной техникой при использовании систем глобального спутникового позиционирования // Известия КГАСУ, 2014, № 4 (26). -С. 397-402.
10. Габдуллин Т.Р. Разработка лесопильного узла к одноковшовому экскаватору // Механизация строительства, 2015, № 8 (854). - С. 6-8.
Makhmutov M.M. - candidate of technical sciences, senior lecturer E-mail: maratmax@yandex.ru
Sakhapov R.L. - doctor of technical sciences, professor, E-mail: rustem@sakhapov.ru
Zemdikhanov M.M. - candidate of technical sciences, assistant professor E-mail: mr.minsur@mail.ru
Kazan State University of Architecture and Engineering
The organization address: 420043, Russia, Kazan, Zelenaya st., 1
Direct and inverse problem of kinematic accuracy of industrial robots Resume
In the article was reviewed the questions of kinematic accuracy of manipulating industrial robots. Received dependences of linking the overall error positioning of the robot through an inaccuracy, parameters programmable manipulator and its position in the working area. Stated and solved the direct and inverse problem of kinematic accuracy manipulation robots.
The error of the robot positioning depends on many factors: the accuracy of the processing management system, controlled, generalized coordinates of the actuator, the accuracy of processing the details of construction, the deformation of the main units and gear mechanisms and other factors.
In various robot operating conditions the most important role can play a variety of factors. Below is a look at one of the major components - a kinematic robot accuracy.
Under the programmable values of the generalized coordinates will understand the value found for a given position of a gripper device of a robot, but these values are usually determined by solving the inverse problems about the provisions of the manipulator. Set and solved the direct and inverse kinematic precision manipulator robots.
Keywords: kinematic accuracy, accuracy linear and angular of position programming error, direct and inverse kinematic accuracy.
Reference list
1. Kozyrev Y.P., Vorobyev E.I. Industrial robots aggregate-modular. - M.: Mashinostroenie, 1988. - 240 p.
2. Demidovich B.P., Maron I.A. Foundations of computational mathematics. - M.: Fizmatgiz, 1963. - 660 p.
3. Kozyrev Y.P. Industrial robots. - M.: Mashinostroenie, 1983. - 376 p.
4. Lurie A.I. Analytical mechanics. - M.: Fizmatgiz, 1961. - 824 p.
5. Makhmutov M.M. Determination of the transfer and transition functions running system potato unit // Technica i oborudovanie dlya sela, 2013, № 5. - P. 21-23.
6. Makhmutov M.M. Optimization of parameters of taper of the strut device chains // Tractori i chelhozmachiny, 2013, № 6. - P. 31-33.
7. Sakhapov R.L., Makhmutov M.M. A review of studies of the interaction of snow cover with various working bodies utility vehicles // Izvestiya Samarskogo nauchnogo chentra RAN, 2016, vol. 18, № 1. - P. 432-434.
8. Sakhapov R.L., Makhmutov M.M. Theory of the functioning of the mechanical energy in construction machinery // Mechanizasiya stroitelstva, 2016, vol. 77, № 8. - P. 17-21.
9. Gabdullin T.R., Zagretdinov R.V. Improving the performance of control systems for road construction equipment with global positioning satellite // Izvestiya KGASU, 2014, № 4 (26). - P. 397-402.
10. Gabdullin T.R. the Development of the sawmill site to a shovel excavator // Mechanizasiya stroitelstva, 2015, № 8 (854). - P. 6-8.