Научная статья на тему 'СИНТЕЗ АЛГОРИТМА УПРАВЛЕНИЯ ПРИВОДАМИ МАНИПУЛЯТОРА ПАРАЛЛЕЛЬНО-ПОСЛЕДОВАТЕЛЬНОЙ СТРУКТУРЫ МОБИЛЬНОГО РОБОТА-ПРОПОЛЬЩИКА'

СИНТЕЗ АЛГОРИТМА УПРАВЛЕНИЯ ПРИВОДАМИ МАНИПУЛЯТОРА ПАРАЛЛЕЛЬНО-ПОСЛЕДОВАТЕЛЬНОЙ СТРУКТУРЫ МОБИЛЬНОГО РОБОТА-ПРОПОЛЬЩИКА Текст научной статьи по специальности «Механика и машиностроение»

CC BY
102
21
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
РОБОТЫ-ПРОПОЛЬЩИКИ / МАНИПУЛЯТОРЫ ПАРАЛЛЕЛЬНО-ПРОСТРАНСТВЕННОЙ СТРУКТУРЫ / СИСТЕМА УПРАВЛЕНИЯ МАНИПУЛЯТОРАМИ / ROBOT-WEEDER / MANIPULATOR WITH A PARALLEL-SPATIAL STRUCTURE / POSITIONING / CONTROL SYSTEM / MATHEMATICAL MODEL OF DYNAMICS

Аннотация научной статьи по механике и машиностроению, автор научной работы — Иванов А. Г., Воробьева Н. С., Жога В.В., Павловский В. Е., Павловский Е. В.

Актуальность. Статья посвящена разработке алгоритма управления исполнительными звеньями манипуляционного механизма параллельно-последовательной структуры мобильного робота-пропольщика. Объект. Представлена расчетная схема механизма перемещения рабочего органа мобильного робота-пропольщика. Материалы и методы. Предлагается двухэтапная процедура решения задачи управления перемещением рабочего органа робота в заданную окрестность конечного состояния за заданное время. Сначала решается задача определения обобщенных координат манипулятора при заданных координатах рабочего органа. Решение этой задачи носит оптимизационный характер. Затем решается задача определения законов формирования задающих воздействий для исполнительных приводов, обеспечивающих перемещение рабочего органа в окрестность заданной точки. Коррекция программной траектории производится таким образом, чтобы в каждый момент времени она проходила через заданное положение рабочего органа и отклонения от конечного состояния исполнительных звеньев изменялись в соответствии с решением сформированного дифференциального уравнения. Результаты и выводы. Синтезирован кинематический алгоритм перемещения рабочего органа манипулятора в заданное положение. Получены законы изменения управляющих усилий. Приводятся результаты численного моделирования, подтверждающие работоспособность предложенного алгоритма на примере конкретного манипулятора. В результате расчета выявлено, что ошибка позиционирования рабочего органа по разработанному алгоритму не превышает 1 %. Наличие начальных возмущений не оказывает влияние на работу разработанного алгоритма.

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

Похожие темы научных работ по механике и машиностроению , автор научной работы — Иванов А. Г., Воробьева Н. С., Жога В.В., Павловский В. Е., Павловский Е. В.

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

DEVELOPMENT OF METHODS FOR AUTOMATIC CONTROL OF MANIPULATOR DRIVES OF MOBILE ROBOT-WEEDER WITH PARALLEL-SERIAL STRUCTURE

Introduction. The article considers the development of a control algorithm for the actuating links of a manipulator with a parallel-serial structure. Оbject. The calculation scheme of the mechanism of movement of the working part of the mobile robot-weeder is presented. Materials and methods. The authors suggest a two-stage procedure for resolving the problem of controlling the robot operating part motion into a set neighborhood of the final state for a set time. The first stage covers the process of solving the problem of defining the manipulator generalized coordinates at the set coordinates of the operating part. The problem solution is of an optimization nature. The second stage proceeds with the resolving of the problem of defining the laws of the setting action formation for the actuating drives responsible for the operating part motion in the set point neighborhood. The programmed path correction is done in such a way that at any specific time it moves through a set position of the operating part while the deviations from the final state of actuating links change according to the solution of the formed differential equation. Results and conclusions. A kinematic algorithm for manipulator position stabilization in a given final state is synthesized. The control efforts change laws are obtained. The results of numerical modeling confirming the efficiency of the proposed algorithm on the example of a specific manipulator are presented. Mathematical modeling showed that the proposed algorithm allows the manipulator grip motion along the program path with an error not exceeding 1%.The algorithm also functions properly in the presence of initial disturbances.

Текст научной работы на тему «СИНТЕЗ АЛГОРИТМА УПРАВЛЕНИЯ ПРИВОДАМИ МАНИПУЛЯТОРА ПАРАЛЛЕЛЬНО-ПОСЛЕДОВАТЕЛЬНОЙ СТРУКТУРЫ МОБИЛЬНОГО РОБОТА-ПРОПОЛЬЩИКА»

НИЖНЕВОЛЖСКОГО АГРОУНИВЕРСИТЕТСКОГО КОМПЛЕКСА НАУКА И ВЫСШЕЕ ПРОФЕССИОНАЛЬНОЕ ОБРАЗОВАНИЕ

DOI: 10.32786/2071-9485-2020-04-42 DEVELOPMENT OF METHODS FOR AUTOMATIC CONTROL OF MANIPULATOR DRIVES OF MOBILE ROBOT-WEEDER WITH PARALLEL-SERIAL STRUCTURE

A. G. Ivanov1, N. S. Vorob'yeva1, V. V. Zhoga2,3, V.E. Pavlovsky4, E. V. Pavlovsky4

1 Volgograd State Agrarian University, Volgograd, Russia 2Volgograd State Technical University, Volgograd, Russia 3Center for Technologies in Robotics and Mechatronics Components, Innopolis University,

Innopolis, Russia

4Keldysh Institute of Applied Mathematics (Russian Academy of Sciences), Moscow, Russia.

Received 13.08.2020 Submitted 25.10.2020

The article was prepared with the financial support of RFBR grant no. 19-48-340013 ra.19-31-

50031 molnr.

Summary

The article presents the results of calculating the program movement of the working part of the robot -weeder from the starting point to the specified end point for a certain time. The results of mathematical modeling confirmed the efficiency of the proposed algorithm for controlling the actuators of the manipulation mechanism. The algorithm works perfectly even in the presence of initial perturbations.

Abstract

Introduction. The article considers the development of a control algorithm for the actuating links of a manipulator with a parallel-serial structure. Оbject. The calculation scheme of the mechanism of movement of the working part of the mobile robot-weeder is presented. Materials and methods. The authors suggest a two-stage procedure for resolving the problem of controlling the robot operating part motion into a set neighborhood of the final state for a set time. The first stage covers the process of solving the problem of defining the manipulator generalized coordinates at the set coordinates of the operating part. The problem solution is of an optimization nature. The second stage proceeds with the resolving of the problem of defining the laws of the setting action formation for the actuating drives responsible for the operating part motion in the set point neighborhood. The programmed path correction is done in such a way that at any specific time it moves through a set position of the operating part while the deviations from the final state of actuating links change according to the solution of the formed differential equation. Results and conclusions. A kinematic algorithm for manipulator position stabilization in a given final state is synthesized. The control efforts change laws are obtained. The results of numerical modeling confirming the efficiency of the proposed algorithm on the example of a specific manipulator are presented. Mathematical modeling showed that the proposed algorithm allows the manipulator grip motion along the program path with an error not exceeding 1%.The algorithm also functions properly in the presence of initial disturbances.

Key words: robot-weeder, manipulator with a parallel-spatial structure, positioning, control system, mathematical model of dynamics.

Citation. Ivanov A. G., Vorob'yeva N. S., Zhoga V. V., Pavlovsky V.E., Pavlovsky E. V. Development of methods for automatic control of manipulator drives of mobile robot-weeder with parallel-serial structure. Proc. of the Lower Volga Agro-University Comp. 2020. 4(60). 449-459. (in Russian). DOI: 10.32786/2071-9485-2020-04-42.

Author's contribution. All authors of this research paper have directly participated in the planning, execution, or analysis of this study. All authors of this paper have read and approved the final version submitted.

Conflict of interest. The authors declare no conflict of interest.

НИЖНЕВОЛЖСКОГО АГРОУНИВЕРСИТЕТСКОГО КОМПЛЕКСА НАУКА И ВЫСШЕЕ ПРОФЕССИОНАЛЬНОЕ ОБРАЗОВАНИЕ

УДК 621.865.8:631.316.43

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

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

1Волгоградский государственный аграрный университет, г. Волгоград 2Волгоградский государственный технический университет, г. Волгоград 3Центр технологий компонентов робототехники и мехатроники, Университет Иннополис,

г. Иннополис, республика Татарстан 4Институт прикладной математики им. М. В. Келдыша РАН, г. Москва

Дата поступления в редакцию 13.08.2020 Дата принятия к печати 25.10.2020

Статья подготовлена при финансовой поддержке гранта РФФИ № 19-48-340013 р а, 19-31-50031 мол нр.

Актуальность. Статья посвящена разработке алгоритма управления исполнительными звеньями манипуляционного механизма параллельно-последовательной структуры мобильного робота-пропольщика. Объект. Представлена расчетная схема механизма перемещения рабочего органа мобильного робота-пропольщика. Материалы и методы. Предлагается двухэтапная процедура решения задачи управления перемещением рабочего органа робота в заданную окрестность конечного состояния за заданное время. Сначала решается задача определения обобщенных координат манипулятора при заданных координатах рабочего органа. Решение этой задачи носит оптимизационный характер. Затем решается задача определения законов формирования задающих воздействий для исполнительных приводов, обеспечивающих перемещение рабочего органа в окрестность заданной точки. Коррекция программной траектории производится таким образом, чтобы в каждый момент времени она проходила через заданное положение рабочего органа и отклонения от конечного состояния исполнительных звеньев изменялись в соответствии с решением сформированного дифференциального уравнения. Результаты и выводы. Синтезирован кинематический алгоритм перемещения рабочего органа манипулятора в заданное положение. Получены законы изменения управляющих усилий. Приводятся результаты численного моделирования, подтверждающие работоспособность предложенного алгоритма на примере конкретного манипулятора. В результате расчета выявлено, что ошибка позиционирования рабочего органа по разработанному алгоритму не превышает 1 %. Наличие начальных возмущений не оказывает влияние на работу разработанного алгоритма.

Ключевые слова: роботы-пропольщики, манипуляторы параллельно-пространственной структуры, система управления манипуляторами.

Цитирование. Иванов А. Г., Воробьева Н. С., Жога В. В., Павловский В. Е., Павловский Е. В. Синтез алгоритма управления приводами манипулятора параллельно-последовательной структуры мобильного робота-пропольщика. Известия НВ АУК. 2020. 4(60). 449-459. DOI: 10.32786/2071-9485-2020-04-42.

Авторский вклад. Все авторы настоящего исследования принимали непосредственное участие в планировании, выполнении или анализе данного исследования. Все авторы настоящей статьи ознакомились и одобрили представленный окончательный вариант.

Конфликт интересов. Авторы заявляют об отсутствии конфликта интересов.

Введение. В сельскохозяйственном производстве одной из сложных операций является борьба с сорняками [7, 8]. Как правило, борьба с сорняками на открытом грунте осуществляется механизированным способом с помощью культивации. При выращивании

НИЖНЕВОЛЖСКОГО АГРОУНИВЕРСИТЕТСКОГО КОМПЛЕКСА: НАУКА И ВЫСШЕЕ ПРОФЕССИОНАЛЬНОЕ ОБРАЗОВАНИЕ

овощных культур в теплицах для удаления сорняков в основном используют ручной труд, также ручной труд до сих пор применяется и при выращивании овощных и бахчевых культур на открытом грунте. Значительным недостатком культивации является то, что культиватор обрабатывает только междурядья. Уничтожение сорняков химическим способом в последнее время используется реже по экологическим соображениям. Для решения проблемы уничтожения сорняков как в междурядьях, так и в рядке разработан мобильный ро-бот-пропольщик (рисунок 1) для точечного механического удаления сорняков.

Мобильный робот-пропольщик состоит из рамы 1, приводных колес 2, системы контроля и управления 3, аккумуляторной батареи 4 и датчика компьютерного зрения 7.

Конструкция передвижения рабочего органа (рисунок 2) выполнена в виде плоского механизма параллельно-последовательной структуры с тремя степенями свободы. Перемещение рабочего органа 8 в горизонтальной плоскости осуществляется с помощью трех линейных приводов (актуаторов) 5, а в вертикальной - с помощью акту-атора 6. Для вращения рабочего органа (фрезы) используется электродвигатель 9.

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

Рисунок 1 - Мобильный робот - Рисунок 2 - Расчетная схема механизма пере-

пропольщик мещения рабочего органа робота - прополь-

щика. Вид сверху

Figure 1 - Mobile weeding robot Figure 2 - The design scheme of the mechanism

for moving the working body of the weeding robot. Top view

Материалы и методы. Для реализации описанной технологии необходимо разработать алгоритмы формирования системы управления передвижения рабочего органа мобильного робота-пропольщика. Система управления должна обеспечивать перемещение рабочего органа в заданную точку рабочей зоны с необходимой точностью. Рассматрива-

НИЖНЕВОЛЖСКОГО АГРОУНИВЕРСИТЕТСКОГО КОМПЛЕКСА НАУКА И ВЫСШЕЕ ПРОФЕССИОНАЛЬНОЕ ОБРАЗОВАНИЕ

ются перемещения манипулятора в горизонтальной плоскости. Требования к перемещениям определяются технологией выполняемой операции: параметрами мобильности, приемистости, погрешностью позиционирования рабочего органа и временем выполнения операции. Обобщенными координатами манипуляционного механизма являются длины линейных приводов q1 = /j(t), q2 = l2(t), q3 = l3(t). Перемещение рабочего органа из известного начального положения [1] с координатами (x40, y40) в заданное конечное положение (x4, y4) обеспечивается изменением длин l (t), (i = 1 ^ 3) исполнительных звеньев манипулятора [10]. Задача решается в два этапа. Сначала решается задача позиционирования: для заданных конечных координатах (x4, y4) точки крепления вертикального актуатора (рисунок 2) требуется найти обобщенные координаты манипулятора l°p, (i = 1 ^ 3). Поскольку количество декартовых координат точки крепления исполнительного механизма равно двум, а количество обобщенных координат манипуляционного механизма равно трем, маневренность манипуляционного механизма равна единице. То есть конечному положению ак-туатора с рабочим органом соответствует бесконечное множество конфигураций манипулятора. Таким образом, решение этой задачи носит оптимизационный характер.

На втором этапе необходимо определить законы изменения обобщенных координат манипулятора li (t), (i = 1 ^ 3) при перемещении точки крепления рабочего органа из начальной в окрестность назначенной точки. В качестве управляющих параметров принимаем ускорения изменения обобщенных координат / (t), (i = 1 ^ 3).

Конструкция манипулятора обеспечивает голономные связи между координатами точки O4 (x4, y4), длинами исполнительных звеньев и геометрическими параметрами

манипулятора:

l2 =д/( У4 - А )2 +(AC + Х4 )2 , 1ъ =J( У4 -/ )2 +(BC - Х4 )2 . (1)

Конфигурация манипулятора определяется из условия минимума квадратичной функции - критерия обобщенной энергии:

Ф = c • А/12 + c2 • Л/22 + c3 • А/32, с ограничениями в виде неравенств:

l < /ор < а , (2)

г mm г г max 5 \ s

где ДА = (11к - М2 = ^/(у4 - \1к )2 +(АС + х4 )2 у40 - /10 )2 + (АС + х40 )2 ,

А/з =^(у4 -¡1к)2 +(ВС - Х4)2 У40 - /10) +(ВС - Х40) - изменения длин исполнительных звеньев; начальная конфигурация манипулятора / (/' = 3); С1, С2, С3 - весовые коэффициенты, значения которых пропорциональны нагрузкам на исполнительные звенья; //тх - минимальное и максимальное допустимые значения длин исполнительных звеньев манипулятора (рисунок 2); ¡°р - оптимальное значение длины.

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

НИЖНЕВОЛЖСКОГО АГРОУНИВЕРСИТЕТСКОГО КОМПЛЕКСА НАУКА И ВЫСШЕЕ ПРОФЕССИОНАЛЬНОЕ ОБРАЗОВАНИЕ

Целевая функция Лагранжа имеет вид:

Ф* = £ с (4 - 1о )2+^-1 (-+/ - гъ_1;тах)+^ (4 + ¡1тт -/ 1), (3)

7=1

где и2 - вспомогательные функции; - множители Лагранжа.

Необходимые условия экстремума функции (3) записываются в форме:

= с + С2 ^ - ^ + сз 5(/3 7 - 730 ) 2 + Л-^ = 0, (4)

1 2 " + С3

д/1 1 <5/ 2 <5/1 <5/

х27-! = 0, при 1° < ^; Л 27 = пРи 1° > 1Ш

Х27-1 > пРи /0 = ^; Х27 > 0 ПРи /0 = /гшг,

(5)

Так как функция Лагранжа (3) выпуклая, а множители Я21-1 > 0, Л27 > 0, то необходимые условия (4), (5) являются достаточными.

Так как манипулятор обладает большой жесткостью, то декартовые координаты точки крепления актуатора с рабочим органом определяются через длины исполнительных звеньев с большой точностью:

/2 -122 Х = ^ =11 +

^ ;2 ,2 Л2 ,2

/ 2 -2

/3 /2

4 ЛС

/2 - /2

+ - ^С2 . (6)

2

Ниже излагается метод синтеза алгоритма системы управления для законов изменения длин исполнительных звеньев [2, 11, 12].

Требования по точности управления предъявляются только к конечной точке, не накладывая ограничений на траекторию перемещения характерной точки, которая может изменяться в процессе перемещения рабочего органа из-за внешних возмущений. Считаем, что для каждого исполнительного звена известны контуры управления, замкнутые по обобщенным координатам /. (г), 7 = 1 - 3 . В этом случае решение задачи сводится к определению законов формирования задающих воздействий /. (г) для исполнительных приводов, обеспечивающих перемещение рабочего органа в окрестность заданной точки на плоскости, которой соответствуют длины исполнительных звеньев

(т) = /°р , I = 1 - 3 . Принимаем, что на траектории движения [3] отклонения от конечного состояния исполнительных звеньев д/. (г) = /°р - /. (г) изменяются в соответствии с решением дифференциального уравнения:

д]] (г) + аиД1г (г) + а27 Д/г (г) = 0, (7)

где а17, а27 - постоянные положительные числа.

Законам формирования задающих воздействий /к (г) исполнительных приводов, определяемых уравнениями (7), соответствуют дифференциальные уравнения:

]] (г) + ал/] (г) + аа/{ (г) = аа1^р, (8)

при начальных условиях, описывающих состояние манипулятора при г0 = 0:

/ г (0) = /,0, ](0) = V (9)

НИЖНЕВОЛЖСКОГО АГРОУНИВЕРСИТЕТСКОГО КОМПЛЕКСА: НАУКА И ВЫСШЕЕ ПРОФЕССИОНАЛЬНОЕ ОБРАЗОВАНИЕ

Общее решение уравнения (8) имеет вид:

w=10+с^ + с^, (10)

где корни Рц, P2i - корни соответствующего характеристического однородного уравнения. Постоянные интегрирования находим из (8) с учетом (9):

M (0)p2i + i,0 C2k = _Ц(0) p + fe, ц (0) = o _m . (11)

Ci =:

(Pu - Pli )

(Pli - Pli )

Коэффициенты уравнений (8) определяются через корни характеристического уравнения:

( Pli + Pli )> a2i = Pli Pli .

Для обеспечения требования I, (/) ^ 1°р при t ^ ж корни характеристического уравнения отрицательные разные. Значения корней характеристического уравнения следует выбирать из допустимых параметров мобильности манипулятора (предельно допустимые скорости перемещения захвата в рабочей зоне) и требуемого времени т попадания в назначенную точку с необходимой погрешностью.

Закон изменения длин исполнительных звеньев (10) является программным. Чтобы построить закон управления с обратными связями, необходимо вычислять требуемое ускорение по текущим значениям обобщенных координат:

I (t) = a, 47 - aj, (t) - atil, (t).

(12)

Таким образом, в выражениях (11) необходимо считать текущие значения обобщенных координат - начальными. Обратная связь в контурах управления приводными двигателями осуществляется по переменным I. (?), I. (?). Значения этих переменных используются при вычислении выражений, входящих в выражение (12). На рисунке 3 приведена структурная схема системы управления.

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

Рисунок 3 - Структурная схема системы управления Figure 3 - Control system structural diagram

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

Функционально система управления может быть разделена на два уровня. Верхний уровень обеспечивает общее планирование движения, обработку показаний приемника GPS и навигацию, связь с пультом удаленного управления и телеметрии по протоколу Wi-Fi, реализует систему технического зрения.

НИЖНЕВОЛЖСКОГО АГРОУНИВЕРСИТЕТСКОГО КОМПЛЕКСА НАУКА И ВЫСШЕЕ ПРОФЕССИОНАЛЬНОЕ ОБРАЗОВАНИЕ

В основу верхнего уровня положен микрокомпьютер Raspberry Pi 3 Model B. Этот микрокомпьютер основан на процессоре Broadcom BCM2837 с четыре 64-битными ядрами ARM Cortex A-53, работающими на частоте 1.2 ГГц, имеет 1 Гб оперативной памяти, порты USB, RS-232, I2C и GPIO, встроенный блок Wi-Fi. Использование в системе управления полноценного микрокомпьютера вместо микроконтроллера позволяет реализацию достаточно сложных алгоритмов управления, поддержку WiFi и построение системы технического зрения. В то же время Raspberry Pi отличается низким энергопотреблением, что существенно в автономном мобильном роботе, и невысокой ценой при достаточной производительности.

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

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

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

Рисунок 4 - Функциональная схема системы управления

Figure 4 - Functional diagram of the control system

Управление исполнительными механизмами построено на двух однотипных че-тырехканальных контроллерах приводов. Каждый из контроллеров построен на двух микроконтроллерах Microchip PIC16F73, имеющих по два генератора ШИМ для управ-

НИЖНЕВОЛЖСКОГО АГРОУНИВЕРСИТЕТСКОГО КОМПЛЕКСА: НАУКА И ВЫСШЕЕ ПРОФЕССИОНАЛЬНОЕ ОБРАЗОВАНИЕ

ления двигателями. Обратная связь реализована на четырех микросхемах Avago HCTL-2017 счетчиков для оптических квадратурных энкодеров. Таким образом, каждый контроллер обеспечивает четыре полных канала управления приводами с обратной связью. Кроме этого, каждый контроллер имеет восемь линий GPIO (цифрового ввода-вывода общего назначения) и пять линий аналогового ввода; с их помощью реализуется обратная связь приводов на потенциометрах, а не на оптических энкродерах.

Рисунок 5 - Блок управления приводами Figure 5 - Drive control unit

Для подключения контроллеров к управляющему компьютеру используется шина собственной разработки, основанная на RS-232, но отличающаяся электрически и использующая дополнительный протокол [4, 6].

Блок управления приводами показан на рисунке 5, контроллеры управления -это две верхние платы. Нижняя плата - четырехканальный силовой ключ, регулирующий напряжения и токи двигателей в соответствии с поступающими от контроллера сигналами направления и ШИМ цифрового уровня.

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

Программы верхнего уровня включают следующие основные модули: систему навигации, опрашивающую приемник GPS и объединяющую данные GPS и одометри-ческих датчиков; систему технического зрения; систему управления манипулятором, реализующую описанные в работе алгоритмы для точного позиционирования рабочего органа; систему управления движением; систему планирования верхнего уровня.

Результаты и обсуждение. Численный пример реализации алгоритма управления. В начальный момент времени рабочий орган манипулятора находился в точке с координатами x40 = -90мм, y40 = 350мм. Расстояние между осями точек крепления актуа-торов AC = BC = 140мм. Этим координатам соответствуют длины исполнительных зве-

НИЖНЕВОЛЖСКОГО АГРОУНИВЕРСИТЕТСКОГО КОМПЛЕКСА: НАУКА И ВЫСШЕЕ ПРОФЕССИОНАЛЬНОЕ ОБРАЗОВАНИЕ

ньев /10 = 0мм, l20 = 355, l30 = 419мм

Задав координаты конечной точки Х4 = 110мм, y4 = 510мм в результате применения алгоритма позиционирования получили

l\P = li° = 106,5мм, 10 = = 466мм, l0p = /3 = 395мм .

На рисунках. 5, 6 приведены результаты расчетов при перемещении рабочего органа из положения, определяемого координатами, x4° =-9°мм, y4° = 35°мм в точку с

координатами Х4 = 11°мм, y4 = 51°мм по законам (10): начальная скорость 1° = 0;

h (t) = l° (P2,eP1t - PifP2lt ), Л/ (t) = - lг°, Pu =-12, Pu =-2°

Pi i " P2 i

Д/10 = 106,5мм, A/20

-11мм, Д/30 = _24мм .

vll(t) « vl2(l)

Рисунок 5 - Законы изменения скоростей исполнительных

Figure 5 - The laws of change in executive speeds

Рисунок 6 - Законы изменения программных усилий приводов исполнительных приводов

Figure 6 - Laws of change of software efforts of drives of actuators

Из графиков (рисунки 5, 6) видно, что в течение т = 0.5 5 захватное устройство стабилизируется в заданном положении. Отклонения от заданного положения не превышающие 0,1 %, а скорости и ускорения практически равны нулю. Траектория точки незначительно отличается от прямой. Программную траекторию при отклонении обобщённых координат манипулятора не имеет смысла стабилизировать, так как в любой текущий момент времени происходит построение новой программной траектории, которая соответствует конечной точке [5]. На рисунке 6 представлены законы изменения движущих сил, полученные в результате решения уравнений (6-10) [9].

Выводы. Решена задача позиционирования манипулятора и задача слабого терминального управления. Коррекция программной траектории производится таким образом, чтобы в каждый момент времени она проходила через текущее положение рабочего органа. С течением времени рабочий орган попадает в конечную область целевой точки. С помощью кинематических параметров манипулятора, строится алгоритм управляющих напряжений. В результате расчета выявлено, что ошибка позиционирования рабочего органа по разработанному алгоритму не превышает 1 %. Наличие начальных возмущений не оказывает влияния на работу разработанного алгоритма.

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

1. Воробьева Н. С., Жога В. В., Несмиянов И. А. Отслеживание приводами манипулятора параллельно-последовательной структуры программных перемещений рабочего органа // Известия Российской академии наук. Теория и системы управления. 2019. № 2. С. 154-165.

НИЖНЕВОЛЖСКОГО АГРОУНИВЕРСИТЕТСКОГО КОМПЛЕКСА НАУКА И ВЫСШЕЕ ПРОФЕССИОНАЛЬНОЕ ОБРАЗОВАНИЕ

2. Добриборщ Д., Колюбин С. А. Адаптивное управление роботом манипулятором с параллельной кинематической схемой // Известия высших учебных заведений. Приборостроение. 2017. № 9(60). С. 850-857.

3. Колюбин С. А., Заводовский О. Д. Энергоэффективное траекторное управление манипуляторами с избыточным числом степеней свободы // Известия высших учебных заведений. Приборостроение. 2018. № 2(61). С. 141-147.

4. Павловский В. Е., Павловский В. В. Модульная микроконтроллерная система управления роботами РОБОКОН-1 // Препринты ИПМ им. М. В. Келдыша. 2012. № 86. 32 с. URL: http://library.keldysh.ru/preprint.asp?id=2012-86.

5. Распределенная система управления погрузочным манипулятором параллельно-последовательной структуры / И. А. Несмиянов [и др.] // Известия Нижневолжского агро-университетского комплекса: наука и высшее профессиональное образование. 2017. № 1(45). С. 260-266.

6. Система управления манипулятора сельскохозяйственного назначения / И. А. Несми-янов [и др.] // Известия Нижневолжского агроуниверситетского комплекса: наука и высшее профессиональное образование. 2014. № 3(35). С. 226-231.

7. Agbots: Weeding a field with a team of autonomous robots / W. McAllister, D. Osipychev, A. Davis, G. Chowdhary // Computers and Electronics in Agriculture. 2019. V. 163. № 104827.

8. Crop and Weeds Classification for Precision Agriculture Using Context-Independent Pix-elWise Segmentation / M. Fawakherji, A. Youssef, D. Bloisi, A. Pretto, D. Nardi // Proceedings - 3rd IEEE International Conference on Robotic Computing, IRC. 2019. № 8675654. P. 146-152.

9. Dynamic model of end-effector actuator used for mobile robotic weeder / A. G. Ivanov, V. V. Zhoga, V. E. Pavlovsky, N. S. Vorob'yeva // International Conference of Young Scientists and Students "Topical Problems of Mechanical Engineering" (ToPME-2019). Moscow, 2019.

10. On the unstable operating modes of manipulator electric drives / I. A. Nesmiyanov, V. V. Zhoga, V. N. Skakunov, N. S. Vorob'eva, V. V. Dyashkin-Titov, V. S. Bocharnikov // Journal of Machinery Manufacture and Reliability. 2017. V. 46 (3). P. 232-239.

11. Robotic weed control using automated weed and crop classification / X. Wu, S. Aravec-chia, Ph. Lottes, C. Stachniss, C. Pradalier. 2020. ffhal-02484462f.

12. Steward B., Jingyao G., Lie T. The use of agricultural robots in weed management and control // Robotics and automation for improving agriculture, edited by John Billingsley. Volume 44 of Burleigh Dodds Series in Agricultural Science Series. Cambridge, UK: Burleigh Dodds Science Publishing, 2019.

Conclusion. Solutions to the positioning task of the manipulator and the problem of weak terminal control. Thus, at each moment of time, it passes through the current position of the working body. The working body falls into the final area. Using the kinematic parameters of the manipulator, an algorithm of control stresses is constructed. As a result of the calculation, it was revealed that the positioning error of the working body according to the developed algorithm does not exceed 1%. The presence of initial disturbances does not affect the operation of the developed algorithm.

Reference

1. Vorobyova N. S., Zhoga V. V., Nesmiyanov I. A. Tracking by manipulator drives of the parallel-sequential structure of program movements of the working body // Proceedings of the Russian Academy of Sciences. Theory and control systems. 2019. № 2. P. 154-165.

2. Dobriborsch D., Kolyubin S. A. Adaptive control of a robot by a manipulator with a parallel kinematic scheme // Izvestiya of higher educational institutions. Instrumentation. 2017. No. 9 (60). P. 850-857.

3. Kolyubin S. A., Zavodovsky O. D. Energy-efficient trajectory control of manipulators with an excessive number of degrees of freedom // Izvestiya of higher educational institutions. Instrumentation. 2018. № 2(61). P. 141-147.

НИЖНЕВОЛЖСКОГО АГРОУНИВЕРСИТЕТСКОГО КОМПЛЕКСА НАУКА И ВЫСШЕЕ ПРОФЕССИОНАЛЬНОЕ ОБРАЗОВАНИЕ

4. Pavlovsky V. E., Pavlovsky V. V. Modular microcontroller robot control system RO-BOCON-1 // Preprints of the Institute of Applied Mathematics M. V. Keldysh. 2012. No. 86. 32 p. URL: http://library.keldysh.ru/preprint.asp?id=2012-86.

5. Parallel-serial distributed loader control system / I. A. Nesmiyanov [et al.] // Izvestia of the Lower Volga Agro-University Complex: science and higher professional education. 2017. № 1(45). P. 260-266.

6. Control system of an agricultural manipulator / I. A. Nesmiyanov [et al.] // Izvestia of the Lower Volga Agro-University Complex: science and higher professional education. 2014. No. 3 (35). P. 226-231.

7. Agbots: Weeding a field with a team of autonomous robots / W. McAllister, D. Osipychev, A. Davis, G. Chowdhary // Computers and Electronics in Agriculture. 2019. V. 163. № 104827.

8. Crop and Weeds Classification for Precision Agriculture Using Context-Independent Pix-elWise Segmentation / M. Fawakherji, A. Youssef, D. Bloisi, A. Pretto, D. Nardi // Proceedings - 3rd IEEE International Conference on Robotic Computing, IRC. 2019. № 8675654. P. 146-152.

9. Dynamic model of end-effector actuator used for mobile robotic weeder / A. G. Ivanov, V. V. Zhoga, V. E. Pavlovsky, N. S. Vorob'yeva // International Conference of Young Scientists and Students "Topical Problems of Mechanical Engineering" (ToPME-2019). Moscow, 2019.

10. On the unstable operating modes of manipulator electric drives / I. A. Nesmiyanov, V. V. Zhoga, V. N. Skakunov, N. S. Vorob'eva, V. V. Dyashkin-Titov, V. S. Bocharnikov // Journal of Machinery Manufacture and Reliability. 2017. V. 46 (3). P. 232-239.

11. Robotic weed control using automated weed and crop classification / X. Wu, S. Aravec-chia, Ph. Lottes, C. Stachniss, C. Pradalier. 2020. ffhal-02484462f.

12. Steward B., Jingyao G., Lie T. The use of agricultural robots in weed management and control // Robotics and automation for improving agriculture, edited by John Billingsley. Volume 44 of Burleigh Dodds Series in Agricultural Science Series. Cambridge, UK: Burleigh Dodds Science Publishing, 2019.

Authors Information

Ivanov Aleksey Gennadievich, assistant of the department "Mechanics" Volgograd State Agrarian University (400002, Volgograd, Universitetsky Prospekt 26), tel. +7 (8442) 41-18-49. E-mail: le-ha_2106@list.ru

Vorob'eva Natalia Sergeevna, head of the department "Mechanics" Volgograd State Agrarian University (400002, Volgograd, Universitetsky Prospekt 26), candidate of technical sciences, tel. +7 (8442) 41-18-49. Zhoga Viktor Viktorovich, Professor, Department of Theoretical Mechanics, Volgograd State Technical University (400005, Volgograd, pr. Lenin 28, building 401), doctor of physical and mathematical sciences, tel. (8442) 24-81-13, 24-80-99.

Pavlovsky Vladimir Evgenievich, professor of IPM named after M.V. Keldysh RAS (125047, Moscow, Miusskaya pl., 4,), Doctor of Physical and Mathematical Sciences.

Pavlovsky Evgeny Vladimirovich, Senior Programmer, IPM named after M.V. Keldysh RAS (125047, Moscow, Miusskaya pl., 4,).

Информация об авторах Иванов Алексей Геннадьевич, ассистент кафедры «Механика» ФГБОУ ВО «Волгоградский государственный аграрный университет» (400002, г. Волгоград, Университетский проспект, 26), тел. +7 (8442) 41-18-49.

Воробьева Наталья Сергеевна, заведующий кафедрой «Механика» ФГБОУ ВО «Волгоградский государственный аграрный университет» (400002, г. Волгоград, Университетский проспект, 26), кандидат технических наук, тел. +7 (8442) 41-18-49.

Жога Виктор Викторович, профессор кафедры «Теоретическая механика» ФГБОУ ВО «Волгоградский государственный технический университет» (400005, Волгоград, пр. им. Ленина 28, к.401), доктор физико-математических наук, тел. (8442) 24-81-13, 24-80-99.

Павловский Владимир Евгеньевич, профессор ИПМ им. М.В.Келдыша РАН (125047, Москва, Миусская пл., д.4,), доктор физико-математических наук.

Павловский Евгений Владимирович, старший программист ИПМ им. М.В.Келдыша РАН (125047, Москва, Миусская пл., д.4,).

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