Научная статья на тему 'Метод інтерполяції дуги кола для систем програмного відтворення рухів'

Метод інтерполяції дуги кола для систем програмного відтворення рухів Текст научной статьи по специальности «Механика и машиностроение»

CC BY
311
60
i Надоели баннеры? Вы всегда можете отключить рекламу.

Аннотация научной статьи по механике и машиностроению, автор научной работы — Невлюдов Ігор Шакирович, Великодний Станіслав Сергійович

Pозглянуто створення нового методу інтерполяції дуги кола для систем відтворення рухів, що дозволяє реалізувати програмне керування рухом відразу за кожною прямокутною координатою переміщення робочого органу.

i Надоели баннеры? Вы всегда можете отключить рекламу.

Похожие темы научных работ по механике и машиностроению , автор научной работы — Невлюдов Ігор Шакирович, Великодний Станіслав Сергійович

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.
i Надоели баннеры? Вы всегда можете отключить рекламу.

Interpolation method of an arc a circle for systems of program reproduction movements

In the article the creation of a new interpolation method of an arc a circle for systems of reproduction movements is considered, which allows to realize a program traffic control simultaneously on each rectangular transition coordinate of a working organ.

Текст научной работы на тему «Метод інтерполяції дуги кола для систем програмного відтворення рухів»

Литература: 1. Swanson W.P. Calculation of neutron yields released by electron incident on selected materials // Health Physics. 1978. V. 35. P. 353-367. 2. International Atomic Energy Agency, IAEA-TECDOC-Draft, No3. Handbook on Photonuclear Data for applications. Vienna, 2000. 3. GEANT4 Physics Reference Manual, GEANT4 Working Group CERN (June 21, 2004). 4. Breismeister J.F. ed. MCNP - A General Monte Carlo N-Particle Transport Code. LA-13709-M. Los Alamos National Laboratory: Los Alamos, NM, 2000. 5. Rudyche Y., Dovbnya A., Prokhorets I., Prokhorets S., KhazhmuradovM. Applying of the program code for modeling of the subcritical assembly controlled by enlecron accelerator // Problems of Atomic Science and Technology. Series: Nuclear Physics Investigations. 2006. №2(46). P. 159161. 6. Degtyarenko P.V., KossovM.V. and WellischH.P. Chiral invariant phase space event generator, III Photonuclear reactions below ?(3,3) excitation // Eur. Phys. J. A 9. 2001.

7. Degtyarenko P. V. Applications of the photonuclear fragmentation model to radiation protection problems, in: Proceedings of Second Specialist’s. Meeting on Shielding Aspects of Accelerators, Targets and Irradiation Facilities (SATIF-2). CERN, Geneva, Switzerland, 12-13 October 1995. Published by Nuclear Energy Agency, Organization for Economic Co-operation and Development. 1996. P. 67-91.

8. Prokhorets I.M., Prokhorets S.I., Rudychev Y.V., KhazhmuradovM.A., Fedorchenko D. V. Questions of the effective methods choosing for neutron-physical processes simulation // Problems of Atomic Science and Technology. Series: Nuclear Physics Investigations. 2007. 9. WhiteM.C.

Development and Implementation of Photonuclear CrossSection Data For Mutually Coupled Neutron-Photon Transport Calculations in the Monte Carlo N-Particle (MCNP) Radiation Transport Code. LA-13744-T. Los Alamos National Laboratory: Los Alamos, NM, 2000.

Поступила в редколлегию 06.09.2007

Рецензент: д-р техн. наук, проф. Путятин Е.П.

Рудычев Егор Владимирович мл. научный сотрудник Национального Научного Центра Харьковский Физикотехнический институт. Научные интересы: радиационная безопасность, математическое моделирование, оптимизация комплексных систем. Адрес: Украина, 61108, Харьков, ул. Академическая, 1, тел. (057)335-65-94. e-mail: khazhm@kipt.kharkov.ua.

Прохорец Светлана Ивановна, мл. научный сотрудник Национального Научного Центра Харьковский Физикотехнический институт. Научные интересы: математическое моделирование. Адрес: Украина, 61108, Харьков, ул. Академическая, 1, тел. (057)335-65-94. e-mail:

khazhm@kipt.kharkov.ua.

Хажмурадов Манап Ахмадович, д-р техн. наук, профессор, начальник отдела Национального Научного Центра Харьковский Физико-технический институт. Научные интересы: математическое моделирование, оптимизация комплексных систем, альтернативные источники энергии. Адрес: Украина, 61108, Харьков, ул. Академическая, 1, тел. (057)335-68-46. e-mail: khazhm@kipt.kharkov.ua

УДК621.865.8:004.421

МЕТОД ІНТЕРПОЛЯЦІЇ ДУГИ КОЛА ДЛЯ СИСТЕМ ПРОГРАМНОГО ВІДТВОРЕННЯ РУХІВ

НЕВЛЮДОВ І.Ш., ВЕЛИКОДНИЙ С.С.______________

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

Вступ

Актуальність теми випливає з необхідності створення більш досконалих систем відтворення рухів (СВР: промислові роботи, автоматичні маніпулятори, верстати з ЧПК, контрольно-вимірювальні машини, динамічні іспитові стенди, радіотелескопи та ін. [1]) та, відповідно, розвитку досліджень в області синтезу ефективних алгоритмів програмного керування рухом виконавчих пристроїв, що реалізують просторовий рух за заданими траєкторіями.

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

Виконання поставленої мети забезпечується в роботі вирішенням таких задач:

- визначення відносної (рухливої) декартової прямокутної системи координат;

- вибір напрямку руху робочого органу (РО) маніпулятора за дугою кола і розрахунок довжини дуги у відносній системі координат;

- визначення відносних і абсолютних прямокутних поточних координат рухливої точки дуги кола.

1. Основні функції та типові режими рухів СВР

СВР є підсистемами автоматичних систем керування (СК) і відносяться до спеціального класу СК рухом промислових і спеціальних модулів зі складною кінематичною структурою [2].

Процеси відтворення рухів відбуваються в основних складових частинах СВР: пристрої керування, інформаційно-вимірювальній системі, виконавчих пристроях та в робочих органах об’ єкта керування. Процес відтворення рухів умовно можна розділити на два етапи:

1) вироблення впливів, що задають, по положенню, які забезпечують рух виконавчих механізмів по окремих координатах (або РО в цілому) за бажаною траєкторією з необхідними швидкостями та прискореннями;

2) відпрацьовування з необхідною якістю впливів, що задають, контурами положень, які включають в себе як складові частини виконавчі й робочі органи об’ єкта.

РИ, 2007, № 3

31

Однією з основних функцій СВР, що повинні бути реалізовані в процесі вироблення завдання, є перетворення впливів, що задають, які сформовані для окремих осей, з однієї системи координат в іншу [3]. Для багатокоординатних верстатів із ЧПК - це перетворення заданих рухів із системи координат, зв’язаної з деталлю, до системи координат верстата; для промислових роботів (ПР) - з абсолютної системи координат робота, жорстко прив’язаної до земної системи координат, у відносну систему координат, зв’язану із суглобами робота і РО. На цій же стадії процесу відтворення рухів пристрій керування повинен сформувати координати проміжних точок траєкторії заданої точки об’ єкта керування або проміжних положень вектора, що відповідає орієнтації РО або деталі. Ця задача вирішується на підставі інформації про координати початкової і кінцевої точок та у вигляді траєкторії або інформації про початковий та кінцевий напрямки вектора, що орієнтує. Це -процедура так званої інтерполяції в системах програмного відтворення рухів [4].

На другому етапі, тобто в процесі відпрацьовування впливів, що задають, повинні бути реалізовані такі основні функції: знімання інформації про лінійне або кутове переміщення по окремих координатах виконавчих і робочих органів об’єкта; формування керуючих впливів на виконавчі органи по окремих координатах руху об’єкта. Рішення останньої задачі ґрунтується на інформації про завдання і реальне положення об’єкта по окремих координатах; при цьому враховуються динамічні характеристики відтвореного руху, а також виконавчих і робочих органів об’єкта.

Види впливів, що задають, залежать від призначення і режимів роботи СВР.

Через різноманіття режимів роботи СВР вимоги до них різні. В одних випадках, наприклад, необхідне точне відпрацьовування сигналів, що задають, по окремих координатах руху РО, в інших - точне відтворення самої траєкторії, причому не тільки при русі з постійною контурною швидкістю V , але й з постійним контурним прискоренням v. В останньому випадку в ролі критерію якості використовується (замість погрішностей по окремих координатах, наприклад погрішностей є x та є у по площинних прямокутних координатах X та Y) контурна (траєкторна) погрішність 5 (рис. 1).

Рис. 1. Визначення траєкторної погрішності: РЗ(хЗ, уЗ), Рі(Хі, уі) - точки заданої та реальної траєкторії; V -траєкторна швидкість

Траєкторні погрішності, в зручному для практичного використання вигляді, можуть бути отримані лише для конкретних видів траєкторій, зокрема для прямої і кола [2]. Однак для більшості випадків застосування програмного керування рухом ПР таких траєкторій досить. В окремих випадках ці траєкторії зручно доповнити рухами по еліпсу і параболі n-го порядку.

2. Основні системи координат ПМ СВР

Більшість РО виконавчих пристроїв СВР із погляду класичної механіки відносяться до твердих тіл [3]. Тому рівняння рухів РО можуть бути записані відповідно до законів руху твердого тіла.

Відомо, що для завдання руху твердого тіла в просторі необхідно вибрати систему відліку, стосовно якого розглядається рух досліджуваного тіла. Для СВР, насамперед, для ПР та маніпуляторів, що містять багатоланкові маніпуляційні системи, характерна наявність декількох систем відліку (більш двох). З кожною системою відліку жорстко зв’язують яку-небудь систему координат, так що положення кожної точки тіла, що рухається, щодо обраної системи відліку можна однозначно визначити трьома координатами цієї точки.

Систему координат, пов’язану з основою (стійкою) ПМ, умовно назвемо абсолютною системою координат, оскільки така система відліку звичайно жорстко прив’язана до Земної системи координат. Відповідно, відносною системою координат назвемо систему координат, пов’язану з РО модуля.

Незважаючи на велику різноманітність кінематичних схем роботів і маніпуляторів, в механіці СВР як “абсолютні ” в основному застосовуються такі системи координат (рис. 2): права Декартова прямокутна, циліндрична і сферична [5]. Кожна точка М тіла, що рухається, у прямокутній системі координат має три поступальні (переносні) координати: х, у, z (див. рис. 2, а). У циліндричній системі координат положення точки визначається двома поступальними р, z і однією обертальною ф координатами (див. рис. 2, б). У сферичній системі координат точка визначається двома обертальними ф, 9 й однією поступальною r координатами (див. рис. 2, в).

Рис. 2. Основні системи координат: а - Декартова прямокутна; б - циліндрична; в - сферична

Зазначені координати будь-якої основної системи координат визначають три ступені свободи РО СВР, тобто задають положення якої-небудь точки РО, зок-

32

РИ, 2007, № 3

рема центра ваги - так зване макроположення РО. Для точного позиціонування РО, наприклад схопу, і орієнтування його щодо деталі необхідні ще три додаткові ступені свободи та, відповідно, три додаткові координати. Звичайно це три кути повороту прямокутної системи координат, “прив’язаної” до РО, - а, в, у (кути Ейлера [4]) щодо обраної точки макроположення, що вважається нерухомою.

3. Загальна характеристика методу інтерполяції

Метод розроблено стосовно задач програмного керування рухом РО робототехнічних комплексів і верстатів із ЧПК, призначених для зварювання, різання, пайки, нанесення покрить, розкрою, механообробки та інших технологічних операцій, виконуваних електричною дугою, лазерним променем, плазмою, пульверизатором, різцем і т.п. Метод призначено для розрахунку і відтворення координат поточної (робочої) точки траєкторії руху РО по дузі кола в абсолютній системі координат (АСК), пов’язаній з основою СВР, і у відносній системі координат (ВСК), пов’язаній з РО та обумовленій площиною, що проходить через три задані точки.

Метод дозволяє разом з розробленими програмами формування руху за прямою і перетворення систем координат реалізувати керування маніпуляційною системою різних СВР по кожній прямокутній координаті переміщення РО при інтерполяції довільно заданої траєкторії руху. При цьому точність відтворення визначається технологічними вимогами до якості виробу або операції та залежить від можливостей системи ЧПК і точності роботи електроприводів по кожній координаті [1]. Передбачається, що РО, наприклад зварювальна голівка робота, рухається по дузі кола з необхідною постійною швидкістю, проходячи послідовно через три точки, задані в АСК модуля.

4. Постановка задачі інтерполяції дуги кола

Для ПР і автоматичних маніпуляторів, що виконують зварювальні, фарбувальні, обробні та інші роботи, часто потрібно здійснювати рух РО (зварювальної голівки, фарбопульта, інструмента та ін.) по колу. Процес навчання такого СВР істотно спрощується, якщо його програмне забезпечення містить алгоритми, що дозволяють формувати сигнали керування для руху по дузі кола, заданій трьома точками в опорній системі координат модуля. При цьому звичайно потрібно, щоб РО модуля переміщався з необхідною швидкістю, проходячи послідовно через три задані точки.

Розглянемо рух РО СВР по дузі кола, заданій трьома точками з координатами ї 1= {x1, y1, z1}, г 2= ={х2, y2, z2} і r 3= {x3, y3, z3} у деякій нерухомій системі координат OXYZ (рис. 3), пов’язаній, наприклад, з основою робота, тобто АСК робота.

Для розкриття методу організуємо рух СВР по дузі кола стосовно двох постановок задачі (ПЗ):

Рис. 3. Завдання вихідних точок дуги кола в абсолютній системі координат робота

1. Організувати рух РО СВР по дузі кола з заданої початкової точки r1 у задану кінцеву точку r3 через задану точку r2 з постійною заданою кутовою швидкістю ю зад. Визначити необхідний час t переміщення РО за розрахованою траєкторією з точки r3 у точку r3.

2. Організувати рух РО СВР за дугою кола з заданої

початкової точки r1 у задану кінцеву точку r3 через задану точку r2 за заданий час ^ад. Визначити не-

обхідну постійну кутову швидкість ю переміщення РО з початкової точки r1 у кінцеву r3 .

Обидві постановки задачі припускають попередній розрахунок довжини l дуги кола і визначення поточних координат положення кінця РО в кожен заданий дискретний момент часу t, у процесі руху.

Для реалізації руху з заданою швидкістю ю або за заданий час ^ад зв ’яжемо з вихідними точками r1, r2, r3 плоску систему координат: OXY, яка лежить у площині кола і початок якої збігається з центром кола, що проходить через ці точки. Назвемо цю систему координат відносною системою координат.

Можна визначити такий алгоритм формування поточних координат руху РО за дугою кола:

Крок 1. Задати відносну систему координат OXYZ.

Крок2. Визначити поточні координати точки руху х;, У,, z, у ВСК.

Крок 3. За допомогою матриці T перетворення систем координат знайти поточні координати точки руху х,, у,, z, в опорній системі координат - АСК: OXYZ.

5. Перетворення систем координат

Для того щоб задати відносну систему координат

OXY Z, необхідно визначити координати її початку -точки r = {х0, у0, z0} центра кола, що проходить через три вихідні точки r1 , r2 і r3 та лежить у площині, що проходить через ці точки (рис. 4).

Визначивши r, задамо систему координат OXYZ у такий спосіб. Початок координат помістимо в точку ?о = {хо, у о, zo} . Вісь OX проведемо через точку Г1. Нехай вектор r0r1 буде напрямним для осі OX .

РИ, 2007, № 3

33

Запишемо матрицю A у розширеному вигляді, з представленням її в однорідних координатах:

T =

t„ t

О

13 X0

22 t23 Уо

32 L33 Z0

,, ,2

t2, t

t3, t32 t

0 0 0

1

Тоді перетворення (2) прийме вигляд: ? = T г ,

(4)

(5)

Вісь OZ проведемо через точку г0 перпендикулярно до площини, що проходить через вихідні точки г,, г2 і г3. Вісь OY повинна бути перпендикулярною до площини, утвореної осями OX і OZ , і проходити через точку г0. Тому вісь OY може бути задана як лінія перетинання двох ортогональних площин: XOY і ZOY . При цьому необхідно стежити за тим, щоб система координат OXY Z, так само, як і АСК OXYZ, була правобічною, що визначається напрямком осі Oy (див. рис. 4).

Нехай х, у, z і x, у, z — координати однієї і тієї ж поточної точки r дуги кола щодо двох різних однобічних Декартових систем координат OXYZ і OXY Z. Нехай, при цьому, система координат OXYZ розташована щодо системи OXYZ таким чином, що вісь Ox має направляючі косинуси: t11, t21,t31; вісь Oy : t12, t22, t23 ; вісь OZ : t13, t23, t33. Тоді щодо системи координат OXYZ вісь OX має направляючі косинуси: t11, t12, t13; вісь OY: t21, t22, t23; вісь OZ: t31, t32, t33. Якщо початок r0 системи координат OXYZ має в системі координат OXYZ координати x0, y0, z0, то перетворення відносних координат x, y, z точки

де T - матриця перетворення прямокутних систем координат (або матриця стану РО СВР).

Із отриманих співвідношень випливає, що, задавши в ВСК OXYZ рух точки і визначивши її координати в системі OX YZ, можна за допомогою перетворення (5) визначити координати цієї точки в АСК - OXYZ. Таке перетворення являє собою рішення зворотної задачі кінематики СВР. Крім рішення такої задачі, тобто переходу від відносної системи координат OXYZ до абсолютної OXYZ, необхідно вирішити і пряму задачу кінематики СВР. Для цього визначимо матрицю T -1 прямого переходу від системи OXYZ до

системи OXYZ за формулою:

T-1 =

AT

000

- ATC 1

(6)

де Г0 = [х0, у0, z0]T, Т - умовна позначка операції транспонування матриці (вектора). Тоді перетворення абсолютних координат точки руху у відносні координати прийме вигляд:

г = T -1Г .

Розглянемо складові матриці T -1:

(7)

АТ =

t11 t 21 t31

t12 t22 t32

t13 t23 t33

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

руху дуги кола в абсолютні координати х, у, z мають C12 _ (t11X0 + t2ly0 + t31z0)

такий вигляд: - AT1 =- C21 = _ (t12X0 + t 22У 0 + t32z0)

л А л C31 _ (t13X0 + t23y0 + t33z0)

X = t11 X + t12 У + t13 z +X0,

У = t21 х + t22 У + t23 z +У0 ,

z = t31X + t32 У + t33z +z0, або в матричній формі

r = А г + ?0,

(1)

(2)

де A - матриця направляючих косинусів (або матриця обертання):

A =

t11

t2

t12 t1

12 13

21 t 22 t23

t31 t32 t

33

(3)

(8)

(9)

Для перевірки абсолютної й відносної систем координат на однобічність досить знайти визначник матриці A:

det A _ t11 (t22t33-t32t23)-t12(t21t33-t31t23) + t13 (t21t32-t22t31); (10)

при цьому detA= 1, якщо прямокутні системи координат однобічні (обидві правобічні або обидві лівосторонні), та detA= -1 - у протилежному випадку.

6. Розрахунок довжини дуги кола

Обидві постановки задачі інтерполяції (див. розд. 4) припускають попередній розрахунок довжини l дуги кола. Для розрахунку довжини дуги необхідно знати

34

РИ, 2007, № 3

її центральний кут. Значення цього кута знайдемо як

кут Піз між векторами ГоГі і ГоГз. Знаючи координати довжини і скалярний добуток цих векторів, можна визначити і косинус кута між ними:

(Го Гі)(Го Гз)

cos П13 =-=^-=г- ,

___„ | Го Гі || Го Гз |

де ГоГі = {Хі - Хо,Уі - Уо, Zi - Zo},

Го Г, = {Хз - Хо,уз- Уо, Z3 - Zo};

| Го Гі \=^ (Хі - Хо)2 + (Уі - Уо)2 + (Zj - Z0)2

(іі)

(і2)

|ГоГз (Хз - Хо)2 + (Уз - Уо)2 + (2з - z»)2. (із)

Звідси з урахуванням, що відносні координати

Хо = Уо = Zq = о, одержимо

TOS Піз =

ХіХз + УіУз + Z1 zз

/Л 2 Л 2 л 2 д

Pi + Уі +Z! Р

2 л 2 л 2 /л 2 л 2 л 2 ' ' Z1 \Хз + Уз + Z3

(і4)

де соs піз - косинус кута, центрального для дуги гігз . Крім кута піз необхідно знайти і центральний кут Пі2

між векторами Го Гі і Го Г2 , знання значення якого дозволить вибрати „ вірний ” напрямок (за годинниковою стрілкою або проти годинникової стрілки) руху РО по дузі кола: від точки гі до точки гз суворо через точку г2 . Аналогічно (і4) знайдемо

соs пі2 =

Хі Х2 + УіУ2 + Z1Z2

/Л 2 Л 2 л 2 /л 2 л 2 л 2

Vх! + Уі + Z1 VX2 + У2 + Z2

(і5)

де cos И12 - косинус кута, центрального для дуги г1гз. Знаючи косинус центрального кута, можна визначити

і сам центральний кут. Точки Гі і Гз можуть знаходитися у будь-яких чвертях системи координат OXY, значить, використовуючи тригонометричні формули приведення, кути n12 і піз будемо обчислювати за такими узагальненими формулами:

1. Якщо cos nij > 0 і Xj > 0, > 0, то

|і - COS2njj

nij = arccos (cosnij) = arctgJ cos2nj , j = 2,з.(16)

2. Якщо cosnij < 0 і Xj < 0, У j > 0, то

|і - cos2njj

nij = р - arccosjcosnij |= р - arctgJ cos2n , j = 2,з.

(17)

з. Якщо cosnij >0 і Xj > 0, ^j < 0, то

11 - cos2n!j

nij = р +arccos|cosnij!= р + arctg J cog2n^ ,j = 2, з.

(18)

4. Якщо cosnij > 0 і Xj > 0, У < 0, то

|і - cos2njj

nij = 2р - arccos(cosnij) = 2р - arctgJ cos2,v , j = 2, з.

(19)

Аналізуючи значення центр альних кутів n 12 і n із, вибирають „ вірний ” напрямок руху РО по дузі кола: за годинниковою стрілкою або проти неї.

Помітимо, що у математиці позитивним вважається центральний кут, відлічуваний точкою, що рухається проти годинникової стрілки, а негативним - за годинниковою. У розглянутому випадку, коли напрямок руху РО СВР за дугою кола обрано, для розрахунку довжини і ij дуги значення має лише абсолютна величина центрального кута п^, а не його знак. Тому незалежно від напрямку руху РО кут пц будемо вважати позитивним та для його обчислення застосовувати таке правило:

1) якщо при обраному русі проти годинникової стрілки РО знаходиться у I чверті площини XOY або при обраному русі за годинниксзвоіо стрілкою РО знаходиться у IV чверті площини XOY, то для обчислення кута nij варто скористатися формулою (16);

2) якщо при русі проти годинникової стрілки РО знаходиться у II чверті або при русі за годинниковою стрілкою РО знаходиться у III чверті, то для обчислення кута nij варто скористатися формулою (17);

3) якщо при русі проти годинникової стрілки РО знаходиться у III чверті або при русі за годинниковою стрілкою РО знаходиться у II чверті, то для обчислення кута nij варто скористатися формулою (18);

4) якщо при русі проти годинникової стрілки РО знаходиться у IV чверті або при русі за годинниковою стрілкою РО знаходиться у I чверті, то для обчислення кута nij варто скористатися формулою (19).

Отримана величина кута пц (j = 2, з) буде обчислена у радіанах [рад]. Для перекладу її в кутові градуси [кут.град] можна скористатися формулою:

180 • n1j

пц,у.г. =—П— [кут.град], j=2, з. (20)

Тоді довжина І ц дуги кола розраховується за формулами:

I ij = R'nij [ум.лін.од.], j = 2, з (21)

або

і ij

R • nUy r. • П 180

[ум.лін.од.], j=2, з,

(22)

де R=| Го Гі |=| Го Г21=| Го Гз | - радіус кола, ум.лін.од.

РИ, 2007, № з

з5

7. Визначення поточних координат положення РО СВР на дузі кола

Розрахувавши довжину £ 13 дуги, що описує РО СВР при русі по колу, нескладно визначити поточні координати положення кінця РО на кривій, у кожен заданий дискретний момент часу t;, у процесі руху. Для цього необхідно виконати такі дії:

1. Визначити час t, за який РО опише шукану дугу:

Гіг,;

t = [а], (23)

Юзвд

де юзад - задана постійна кутова швидкість руху РО, рад/а (див. розд. 4, П3=1); або визначити необхідну постійну кутову швидкість w переміщення PO по дузі

ГіГз

Піз г

w= t [рад/с], (24)

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

^зад

де і^ад - заданий час, за який PO описує шукану дугу

хі = R • cos ф (t;),

y; = R • sin ф (ti), (29)

zi = 0 Vi = 0^N.

Рис. 5. До визначення відносних поточних координат положення РО на дузі кола

6. При заданій матриці стану РО Т визначити на підставі перетворення (5) поточні абсолютні координати положення кінця РО на дузі кола в кожен заданий дискретний момент часу ti:

Гі г,, с (див. розд. 4, П3=2).

2. Визначити необхідний дискретний крок At за часом t (або по 1зад) руху РО по дузі кола і задати дискретні моменти часу ti:

Хі = tiiXi + ti2 Уі + ti3 yi = t21 Xi + t22 yi + t23 Zi = t3iXi + І32Уі + t33

Zi + X0

Zi + Уо,

Zi + Z0,

i = i Vi = 0, N.

(30)

At = — [СІ або At = — [cl; (25)

N 11 N L J

t; = t;-i+ At [а] або t; = Д t i [c] V i=i, N ; t0=0, (26)

де N - задана кількість інтервалів дискретизації за часом, що повинна знаходитися у межах: i0 < N < 2i 600. У перерахуванні в кутові одиниці виміру мінімальний крок по дузі I i3, рівній довжині кола, складає: Д і i3=i кут. хв = 60 кут. с.

3. Визначити збільшення Дф кута (р (t) на одному інтервалі дискретизації Д t:

Аф = юзвдДі \раd або Аф = raAt \рад\ . (27)

4. Визначити поточні значення кута ф(р) в дискретні моменти часу ti:

ф( t;) = ф( t; _i) + Дф [ рад]

або ф( t;) = Дф- і [ рад] Vi = i,N; ф( to ) = 0.(28)

5. При заданому постійному радіусі R дуги ц г3 кола визначити поточні відносні координати положення кінця РО СВР на кривій у кожен заданий дискретний момент часу t;, що можна зробити шляхом перетворення полярної системи координат у прямокутну ВСК

OXYZ (рис. 5):

Висновки

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

При вирішенні задач, поставлених безпосередньо перед виконанням роботи, була досягнута мета дослідження: сформувати новий метод опису траєкторій руху.

У результаті досліджень розглянуто: основні функції та типові режими рухів СВР, основні системи координат ПМ СВР, загальну характеристику методу інтерполяції' дуги кола, перетворення систем координат, розрахунок довжини дуги кола, визначення поточних координат положення РО СВР на дузі кола.

Наукова новизна отриманих результатів: вперше про -цес «навчання» СВР істотно спрощується, якщо її програмне забезпечення містить алгоритми, які розроблені на підставі методів, що дозволяють автоматично формувати сигнали керування виконавчими пристроями, які реалізують рух РО СВР за заданою просторовою тр аєкторією.

Практична значущість отриманих результатів. При практичному застосуванні математичного забезпечення вихідні дані можуть бути задані в результаті роз-

в’язання зворотної задачі кінематики або визначені інженером-технологом аналітично, але з передбаченими необхідними перевірками умов коректності зав-

36

РИ, 2007, № 3

дання вихідних точок та умов фізичної реалізації сформованої траєкторії руху РО СВР. Метод може бути використано при викладанні відповідних дисциплін у вищих навчальних закладах ІІІ -IV рівнів акредитації, зокрема на факультеті ЕА ХНУРЕ при проведенні лабораторних і практичних робіт з дисциплін за напрямом «Робототехніка». Також практичні результати можуть бути використані у цехах із верстатами з ЧПК і промисловими роботами на Харківському заводі підйомно-транспортного обладнання, заводі «Комунар» та на ХДПЗ ім. Т.Г. Шевченка.

У порівнянні з існуючими аналогами [4, 6 - 8] цей метод може дозволити реалізувати програмне керування рухом відразу за кожною прямокутною координатою переміщення РО. СВР, що містять програмне забезпечення на основі поданого методу, можуть значно швидше виконувати розрахунок відповідної траєкторії руху поточної робочої точки у просторі та забезпечити найвищу точність опису тр аєкторій.

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

Література: 1. Великодний С.С. Аналіз динамічної точності дволанкового маніпулятора промислового робота // Автоматизированные системы управления и приборы автоматики. 2005. № 130. С. 82-85. 2. Худяєв О.А., Прокопенко О.О., Великодний С.С. Алгоритмічні та програмні засоби автоматизованих систем керування. Харків: УТПА, 2006. 120 с. 3.ХудяевА.А. Кинематика систем воспроизведения движений. Харьков: УИПА, 2000. 132 с. 4. Юревич Е.И. Основы робототехники, 2-е издание. Санкт-Петербург: БХВ- Петербург, 2005. 416 с. 5. Костюк В.І.,Спину Г.О., Ямпольський Л.С. Робототехніка. Київ: Вища школа, 1998. 448 с. 6. Олссон Г., Пиани Дж. Цифровые системы автоматизации и управления. Санкт-Петербург: Невский Диалект. 2001. 557 с. 7. Дорф Р., Бишоп Р. Современные системы управления. Москва: Лаборатория Базовых Знаний. 2002. 832 с. 8. Yim Y., Zhang Y., Daff D. Modular Robots // IEEE SPECTRUM. 2002. № 2. P. 30-34.

Надійшла до редколегії 20.09.2007

Рецензент: д-р техн. наук Дубровський В.В.

Невлюдов Ігор Шакирович, д-р техн. наук, професор, завідувач кафедри ТАВР ХНУРЕ. Наукові інтереси: автоматизація технологічних процесів у радіоелектронному приладобудуванні. Адреса: Україна, 61000, Харків, пр. 50-річчя СРСР, б. 16, кв. 473, тел. 702-14-86 (роб.), 778-77-44 (дом.).

Великодний Станіслав Сергійович, магістр, асистент кафедри ТАВР ХНУРЕ. Наукові інтереси: робототехніка, електропривод. Захоплення та хобі: туризм та вивчення філософських праць. Адреса: Україна, 61204, Харків, пр. Л. Свободи, б. 46, кв. 292, тел. 337-14-70 (дом.), 8-097-950-0274 (моб.).

УДК618.514.01:517.977.5

ГАРМОНИЧЕСКИЙ ОСЦИЛЛЯТОР КАК ОБЪЕКТ УПРАВЛЕНИЯ В ЗАДАЧЕ ДИНАМИЧЕСКОГО СИНТЕЗА. I

РАДИЕВСКИЙ А. Е.__________________________

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

1. Введение

Развитие механики тесно связано с изучением маятника и маятниковых систем. За более чем 300 лет, прошедших со времени, когда Галилей обратил внимание на изохронность колебаний маятника, ни одной механической системе не было уделено столько всестороннего теоретического внимания, как маятнику^]. Маятник и маятниковые системы постоянно привлекали к себе внимание исследователей в различных областях математики, механики, физики и техники. Уравнение движения маятника является одним из фундаментальных, описывает широкий класс колебательных процессов. В силу своей простоты маятник служил хорошей моделью для изучения сложных динамических процессов [2], что позволяло проводить экспериментальную проверку различных теоретически обнаруженных колебательных эффектов, значительно расширить область применения маятни-

РИ, 2007, № 3

ковых моделей для математического описания колебательных процессов[3]. Одной из разновидностей многообразия моделей маятниковых систем является математическая модель гармонического осциллятора.

Интересс к изучению названной модели объясняется тем, что, с одной стороны, можно провести исследования общетеоретических положений[4], а с другой -возможно их использование при изучении конкретных маятниковых систем (например, проблематика стабилизации положения плазменного шнура[5], движение вращающегося в пространстве тела с одной осью симметрии[6] и др.).

В настоящей работе в классе задач аналитического конструирования оптимальных регуляторов (АКОР) исследуется линейная модель гармонического осциллятора без демпфирования как обьекта управления (ОУ).

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

2. Постановка и особенности задачи

На движениях ОУ

dx

dt 1 ;

необходимо определить алгоритм управления (АУ), который доставляет экстремум критерию качества

37

i Надоели баннеры? Вы всегда можете отключить рекламу.