CC BY
80
УДК 693.54 ББК 38.626
П-18
Паршин Дмитрий Яковлеви, доктор технических наук, профессор, профессор кафедры «Электротехника и автоматика» Ростовского государственного строительного университета, т.: 89185086649, e-mail: d. [email protected];
Барщенков Антон Александрович, аспирант кафедры «Автоматизация и электропривод станочных систем» Донского государственного технического университета, e-mail: [email protected];
Сморгунова Марина Васильевна, преподаватель кафедры строительных и
общепрофессиональных дисциплин ФГБОУ ВПО «Майкопский государственный технологический университет».
АВТОМАТИЧЕСКОЕ УПРАВЛЕНИЕ БЕТОНОУКЛАДЧИКОМ МАНИПУЛЯТОРОМ
(рецензирована)
В статье изложены особенности и принципы управления бетоноукладочными
манипуляторами. Сформулирован общий подход к построению кинематических и динамических моделей бетоноукладочных манипуляторов с учетом податливости звеньев. Рассмотрены особенности построения математических моделей манипуляторов с гидроприводами, а также сформулированы принципы планирования траекторий движения бетоноукладочных манипуляторов. Представлена структура устройства управления гидроприводами манипулятора.
Ключевые слова: бетонные работы, манипуляторы, автоматизация, управление движением, математические модели, гидропривод.
Parshin Dmitry Yakovlevich, Doctor of Technical Sciences, professor, professor of the Department of Electrical Engineering and Automation, Rostov State University of Civil Engineering, tel: 89185086649, e-mail: dparshin @ mail.ru;
Barschenkov Anton Alexandrovich, post graduate student of the Department of Automation and Machine Tools of the Don State Technical University, e-mail: fma.anton @ mail.ru;
Smorgunova Marina Vasyljevna, lecturer of the Department of Construction and General Professional Disciplines of FSBEIHPI "Maikop State Technological University".
AUTO CONTROL OF PAVER MANIPULATOR
(reviewed)
The article describes the characteristics and principles of paver manipulators. A general approach to the kinematic and dynamic models of manipulators considering compliance of units has been formulated. The features of the mathematical models of manipulators with hydraulic drives have been considered and principles of planning trajectories of the concreting manipulators have been defined. The structure of the control unit of hydraulic actuators of the manipulator has been presented.
Keywords: concrete works, crams, automation, motion control, mathematical models, hydraulic drive.
Главным направлением повышения эффективности бетонных работ является внедрение комплексной механизации и автоматизации на основе использования достижений робототехники и микропроцессорной техники. Высокие
t s3 экономические показатели определяют использование для
распределения и укладки бетонной смеси шарнирно-
распределительных стрел.
\ s2 Анализ приведенных структур бетоноукладочных
манипуляторов показал, что наибольший интерес представляют многозвенные стрелы-манипуляторы с гидроприводом, наиболее полно отражающих особенности и требования выполняемых операций (рис. 1). Структурной особенностью таких манипуляторов является наличие ветвящихся структур, обеспечивающих
наилучшие кинематические и динамические характеристики.
Рис. 1 - Бетоноукладочная стрела-манипулятор
Использование гидроцилиндров в приводных механизмах этих манипуляторов нарушает обычную цепочную структуру их построения. При проектировании таких манипуляционных механизмов следует проводить оптимизацию соотношения параметров кинематических структур, обеспечивающую получения квазилинейных характеристик: qi = ^); si = 2^).
Особенностью математических моделей строительных роботов является необходимость учета упругих деформаций звеньев, возникающих при воздействии динамических и ветровых нагрузок. В соответствии с принципом конечных разбиений такие манипуляторы можно рассматривать как совокупность последовательно упруго соединенных жестких тел. При переходе к такой структуре для деформируемых звеньев определяются точки, наиболее критичные к деформации (ТКД), которые характеризуются максимальным значением отношения предельного напряжения вдоль траектории движения к удельной деформации материала элемента конструкции. В этой точке звено манипулятора разбивается на два тела, соединенные шарниром. Введение в модель фиктивных степеней подвижности позволяет учесть смещения, обусловленные наличием упругих деформаций. В динамическую модель добавляются уравнения для обобщенных сил фиктивно введенных звеньев, параметры которых идентифицируются для наибольшего соответствия математической модели реальному объекту. Если не удается получить заданную точность модели, то производится поиск еще одной ТКД с последующим введением в модель дополнительной фиктивной степени подвижности.
В соответствии с изложенной концепцией учета упругих деформаций представим конструкцию манипулятора в виде четырех упругих звеньев, соединенных шарниром и жесткого пятого звена (рис. 2а). Так как основной нагрузкой манипулятора являются силы тяжести элементов и находящегося в системе раствора, то предельные напряжения возникают в основаниях звеньев, в местах крепления гидравлического привода. Учитывая это, произведем разбиение упругих звеньев на составляющие и
добавим в точках разбиения фиктивные степени подвижности д7— д10, показанные на структурной схеме модели бетоноукладочной стрелы (рис. 26).
Яъ’Чъ
(а) (б)
Рис. 2 - Структурные схемы манипулятора: а - исходная; б - с фиктивными степенями
подвижности
Для удобства математического описания обобщенные координаты манипулятора разделяются на управляемые д ' = (д\,д2,д3,д4,д5,д6 Г и обобщенные координаты, описывающие деформацию
элементов стрелы д" = (д7,д8,д9,д10 )г, при этом д = д 'ид ". Произведя разделение на управляемые и неуправляемые обобщенные координаты, получаем уравнения кинематической модели для скоростей и ускорений в виде:
х = О' (д,Ах)-д' + О" (д,Ах)-д "; х = О'(д,Ах)-д" + О" (д,Ах)-д" + О(д,д,Ах)-д, где О'(д,Ах), О" (д,Ах) - матрицы преобразований систем координат; Ах - вектор координат конечного звена.
Для получения полной математической модели бетоноукладочного манипулятора с гидроприводами необходимо рассмотреть построение кинематической и динамической моделей механизмов привода с гидроцилиндрами. Кинематические модели рассматриваемых структур должны содержать уравнения связи обобщенных координат qi с перемещениями гидроприводов si: qi = ^^), которые позволяют устанавливать зависимости между векторами х е 5 : х = /2(ё).
Для рассматриваемых структур искомые функции qi = легко получить на основе геометрического подхода. Для кинематической структуры гидропривода первого типа (рис. 3а) обеспечивающей подъем и опускание стрелы, эта взаимосвязь описывается уравнением вида:
д(5) = /Ъ) + агссо/Г1^ +1^ — 52 |/(2^^)) + агй^е/ й) — я,
где a, Ь, c, d, є — конструктивные параметры; іі = Vа2 + Ъ2, 12=л/С2 + в2 - межосевые расстояния.
Данный тип структуры в первую очередь относится ко второй степени подвижности, где для удобства отчета обобщенной координаты q2 удобно использовать угол у, равный у = 0 + п/2 - аг^^а/С). В этом случае обобщенная координата связана с перемещением привода
зависимостью:
(а
q(s) = arctga / b) + arccoS((/12 +/f — s2
)/(2/l/2 ))
— n/2
Рис. 3 - Расчетные схемы бетоноукладочного манипулятора с гидроприводом
Решение обратной задачи о положении для рассматриваемой структуры гидропривода на основе геометрического подхода включает уравнение связи si = /2^), вида:
s(q) — (/j2 +12 + 2/1/2 cos(0 — a — (p)-
Аналогичным образом находятся уравнения связи обобщенных координат qi с перемещениями гидроприводов si: qi = f2(s,) для кинематических структур второго типа (рис. 3б), представляющих собой цепь Витта, с последовательно соединенными трех- и четырехзвенниками. Эти соотношения получаются путем предварительной записи выражений:
<Pii(s) = Z0u02i03i = arcco^a2- + -sf )/2a0iau);
<?2i (s) = z0i02i04i =к + а0 +4 - (рь (s) ;
^2i (s) = ZO2i°i°5i = arcco
V
^ di + boi — b1j- ^ 2b0idi ,
где dt (s) = yjbO + bl2 — 2 • bob cos(^i (s)).
+ arccos
(df + b2 — b2V
V
2b3idi
Используя эти выражения, записываются уравнения связи для обобщенных координат:
Ч/ О) = «1/ + «4/ -л + Фъ/ (X) •
Для получения полных кинематических моделей рассматриваемых структур необходимы уравнения для скоростей и ускорений. Угловые и линейные скорости перемещения 1-го звена выражаются через скорости 1-1-го звена:
ю,
= Юі—1 + (l — % ')eiqi ; vi = vi—1 + ю—1 x Г;—ц + et • q',
где Г—1 г - вектор, соединяющий оси степеней подвижности 1-1 и 1-ой; £. - логический коэффициент, описывающий тип кинематической пары: вращательная - £ = 0, поступательная
- £ = 1.
Используя теорему Кориолиса определяются линейные и угловые ускорения:
£/ = Ё/-1 + (1 - £ )• Щ X е • д" +(1 -£ )• ^ Ч ;
а = а-1 + Ё-1 х Г/-и + Щ-1 х (щ-1 х Г/-и )+£/ •е •д" + 2£ •Щ х е •д" ,
где е-1 , аг-1 , е;, а1, - вектора угловых и линейных ускорений 1-1 и /-го звена манипулятора.
Линейные и угловые скорости как функций обобщенных скоростей и обобщенных координат записываются в виде:
П П
Щг = X Щ/д} ; Vг = X ^7д"- ;
7=1 7=1
п
= X (1 - £г )ё7 ; Щ х ги + £7е7 •
7=1
Аналогичным образом можно записать конечные выражения для ускорений:
п п
е = х(щгд” +(х(ЩхЩ)дк)д7) •
7=1 к=1
Описание обобщенных скоростей и ускорений манипулятора удобно представить в виде векторно-матричного уравнения:
г = Ц •г = ^{^
Продифференцировав это выражение, получим уравнение связи для ускорений:
д" = кР" + (кд ) "* " = к‘Р" + ^ | •(* ")2 •
Для структурной схемы первого типа (рис. 3а) уравнения связей обобщенных и приводных скоростей представляются в виде:
я" (*’ )= О*) • * =
(4/,2/| -(/,2 + /22 -*2)2)1/2
* "(я ') = к|»(д) • д' + Р~ д) •д'
8 (/^ + /| + 2/1/2 соБ(д - а - р)1/
1 + /^2 + 2/1/2 соэ(д - а ■
Аналогично могут быть записаны уравнения связей обобщенных и приводных скоростей для структурной схемы второго типа (рис. 3б):
д"(* ") = кГ (*> " ; * " (д") = к8(1) (я) я" •
Построение динамической модели манипулятора лучше выполнять на основе уравнений Лагранжа. Проведя разделение обобщенных координат на управляемые д' и введенные для имитации упругой деформации д", уравнение динамики представляем в виде:
М " = Ъ ' (д)д ' + Ъ (д)д " + Ь ' (д,д);
М " = Ът (д)д ' + Ъ " (д)д " + Ь " (д,д), где М' - ообобщенные силы, создающиеся приводами; М" - обобщенные силы, имитирующие упругие смещения; Ъ'(д), Ъ(д), Ъ"(д) - матрицы динамики; Ь(д,д) - вектор кориолисовых и центробежных сил.
Для бетоноукладочного манипулятора с замкнутыми кинематическими цепочками гидроприводов баланс виртуальных сил равен:
X X \rniv ^ - §)&п +(Iг■vег■v х 1 }5У V }= X ,
г=^=0 г=1
где г - орт-вектор звена г с массой т и моментом инерции J в точке тяжести; § - вектор
гравитационного взаимодеиствия; т - приводнои момент сил привода в i-м звене.
На основе этого уравнения можно получить различные выводы динамических уравнении манипулятора. Так для виртуального представления передвижения звеньев манипулятора, уравнения динамики следует представить в виде:
n n
Z Z imkvVkv(rkv - g)+ (їkv^kv + <°kv X 1 kiv^iv )&kv}= ZTk&lk .
k=1v=0 i =1
Для управления привода это уравнение необходимо преобразовать в координаты привода. Для их получения следует воспользоваться уравнениями баланса виртуальной работы в шарнирных координатах и уравнениями связи обобщенных координат и координат привода. В результате получим динамические уравнения в координатах привода:
M(s)s + h(s,s) + g(s) = Fa , где M(s) = k'M(q)k' + h(s,s) + g(s), h(s,s) = k'M(q)k'i2 + k'h(q,q) = k'M(q)k'i + k'h(q,q), g(s) = k^g(q) .
Планирование траекторий движения бетоноукладочных манипуляторов определяется формой и планом возводимых зданий и сооружений. Задача построения траекторий движения сопла бетоноукладочной стрелы, сводится к описанию последовательности движений в плоскости XnYn параллельной плоскости XqYq системы координат манипулятора. Координата zn в пределах одного цикла укладки не меняется, а затем увеличивается на величину ЛИ, соответствующую шагу подъема опалубки. На рисунке 4 приведены примеры наиболее часто возводимых монолитных объектов, представляющие собой набор прямоугольников, либо окружностей. При возведения каркаса жилого дома (рис. 4а) необходимо на основании плана здания сформулировать массив координат точек P1,P2,..P10 и определить последовательность обхода прямолинейных участков Pi ^Pj . Каждый
участок описывается уравнениями вида:
- для участков параллельньк оси хо ^рн (Xjн,^Ун),pjK (xjK,yjK), y = у^ y^ ^ Xj-н < x < xjK;
- для участков параллельн^іх оси Го ^ рш (xm, ун ),рк (xK, уж ), x = XinV XiK ^ уш < y < УіК .
Рис. 4 - Планы монолитных объектов и траекторий укладки бетона
Планирование движений выполняется в обобщенных координатах на основе временного закона их изменения, формируемого для каждого /-го участка траектории д/(і) = \д1і(і),д2/(і),---уЧт(^)]. При этом основой для их формирования служат временные законы изменения положения и ориентации сопла и скорости его перемещения, которые описываются системой уравнений:
Щ (і) = [Х (і), Уі(і), (і )]
V (і) = Ухі(()^уі (і>?і (Оі
V (і) = Ь і (*),Фі (і ),Рі (і )і
©і (ї) = [юа (ї),Ю^.(ї),Ю^. (0І
где Щ (í),vi (і) - вектора положения и скорости в текущий момент времени і при движении на /-ом
участке траектории; ^ (і),юг (t) - вектора ориентации и угловой скорости на /-ом участке в момент времени Ї.
В случае прямолинейного участка траектории перемещение сопла при его равномерном
движении со скоростью vi = |у
v V
хг> Ууг> уп
] описывается вектором:
іг (і) =
Хі + Vxгt
У і + Vyгt г + ч„л
, уёг, гёг - координаты конечной
^ У г ^ Уг ^ Уёг ,
г ^ гг ^ гёг
где х{ г ,у{ г^ г - координаты начальной точки траектории; хёг. точки траектории.
Управление движением сопла бетоноукладочного манипулятора по заданной траектории с требуемой скоростью осуществляется путем управления гидроприводами. Непременным условием управления положением поршня с подчиненным контуром регулирования является возможность непосредственного измерения одной или нескольких вспомогательных переменных. Для бетоноукладочных роботов в первую очередь следует стабилизировать рабочее давление. В качестве вспомогательной переменной удобно использовать усилие привода Е^в = 8[Ргд. Пренебрегая вязким
трением в силу его малости по сравнению с силой сухого трения, уравнение динамики линеаризованного гидропривода с контуром регулирования давления записывается в виде:
= КзадЛи _ КзадКвоз (Тг5 + 1)Л^н
(
1
\
Использование отрицательной обратной связи по нагрузочному давлению позволяет улучшить демпфирование привода, не оказывая при этом влияния на характеристическую частоту контура и коэффициент усиления. Получить желаемые динамические характеристики гидропривода бетоноукладочного манипулятора позволяет введение в структуру управления ПИД-регулятора. Структурная схема звена манипулятора с гидроприводом, снабженным подчиненным контуром регулирования давления и ПИД-регулятором представлена на рис. 5.
ПИД-регулятор
к1+ки + —
УМг
и
Рис. 5 - Структурная схема гидропривода с ПИД - регулятором и контуром регулирования давления
Используя закон управления ПИД-регулятора и уравнения динамики привода записываем передаточные функции гидропривода по задающему и возмущаещему воздействиям:
пг с-л — Х (5) - (К5 + К5 + Ки ) •
"зад(5) = , . = , . ’
Муп(5) Я(5)
Ш Х (5) - 5 '(Гг 5 + КгпКрд + і)
BOЗ К (5) а (5) .
где Кп, Кд, Ки - коэффициенты передачи ПИД-регулятора по пропорциональной, дифференциальной и интегральной составляющим.
Главная проблема при управлении бетоноукладочными роботами с гидроприводом заключается в
неопределенности параметров. Поэтому представляет интерес использование управления по положению с предварительной компенсацией динамики робота. Управление реализуется по принципу децентрализации с регулированием действующих между степенями подвижности динамических сил, обусловленных моментами инерции, кориолисовыми моментами и гравитационными силами. Для получения лучших динамических характеристик бетоноукладочных роботов при движении вдоль референсной траектории на основе динамической модели вычисляются корректирующие воздействия для каждой обобщенной координаты. Необходимые усилия перемещения приводной системы манипулятора, обеспечивающие движения по заданной траектории с определенной скоростью, задаются управляющими воздействиями, которые вырабатывается компенсирующим устройством. Они могут быть легко получены на основе использования линеаризованной модели приводной системы.
Литература:
1. Воробьев Е.И. Механика промышленных роботов: учебное пособие для втузов. В 3 кн. Кн. 1. Кинематика и динамика / Е.И. Воробьев, С.А. Попов, Г.И. Шевелева; под ред. К.В. Фролова, Е.И. Воробьева. - М.: Высшая школа, 1998. - 304 с.
2. Паршин Д.Я. Математические модели строительных роботов / Д.Я. Паршин // Известия вузов. Сев.-кавк. регион. Технические науки. - 2006. - №4. - С. 3-9. (Приложение).
3. Паршин Д.Я. Теоретические основы и практическое применение строительных роботов и мехатронных комплексов: монография / Д.Я. Паршин. - Ростов н/Д: РГСХМ, 2005. - 265 с.
References:
1. Vorobyov E.I. Mechanics of robots: manual for technical schools. In 3 books. B. 1. Kinematics and Dynamics / Vorobyov E.I., Popov S.A., Sheveleva G.I. Ed K.V. Frolov, E.I. Vorobyov. - M.: High school, 1998. 304p.
2. Parshin D.Y. Mathematical models of building robots/ D.Y. Parshin / / Proceedings of universities. North-Caucasus region. Tech. sciences. - 2006. -№4. - P. 3-9.
3. Parshin D.Y. Theoretical basis and practical application of building robots and mechatronic systems: monograph. Rostov n /D, 2005. - 265 p.
