Scientific journal
Fundamental research
ISSN 1812-7339
"Перечень" ВАК
ИФ РИНЦ = 1,674

THE CONTROL SYSTEM OF THE ADAPTIVE ASSEMBLY ROBOT WITH THE MODEL OF TECHNOLOGICAL PROCESS

Mishulin Y.E. 1 Egorov I.N. 2 Bunenkov V.V. 2
1 ladimir State University named after Alexander Grigorievich and Nikolai Grigorievich Stoletovs
2 Vladimir State University named after Alexander Grigorievich and Nikolai Grigorievich Stoletovs
Questions of creation of system of adaptive control of the assembly robot which is carrying out operation of assembly of products like rotation bodies are considered. The control system of the robot is under construction with use of model of assembly process. The given model of assembly process reflects the geometrical communications and power interactions resulting from interface of details. It is shown that owing to geometrical communications and power interactions in the course of interface of details possibly emergence of special (singular) states in the form of jamming. Algorithms of management of system of drives of the robot are developed on the basis of information on a condition of object of management – technological process of assembly for each contact situation. For management of process of assembly at continuous movement of the collected products by means of system of technical sight the problem of detection of the interfaced moving cylindrical detail, determination of its coordinates and speed of movement proceeding from the admissible size of a hindrance of the image is solved. Assembly is carried out in the mode of position-force management and indistinct visual tracking by the assembly robot behind situation and coordinates of the center of an opening of continuously moving detail. The developed mathematical models of technological process of interface of details like «shaft plug» taking into account communications, parameters of power interaction and algorithms of model management provide the solution of problems of identification of situations of process of interface and adaptive logical-dynamic management of interface process.
assembly robot
mathematical model
build process
force-torque sensor
1. Egorov I.N. Pozicionno-silovoe upravlenie robototehnicheskimi i mehatronny-mi ustrojstvami: monografija / Vladim. gos.un-t.-Vladimir: Izd-vo Vladim.gos.un-ta, 2010. 192 р.
2. Egorov I.N., Matlub M.M. Upravlenie robotami na osnove pozicionno-silovyh i nechetkih vizualnyh algoritmov // Izvestija TGU. Tehnicheskie nauki. Vyp.1, 2010. рр. 158–165.
3. Egorov I.N. Upravlenie mehatronnymi i robototehnicheskimi sistemami s silo-momentnym ochuvstvleniem: Ucheb. posobie. I.N. Egorov, A.A. Kobzev, Ju.E. Mishulin, V.A. Nemontov // Pod red.prof. I.N.Egorova / Vladim. gos. un-t, Vladimir, 2004. 270 р.
4. Zharkov G.E. Metod sborki izmeneniem polozhenija centra tjazhesti//Sborka v ma-shinostroenii, priborostroenii. Moskva. 2014, no. 11. рр. 5–12.
5. Iskusstvennyj intellekt i intellektualnye sistemy upravlenija .I.M. Ma-karov, V.M. Lohin, S.V. Manko, M.P. Romanov. M.: Nauka, 2006. 336 р.
6. Kuznecov M.V., Simakov A.JI. Primenenie metodov nechetkogo upravlenija v robo-tizirovannyh sborochnyh operacijah // Mehatronika, avtomatizacija, upravlenie. 2004. no. 5.
7. Poduraev Ju.V. Mehatronika: osnovy, metody, primenenie: ucheb. posobie. M.: Mashinostroenie, 2006. 256 р.
8. Poletaev V.A., Turchin D.E. Analiz svjazej pri avtomaticheskoj sborke s pomoshh’ju metoda prostranstvennyh konfiguracij / Vestnik Kuzbasskogo GTU. 2005, no. 4,2. рр. 76–79.
9. Chernjahovskaja L.B. Kinematicheskij i dinamicheskij analizy avtomaticheskoj sborki cilindricheskih detalej: Monografija. Samara: Sam.gos. un-t, 2011. 75 р.

Создание переналаживаемых роботизированных сборочных комплексов основано на применении: промышленных роботов (ПР) с программным управлением, работающих в условиях упорядоченной среды; адаптивных ПР, взаимодействующих с неупорядоченной средой вследствие оснащения их системами очувствления и логико-динамического управления; интеллектуальных ПР, обеспечивающих высококачественное управление в условиях неопределенностей. В первом случае операцию сопряжения деталей осуществляет специальное технологическое устройство, а ПР обеспечивает захват и базирование деталей и съем собранного узла. Во втором и третьем случаях ПР является технологическим роботом, который непосредственно выполняет операцию сборки деталей [7].

В общем виде технологический процесс роботизированной сборки состоит из следующих основных переходов: захват одной из деталей и перемещение её на позицию сборки; позиционирование и относительная ориентация собираемых деталей с точностью, обеспечивающей их собираемость; сопряжение собираемых деталей; контроль качества сборки и съем собранного изделия (узла). Функциональные движения [7] технологического сборочного робота (СР), непосредственно выполняющего процесс сборки изделий (узлов) из деталей типа «вал-втулка», являются несвободными движениями. Это происходит вследствие действия как геометрических и кинематических связей (связей 1 и 2 видов) [8], так и силовых взаимодействий с возможностью возникновения особых (сингулярных) состояний (заклинивание) [9], вызванных резким увеличением силы трения с уменьшением угла между осями собираемых деталей [4].

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

В качестве объекта управления в системе управления СР рассматривается технологический процесс сборки. Исходя из этого, очевидно, что управляющими воздействиями или входными величинами сборочного процесса, как объекта управления являются выходные координаты СР, а именно координаты положения mishulin01.wmf и скорости mishulin02.wmf рабочего органа. Управляемой координатой или выходной величиной сборочного процесса является вектор сил и моментов mishulin03.wmf, возникающий в результате действия геометрических связей собираемых компонент при сопряжении деталей [3].

Кроме того, входными величинами сборочного процесса являются координаты mishulin04.wmf положения базовой детали. Величина mishulin05.wmf является постоянной величиной, если базовая деталь находится на неподвижном основании, и переменной, если базовая деталь в процессе сборки перемещается. Изменение скоростей движения рабочего органа робота и сборочного стола приводит к непостоянству коэффициента трения fТР между собираемыми деталями.

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

mishulin07.wmf

Основой математической модели сборочного процесса являются уравнения геометрических связей и силовых взаимодействий собираемых деталей (рис. 1).

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

mishulin08.wmf

где Xp, Yp – координаты точки контакта P.

pic_48.wmf

Рис. 1. Структурная схема модели сборочного процесса

При достижении D ? 0 собираемые детали соприкасаются и возникает сила реакции N, пропорциональная величине деформации, т.е. N = –CD, где C – коэффициент жесткости. На основании этих положений определены геометрические условия, при которых возникают силовые взаимодействия собираемых деталей [3].

Величина нормальной силы Ni, возникающей при точечном контакте, для различных ситуаций взаимодействия собираемых деталей определяется в виде Ni = –CDi, при i = 1...8, где C – жесткость собираемых деталей.

В этом выражении необходимо учитывать знак Di:

Ni = –sgn (i) CDi,

где sgn (i) = [10001011]T для Di > 0; sgn (i) = [01110100]T для Di < 0.

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

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

Уравнения сил и моментов в матричной форме имеют вид

mishulin09.wmf

где mishulin10.wmf – вектор столбец, mishulin11.wmf; i определяет номер сборочной ситуации; Nj – нормальная сила реакции; j – номер контактной ситуации; mishulin12.wmf – матрицы коэффициентов, учитывающие геометрию и взаимное расположение собираемых деталей.

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

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

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

pic_49.wmf

Рис. 2. Структурная схема системы управления сборочного робота

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

pic_50.wmf

Рис. 3. Функциональная схема системы управления сборочного робота

Устройство управления формирует законы позиционно-силового управления [1, 2, 3] приводами исполнительного устройства СР. Выходными сигналами mishulin13.wmf сборочного процесса являются силы и моменты, возникающие в результате взаимодействия собираемых деталей. Они измеряются измерительной системой. Выходные сигналы с исполнительного механизма поступают также на математическую модель сборочного процесса, которая формирует усилия и моменты:

mishulin14.wmf

mishulin15.wmf

Сигналы с измерительной системы mishulin16.wmf mishulin17.wmf и модели mishulin18.wmf mishulin19.wmf поступают на наблюдатель, который формирует функцию ?К оценки правильности протекания сборочного процесса. Функция оценки может иметь вид

mishulin20.wmf

где e – величина, стремящаяся к нулю, и определяется точностью измерения mishulin21.wmf и mishulin22.wmf и полнотой и точностью математической модели. Смыслом функции ?1 является соответствие или равенство усилий и моментов на выходе объекта управления и на выходе его модели.

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

mishulin23.wmf

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

Для определения причины несобираемости служит анализатор, на вход которого поступает сигнал ?К с выхода наблюдателя, и функция оценки ?К принимает следующие значения:

mishulin24.wmf

Анализатор работает по алгоритму распознавания сборочной ситуации.

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

1. Управление сборочной системой осуществляется по одному из алгоритмов, соответствующему какой-либо сборочной ситуации [3]. В случае неравенства нулю функции оценки ?К анализатор определяет, в какой сборочной ситуации находятся собираемые детали. Если определена сборочная ситуация, не соответствующая алгоритму управления, то выдается сигнал на блок программной коррекции и устройство управления изменяет алгоритм работы на соответствующий алгоритм для определенной сборочной ситуации.

2. Если сборочная ситуация соответствует алгоритму управления, а функция ?К не равна нулю, то необходимо сформировать сигналы на коррекцию программного движения с помощью блока сигнальной коррекции (адаптации) [2, 3].

Для определения величины коррекции Uc воспользуемся следующими положениями. Возникающие в процессе сборки силы F и моменты M являются результатом силового взаимодействия собираемых деталей. Будем считать, что силомоментный датчик позволяет измерить все составляющие главного вектора сил и моментов по координатным осям. Причем компоненты момента Mx, My, Mz выражаются через компоненты силы Fx, Fy, Fz и координаты Xk, Yk, Zk точки K приложения вектора сил и моментов:

mishulin25.wmf

mishulin26.wmf

mishulin27.wmf

Эти уравнения линейно зависимы, поскольку mishulin28.wmf и образуют систему второго порядка. Таким образом, можно определить лишь две координаты, что часто бывает достаточно, так как одна координата, например высота вала Zk = H, известна. Следовательно, по измеренным силам и моментам можно определить координаты точки приложения силы F или точки контакта собираемых деталей:

mishulin29.wmf

mishulin30.wmf

Zk = H.

Эти выражения положены в основу работы блока формирования параметров сигнальной коррекции.

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

Алгоритмы управления разрабатываются на основе информации о состоянии объекта управления – технологического процесса сборки. Эта информация поступает с измерительной системы. Формируемое управление подается на приводы по соответствующим координатам. Алгоритм управления разрабатывается для каждой контактной ситуации [2, 3]. В исходном состоянии базовая деталь расположена на сборочном столе. Вторая деталь находится в схвате робота. Робот выводит деталь на позицию сборки и приводу по координате вертикального перемещения Z, задается управление по усилию с уставкой FZзад. Деталь перемещается вниз до контакта со второй деталью. При достижении FZ = FZзад привод останавливается.

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

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

C целью повышения эффективности существующих методов автоматической сборки необходимо найти решение проблемы управления СР в особых (сингулярных) состояниях заклинивания. Создание эффективных систем управления подобными сложными динамическими объектами в условиях существенной неопределённости требует применения специальных методов адаптации и интеллектуального управления [5].

В качестве примеров решения данной проблемы следует, в частности, отнести разработку: метода автоматической сборки цилиндрических подвижных соединений изменением центра тяжести подвижной детали и метода наложения колебаний вдоль оси сборочного комплекта, обобщенных сетевой морфологической матрицей вариантов [4]; системы нечеткого управления поиском согласованного положения деталей для роботизированных сборочных устройств на основе желаемого закона движения совмещаемой детали относительно базовой [6]; алгоритмического и программного обеспечения интеллектуальной сборки соединений с гарантированным зазором на основе нейронных сетей с силомоментной адаптацией и использованием в качестве исполнительного устройства робота IRB-140, оснащенного силомоментным датчиком фир мы «Schunk».

Работа выполнена при финансовой поддержке РФФИ (проект № 13-08-01364).