Новый подход к решению задачи управления роботом-манипулятором
Рассматривается задача управления роботом-манипулятором, состоящим из трех звеньев: стрела, рукоять и исполнительный механизм, соединенных между собой шарнирами. Конфигурация робота однозначно определяется углами между звеньями. Предполагается, что эти углы доступны измерению. Предполагается также, что на основании этих измерений можно вычислить моменты инерции и весовые моменты (произведения веса на плечо) звеньев. В результате получается простая математическая модель, описывающая движение робота, для которой получен простой алгоритм управления. Приведены результаты численного моделирования для задач перехода манипулятора из начального состояния в рабочее и движения манипулятора вдоль поверхности.
A new approach to solving the problem of robotmanipulator control.pdf В настоящее время существует большое количество различных типов подвижных роботов, или манипуляционных систем (экскаваторы, погрузчики, бурильные установки и пр.). Для каждого типа роботов имеют место проблемы с их управлением. В данной работе рассматриваются роботы-манипуляторы, состоящие из трех звеньев: стрела, рукоять и исполнительный механизм, соединенных между собой шарнирными механизмами. Теоретические вопросы управления подобными устройствами наиболее подробно изложены в [1-6]. В этих работах для управления роботами предложено использовать так называемые скользящие режимы [7. С. 12], что приводит к большим вычислительным трудностям. Следует также отметить работы [8-10] по синтезу управления на основе метода конструирования агрегированных регуляторов применительно к управлению движением центра масс подвижного объекта, описанным в виде системы дифференциальных и / или разностных уравнений. Этот метод привлекателен тем, что является аналитическим и приводит к созданию алгоритмов робастного нелинейного управления в условиях как систематических, так и случайных помех. Несмотря на возрастающее число работ в направлении создания систем управления для существующих моделей манипуляторов, имеется ряд не вполне решенных вопросов: невысокая точность следящего управления; сложность технической реализации системы управления с учетом вопросов устойчивости управления. В настоящей работе предложен новый и достаточно простой метод построения законов управления для объекта «трехзвенный робот-манипулятор» с целью его дальнейшего сравнения по эффективности с ранее полученными алгоритмами управления [1, 7, 9]. 1. Схема робота-манипулятора Схема робота-манипулятора приведена на рис. 1. Здесь 0А - стрела, АВ - рукоять, ВС - исполнительный механизм. В точках 0, А и В расположены шарнирные механизмы, которые выполняют 4 Новый подход к решению задачи управления роботом-манипулятором поворот звеньев. На рисунке l\\, I2, I3 - длины звеньев 0А, АВ, ВС соответственно. G\\ = gm\\, G2 = gm2, G3 = gm3 - вес этих звеньев, m\\, m2, тз - массы звеньев, g - ускорение силы тяжести. Конфигурация (состояние) робота однозначно определяется углами между звеньями а, в, у или координатами точек А(х\\, y\\), В(х2, у2), С(хз, уз). Между этими данными есть однозначное соответствие. Если заданы углы а, в, у, то X = /,cos(a), у = /jsin(a), x2 = x + /2sin(p), У2 = у - /2cos(p), (1) x3 = x2 +13 cos(x), y3 = y 2 + /3 sin(x), где p = а + в - п/2, т = -у + р + л/2 = а + в - у. Рис. 1. Схема робота-манипулятора Fig. 1. Robot manipulator diagram Если заданы координаты точек А(х1, у{), В(х2, У2), С(х3, У3), то а = arcsin(у / /х), Р = л /2 -а + arccos((у - у)//2), (2) У = а + р-arcsin((у3 -У2)//3). Далее нам потребуется результат решения следующей задачи. Пусть заданы координаты точек В(х2, У2) и С(х3, У3). Эти точки должны удовлетворять условиям х2 + у2
Ключевые слова
робот-манипулятор,
управление движением центра масс,
планировкаАвторы
Параев Юрий Иванович | Томский государственный университет | профессор, доктор технических наук, заслуженный деятель науки РФ, заслуженный профессор, профессор кафедры прикладной математики Института прикладной математики и компьютерных наук | paraev@mail.ru |
Колесникова Светлана Ивановна | Санкт-Петербургский государственный университет аэрокосмического приборостроения | доктор технических наук, профессор кафедры компьютерных технологий и программной инженерии института вычислительных систем и программирования | skolesnikova@yandex.ru |
Цветницкая Светлана Александровна | Томский государственный университет | кандидат технических наук, доцент кафедры прикладной математики Института прикладной математики и компьютерных наук | svetasa@sibmail.com |
Всего: 3
Ссылки
Матюхин В.И. Управление движением манипулятора. М. : Науч. изд. Ин-та проблем управления им. В.А. Трапезникова РАН, 2010. 95 с.
Матюхин В.И. Непрерывные универсальные законы управления манипуляционным роботом // Автоматика и телемеха ника. 1997. № 4. С. 69-82.
Матюхин В.И. Стабилизация движений манипулятора вдоль заданной поверхности // Автоматика и телемеханика. 2011. № 4. С. 71-85.
Матюхин В.И., Пятницкий Е.С. Управление движением манипуляционных роботов на принципе декомпозиции при учете динамики приводов // Автоматика и телемеханика. 1989. № 9. С. 67-81.
Dwivedy S.K., Eberhard P. Dynamic analysis of flexible manipulators, a literature review // Mechanism and Machine Theory. 2006. № 41. P. 749-777.
Yu H., Liu Y., Hasan M.S. Review of modelling and remote control for excavators // International Journal of Advanced Mechatronic Systems. 2009. V. 2, № 1. P. 68-80.
Уткин В.И. Скользящие режимы в задачах оптимизации и управления. М. : Наука, 1981. 368 с.
Синергетика и проблемы теории управления : сб. науч. тр. / под ред. А.А. Колесникова. М. : Физматлит, 2004. 504 с.
Kolesnikov A.A., Kolesnikovа S.I., Tsvetnitskaya S.A. Discrete Stochastic Regulator on a Manifold, Minimizing Dispersion of the Output Macrovariable // Mekhatronika, Avtomatizatsiya, Upravlenie. 2019. № 12 (20). P. 707-713. URL: https://doi.org/10.17587/mau.20.707-713 (accessed: 17.12.2020).
Kolesnikova S., Tsvetnitskaya S., Pobegailo P. An Extension of the Method of Aggregated Regulators to a Discrete Stochastic Object // International Siberian Conference on Control and Communications, SIBCON. DOI: 10.1109/SIBCON.2019.8729595. URL: https://ieeexplore.ieee.org/document/8729595. (accessed: 17.12.2020).
Matyukhin, V.I. (2010) Upravlenie dvizheniem manipulyatora [Manupulator motion control]. Moscow: RAS.
Matyukhin, V.I. (1997) Continuous universal laws of control of a manipulative robot. Avtomatika i telemehanikale - Automation andRemout Control. 4. pp. 69-82.
Matyukhin, V.I. (2011) Stabilization of manipulator movements along a given surface. Avtomatika i telemehanikale - Automation and Remout Control. 4. pp. 71-85.
Matyukhin, V.I. & Pyatnitskiy, E.S. (1989) Motion control of manipulation robots based on the principle of decomposition taking into account the dynamics of drives. Avtomatika i telemehanikale - Automation and Remout Control. 9. pp.67-81.
Dwivedy, S.K. & Eberhard, P. (2006) Dynamic analysis of flexible manipulators, a literature review. Mechanism and Machine Theory. 41. pp. 749-777. DOI: 10.1016/j.mechmachtheory.2006.01.014
Yu, H., Liu, Y. & Hasan, M.S. (2009) Review of modelling and remote control for excavators. International Journal of Advanced Mechatronic Systems. 2(1). pp. 68-80. DOI: 10.1504/IJAMECHS.2010.030850
Utkin, V.I. (2012) Skol'zyashchie rezhimy v zadachakh optimizatsii i upravleniya [Sliding modes in control and optimization]. Berlin: Springer.
Kolesnikov, A.A. (ed.) (2004) Sinergetika iproblemy teorii upravleniya [Synergetics and problems of control theory]. Moscow: Fismatlit.
Kolesnikov, A.A., Kolesnikova, S.I. & Tsvetnitskaya, S.A. (2019) Discrete Stochastic Regulator on a Manifold, Minimizing Dispersion of the Output Macrovariable. Mekhatronika, Avtomatizatsiya, Upravlenie. 12(20). pp. 707-713. DOI: 10.17587/mau.20.707-713
Kolesnikova, S., Tsvetnitskaya, S. & Pobegailo, P. (2019) An Extension of the Method of Aggregated Regulators to a Discrete Stochastic Object. International Siberian Conference on Control and Communications, SIBCON. DOI: 10.1109/SIBCON.2019.8729595