Система управления манипулятора сельскохозяйственного робота

АГРОПРОМЫШЛЕННАЯ ИНЖЕНЕРИЯ

УДК 621.865.8

СИСТЕМА УПРАВЛЕНИЯ МАНИПУЛЯТОРА СЕЛЬСКОХОЗЯЙСТВЕННОГО РОБОТА

ИА.Несмиянов1, кандидат технических наук, доцент В.В. Жога2, доктор физико-математических наук, профессор В.Е. Павловский3, доктор физико-математических наук, профессор Н.С. Воробьева1, кандидат технических наук, доцент

1 Волгоградский государственный аграрный университет 2Волгоградский государственный технический университет 3Институт прикладной математики им. М.В. Келдыша РАН, г. Москва

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

Ключевые слова: манипулятор, система управления, программное движение.

Работа выполнена при поддержке Российского фонда фундаментальных исследований (13-08-00387 - а), (12-08-00301 - а).

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

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

В связи с этим актуальны задачи оптимизации геометрических, кинематических и силовых параметров манипуляторов параллельной кинематической структуры и разработка методик их расчета и проектирования [4].

Манипулятор погрузочного робота

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

Рисунок 1 - Конструкция манипулятора робота Механизм содержит три звена 2, 3, 4, концы которых закреплены с помощью специальных двухподвижных шарниров на поворотном основании 5, что позволяет изменять зону обслуживания. Противоположные концы звеньев соединены специальным шарнирным узлом 6, обеспечивающим пересечение геометрических осей этих звеньев в одной точке, что исключает появление изгибающих моментов от внешних нагрузок. Поворотное основание 5 имеет возможность поворачиваться за счёт звена переменной длины 4.

Задача позиционирования Общая задача перемещения исполнительного элемента (схвата) разделяется на три этапа: позиционирование схвата, обеспечиваемое геометрией механизма, синтеза его траектории в пространстве, ограниченном рабочей зоной, и определение закона движения по полученной траектории.

Позиционирование схвата манипулятора при выполнении технологических операций состоит в перемещении его из начального состояния, которое определяется координатами точки Мо(Хмо, Умо, %мо), в конечное положение мк(Хмк, Умк, %мк). Причём, при известной начальной конфигурации манипулятора, определяемой обобщёнными координатами ¡¿0,требуется найти конечную конфигурацию /¿к. Так как число обобщенных координат манипулятора, равное четырём, превышает число обобщенных координат схвата, равное трём, то есть манипулятор обладает ненулевой маневренностью, то заданному конечному положению объекта соответствует множество конфигураций системы (рис. 2).

Рисунок 2 - Перевод схвата манипулятора из начального положения в конечное (плоскость 20У) Координаты центра схвата м в декартовой системе неподвижных координат 0ХУ2 и длины звеньев манипулятора, связаны уравнениями

\Х2м +

где Хм, Ум, 2м - координаты точки М в неподвижной системе координат; Хв=-Хс, 2л, Ув=Ус, - координаты точек крепления звеньев манипулятора.

Длины звеньев /2к, ¡зк определяются однозначно из выражений (1), а длины звеньев ¡1к(Ул, ^л), ¡4к(ул, ^л) находятся из условия минимума квадратичной функции

б

и ограничений типа равенства

/7л, 1Л) = + (¥в -7а)2 -ОА = 0,

и неравенств [7].

Ашт - К - 11шах, 14шт - 14 - 14шах'

В соответствии с теоремой Куна-Такера, необходимые условия стационарности записываются в виде

дФ

д¥А

дФ

д2,

= С

= С

эд -¿)2 -/)

дУл

С

дУл

ЭД -¿)2 -/)

д2,

С

д2,

Здесь я

Г> 0, У

У = У 7Л ^Лш^п

Г> 0,1/ Л1 = о,/

Л ^-,2-я, = о,

д7Л

УТЛА=о.

У =У , Л Лшах',

УЛ < УЛшах'

21= 0, У УЛ > УЛшт, из которых и находятся значения Ь1к(УА, Да), Ь4к(УА, 2А).

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

Задавая закон движения звеньев от ¡0 до ¡¡к за время Т исходя из условия «мягкого» трогания и касания, заключающегося в выполнении условий равенства нулю скоростей и ускорения схвата в начальном и конечном положениях,

I

Ь

т

1 • (2пХ

I Т"

параметрические уравнения траектории схвата определяем из решения обратной задачи кинематики.

Оптимальная по времени перемещения схвата манипулятора траектория- это прямая. Однако такое перемещение возможно в том случае, когда все точки отрезка ММ принадлежат множеству, являющемуся частью зоны обслуживания. Из уравнения прямой в пространстве, проходящей через две точки М0 и Мк определяются зависимости координат ХМ, УМ, 2М от длины траектории. Закон движения по прямой ММк также принимался, удовлетворяющим требованиям «мягкого» касания. Таким образом, из уравнений (1) находятся законы изменения длин звеньев ¡1(1) без решения обратной задачи кинематики.

Траекторный синтез

Система дифференциальных уравнений, описывающих движение манипулятора с голономными связями, записывается с помощью уравнений Лагранжа с неопределёнными множителями.

Вводятся обозначения х=Х, х3=У, х5=2, х7=ф, N=1, 2, 3, 4 - управляющие усилия в звеньях манипулятора. Функции, переводящие схват манипулятора из начального положения в конечное положение за время Т, находятся из условия минимума функционала [6]

3

Ф

+ -

2

х2 +х4

Л.

Искомые функции должны удовлетворять следующим граничным условиям

х28-1(0) = x2S-1,0, x2S-1(Т) = x2S-1,Т, x2S (0) = x2S (Т) = 0

Значение функции х7(Т) неизвестно. Записывая необходимые условия стационарности, для хф), £=1, 3, 5 с учётом граничных условий, имеем

-2 Гхк (Т) - хк (0)] 3 3 Гхк (Т) - хк (0)] 2

К Т3 Т (8) Согласно [7], граничное условие для функции влияния

8Ф\

Л7

&7(T ) ' v ^ " 2T3 где f - постоянный коэффициент, значение которого определяется по результатам анализа, полученного решения и может корректироваться на стадии проектирования.

х-

х (71) = const = xn(t) = —Ц-—, и после интегрирования получаем ' ' 2^3

pt) = Щ113-P)12 + p

6Т3 4Т2

Тогда при t=T определяем неизвестное значение угла поворота основания в конечный момент времени х7=ф О\Л, а из уравнений (1) находятся законы изменения длин звеньев 4 манипулятора.

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

Управление манипулятором робота

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

В качестве исполнительного механизма звена манипулятора выступает линейный движитель - актуатор. Данные движители не имеют внутренней системы управления, но оснащены датчиком обратной связи, для определения состояния актуатора. Управление актуатором происходит аналогично управлению обычным электродвигателем постоянного тока, за тем исключением, что актуатор имеет ограничение вращения в виде длины штока. Также как и в электродвигателе, на вход актуатора подается постоянное напряжение, а управление скоростью происходит посредством ШИМ-сигнала.

Для получения информации о состоянии актуатора используется обратная связь, которая реализована в виде потенциометра и для его оцифровывания используется аналого-цифровой преобразователь (АЦП), входящий в состав отладочной платы. Разработана структурная схема подсистемы управления манипулятором мобильного робота (рис. 3).

Система управления движением с ШИМ - управлением приводами электродвигателями постоянного тока. Основным структурным компонентом системы управления является БУП (блок управления приводами) - модуль контроллеров и усилителей мощности (ключей). БУП полностью управляет системой, имеющей 4 управляемых степеней подвижности, рассчитан на систему аналоговой обратной связи. Система управления состоит из одного БУП с возможностью управления по интерфейсу RS-232 от удаленного компьютера. Система дистанционного управления движением реализуется на базе персонального компьютера. Его задача состоит в расчете в реальном масштабе времени координированного движения всех приводов по заданной математической модели, выдаче управляющих команд на БУП и обработке данных обратной связи.

Рисунок 3 - Структурная схема подсистемы управления манипулятором

Результаты численного и экспериментального моделирования

На рис. 4-5 представлены результаты решения рассмотренной задачи для начальных значений длин звеньев манипулятора ¿10=235 мм, ¿20=370 мм, ¿30=3 70 мм, ¿40=240 мм, при движении схвата по прямой и при заранее неизвестной траектории для синусоидального закона изменения ускорения. Этим значениям, полученным по показаниям датчиков положения, соответствуют координаты схвата Х(0)=0 мм, 7(0)=340 мм, Z(0)=349 мм и угол наклона основания манипулятора ф(0)=0,65 рад. Задавшись конечными значениями координат схвата, Х(Т)=50 мм, Д7)=580 мм, Z(Т)=150 мм, определяются законы изменения координат схвата Х(0, угла наклона основания модели манипулятора робота ф(/), а по выражениям (1) - длин его звеньев.

мм

5   -  1 /3

,7* 2' /2 ^ г

4 9 //

г> П

4

01234567 /,С

Рисунок 4 - Расчетные (кривые 1-4) и экспериментальные (кривые 1'-4') зависимости изменения длин звеньев 1-4 манипулятора от времени при синусоидальном законе изменения ускорений штоков исполнительных звеньев

Приведенные расчетные и экспериментальные зависимости изменения длин звеньев манипулятора от времени при движении схвата по прямой и при заранее неизвестной траектории для синусоидального закона изменения ускорения показали, с учетом ошибок измерений, совпадение теоретических и экспериментальных результатов, что может служить подтверждением практической реализуемости исследованных законов движения. Из рис. 4 видно, что при реализации прямолинейной траектории линейные скорости штоков звеньев 1, 2 и 3 изменяют знак, т. е. они совершают в относительном движении возвратно -поступательные движения. Причем, программные усилия, необходимые для реализации прямолинейной траектории, становятся знакопеременными.

О SO 100 ISO 200 2SO 300 3S0 400

Длина траектории по прямой SIip,MM

Рисунок 5 - Зависимости максимального отклонения (hmax) схвата манипулятора от прямолинейной траектории, увеличение длины траектории (AS) и отношение максимальных значений amax ускорений схвата при движении по прямой и при синусоидальном законе изменения ускорения в зависимости от расстояния

между точками позиционирования

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

Библиографический список

1. Аварийно-спасательная машина [Текст] : пат. 2476372 РФ, МПК С1./ В.В. Жога, В.А. Скакунов, А.В. Ерёменко, П.В. Федченков, В.М. Герасун, И.А. Несмиянов, В.В. Дяшкин-Титов; ВолгГТУ

2. Брайсон А., Хо Ю-ши. Прикладная теория оптимального управления [Текст] /Хо Ю-ши Брайсон А. - М.: Мир, 1972. - 544 с.

3. Глазунов, В.А. Пространственные механизмы параллельной структуры [Текст]/ В.А. Глазунов, А.Ш. Колискор, А.Ф. Крайнев. - М.: Наука, 1991. - 95 с.

4. Исследование оптимальных конфигураций манипулятора-трипода с поворотным основанием [Текст] / В.М. Герасун, В.В. Жога, И.А. Несмиянов, Н.С. Воробьева, В.В. Дяшкин-Титов // Мехатроника, автоматизация, управление. - 2013. - № 6. - С. 21-16.

5. Манипуляционные системы роботов [Текст] / А.И. Корендясев, Б.Л. Саламандра, Л.И. Тывес и др. - М.: Машиностроение, 1989. - 472 с.

6. О программных движениях манипулятора-трипода [Текст] /В.В. Жога, В.М. Герасун, И.А. Несмиянов, Н.С. Воробьева, В.В. Дяшкин-Титов // 6-я Всероссийская мультиконференция по проблемам управления: материалы мультиконференции. - Изд-во ЮФУ, 2013. - Т. 2. - С. 146-150.

7. Синтез программных движений манипулятора на основе пространственного механизма параллельной структуры с четырьмя поступательными парами [Текст] / В.М. Герасун, В.В. Жога, И.А. Несмиянов, Н.С. Воробьева, В.В. Дяшкин-Титов //Управление в технических, эргатических, организационных и сетевых системах (УТЭ0СС-2012): материалы 5-й Российской мультиконференции по проблемам управления. - Санкт-Петербург, 2012. - С. 722-725.

E-mail: ivan_nesmiyanov@mail.ru