Спосіб керування приводами маніпуляційної системи промислового робота

Реферат: UA 73997 U UA 73997 U 5 10 15 20 25 30 35 40 45 50 Корисна модель належить до робототехніки, зокрема до способів керування приводами промислових роботів із захватними пристроями, які можуть здійснювати складний (поступальний та обертальний) рух. Відомий лінійний інтерполяційний спосіб керування роботом [пат. 5379367 США МПК G05B 19/415; B25J 9/16. Linear interpolating method for robot control / Jin-Li Song; заявник та власник Samsung Electronics Co., Ltd; заявл. 27.12.1991; опубл. 3.01.1995] згідно якого рух робота відбувається за лінійними законами розгону та гальмування. Недоліками даного способу є те, що рух ланок робота є неоптимальним, оскільки лінійний розгін та гальмування можуть викликати небажані коливання ланок робота, що негативно позначається на точності позиціонування предметів, які переміщує робот. Відомий також спосіб [Черноусько Ф.Л. Управление колебаниями / Черноусько Ф.Л., Акуленко Л.Д., Соколов Б.Н. - М.: Наука, 1980.-384 с.] оптимального переміщення вантажу у горизонтальній площині за допомогою поворотного пристрою, який складається із двох твердих тіл А і В (рис. 1). Така конструкція властива багатьом маніпуляційним системам промислових роботів. Даний спосіб вибраний як аналог, оскільки він є найбільш близьким до пропонованого. Недоліками аналога є можливість перевантаження приводних механізмів, особливо при частих пусках і зупинках та виникнення коливань у елементах маніпулятора, що негативно позначається на точності виконання операцій, виконуваних роботом, та його надійності. В основу корисної моделі поставлена задача створити спосіб керування приводами маніпуляційної системи промислового робота для зменшення вірогідності перевантаження приводних механізмів робота та виключення можливості виникнення коливань у його маніпуляторі. Поставлена задача вирішується тим, що швидкості приводних механізмів поступального та обертального руху маніпуляційної системи промислового робота змінюються за певними законами, які описуються дискретними функціями часу і є оптимальними за критерієм енергетичних втрат у електродвигунах робота. Суть корисної моделі пояснюють креслення на фіг. 1 зображено маніпуляційну систему промислового робота, захватний пристрій якого може виконувати складний (поступальний та обертальний) рух: тіло В виконує поступальний рух вздовж напрямної Ох, яка жорстко пов'язана з тілом А, яке виконує обертальний рух. Рух тіла В характеризується координатою х, а тіла А координатою φ. На граф. 1 представлені графічні залежності швидкості тіла В; на граф. 2 показано графік функції зусилля, що діє на тіло В; на граф. 3 показано графік кутової швидкості тіла А; на граф. 4 зображено графік зміни крутного моменту, що діє на тіло А; на фіг. 2. показано алгоритм роботи системи керування приводами маніпуляційної системи промислового робота. Графіки, зображені на граф. 1-4, побудовані при умовах: переміщення тіла В - 1 м, обмеження накладені на кутову швидкість руху тіла В - 2 м/с; кутове переміщення тіла А - 1,7 рад; обмеження накладені на швидкість руху тіла А - 1,2 рад/с; момент інерції тіла А відносно осі О 2 2,5 кгм ; маса тіла В - 20 кг. Маса тіла В (фіг. 1) включає маси захватного пристрою, вантажу та приведений до поступального руху момент інерції приводу поступального руху захватного пристрою. Зображений на фіг. 2 алгоритм роботи системи керування маніпуляційною системою робота ілюструє заявлений спосіб. Згідно з пропонованим способом спочатку задаються координати точки захватного пристрою робота в робочому просторі робота, куди необхідно перемістити вантаж масою m. Координати задаються в глобальній системі координат, яка пов'язана, наприклад, із нерухомою платформою робота. Надалі проходить опитування датчиків положення захватного пристрою робота для того, щоб визначити його поточні координати. Після цього виконується розрахунок локальних початкових та кінцевих координат для тіл А та В. Обчислені локальні координати відповідають початковому та кінцевому положенню захватного пристрою робота. Надалі задається значення тривалості Тх роботи приводу поступального руху. Після цього виконується розрахунок дискретних значень швидкості поступального руху маніпуляційної системи робота за формулою:  30t i2 t i  Tx 2 х поч  х кін   xt i   5 Tx , i=0, 1,…, n, (1), де і - кількість дискретних значень швидкості приводу поступального руху, n - кількість T   n  x  t  , Т - тривалість роботи приводу поступального руху, Δt  дискретних значень швидкості х 55 крок дискретності задання часу, ti – і-тий момент часу, хпоч та хкін - початкова і кінцева координати приводу поступального руху, які відповідають початковому та кінцевому положенню захватного пристрою у глобальній системі координат. За формулою (1) виконується розрахунок 1 UA 73997 U значень швидкості для всіх n, при цьому показник i пробігає значення від 0 до n. Після цього  виконується визначення максимального значення швидкості із отриманого масиву xti  . Це роблять шляхом порівняння їх між собою. Отримане максимальне значення швидкості 5 10  порівнюється із допустимим. Якщо максимальне значення швидкості xmax більше аніж допустиме, то тривалість Тх роботи приводу поступального руху збільшується на величину Δt і процес розрахунків повторюється знову. Якщо максимальне значення швидкості не більше ніж допустиме, то відбувається процес розрахунку масиву дискретних значень кутових швидкостей. Для цього спочатку задається значення тривалості роботи привода обертального руху Тφ. Після цього розраховується масив значень кутових швидкостей маніпуляційної системи робота за виразом:    tj    6t 2 t j  T 2 64qt j  32qT  32t jпоч  11Tкін 6 T , j=0, 1,…, k, (2), де j - кількість дискретних значень швидкості приводу обертального руху, k - кількість T  k    t дискретних значень швидкості  15     , Tφ - тривалість роботи приводу обертального руху, tj-j тий момент часу, φпоч та φкін - початкова і кінцева координати приводу обертального руху, які відповідають початковому та кінцевому положенню захватного пристрою у глобальній системі координат, q - постійний коефіцієнт, який для заданих параметрів системи рівний q=1,1647. Далі визначається найбільше значення кутової швидкості, аналогічно, як це виконувалось для  масиву швидкостей xti  . Після перевірки умови max   доп , виконується видача керуючих сигналів на приводи поступального та обертального руху захватного пристрою робота. У загальному випадку тривалість роботи приводів поступального та обертального руху робота не рівна. Це показано на граф. 1 та граф. 3, коли швидкість відносного поступального руху тіла В рівна нулю (тіло В вже перемістилось на задану відстань), а тіло А ще виконує обертальний рух. З граф. 2 видно, що коли тіло В закінчило відносний поступальний рух, то привод поступального переміщення повинен розвивати певне зусилля, яке необхідне для того, щоб компенсувати відцентрову силу, яка діє на тіло В. Графік зміни крутного моменту, що діє на тіло А (граф. 4), має плавний характер руху, що зменшує коливання у ланках робота. Використання пропонованого способу керування приводами маніпуляційної системи промислового робота дозволяє зменшити потужність втрат у його електроприводах, усунути умови виникнення коливань ланок маніпулятора робота. У свою чергу це підвищить надійність елементів робота та, головне, збільшить точність позиціонування переміщуваних ним предметів.  20 25 30  ФОРМУЛА КОРИСНОЇ МОДЕЛІ 35 40 Спосіб керування приводами маніпуляційної системи промислового робота, що включає зміну швидкостей приводів поступального та обертального руху робота, причому максимальні значення вказаних швидкостей не перевищують наперед встановлених значень, який відрізняється тим, що швидкості привідних механізмів робота змінюють за оптимальними законами, які описують дискретними функціями часу: - для приводу поступального руху  xt i    30t i2 t i  Tx 2 х поч  х кін  5 Tx , i  0,1 ...,n, , де i - кількість дискретних значень швидкості приводу поступального руху, n - кількість    , Tx - тривалість роботи приводу поступального руху, яка    доп , t - крок дискретності задання часу, t i - i -тий момент часу, x дискретних значень швидкості  n     визначається з умови x max 45 Tx t x поч та х кін - початкова і кінцева координати приводу поступального руху, які відповідають початковому та кінцевому положенню захватного пристрою у глобальній системі координат; - для приводу обертального руху  t j    6t 2 t j  T  64qt j  32qT  32t jпоч  11Tкін  2 6 T 2 , UA 73997 U де j - кількість дискретних значень швидкості приводу обертального руху, k - кількість  T   , T - тривалість роботи приводу обертального руху, яка дискретних значень швидкості  k   t      визначається з умови max   доп , t j - j -тий момент часу, поч та кін - початкова і кінцева 5 координати приводу обертального руху, які відповідають початковому та кінцевому положенню захватного пристрою у глобальній системі координат, q - постійний коефіцієнт. 3 UA 73997 U 4 UA 73997 U 5 UA 73997 U Комп’ютерна верстка Г. Паяльніков Державна служба інтелектуальної власності України, вул. Урицького, 45, м. Київ, МСП, 03680, Україна ДП “Український інститут промислової власності”, вул. Глазунова, 1, м. Київ – 42, 01601 6