БАТЫРКАНОВ Ж. И., КАДЫРКУЛОВА К. К., МАМАТОВ Д. Н.
СИНТЕЗ ЗАКОНОВ УПРАВЛЕНИЯ ДВИЖЕНИЕМ ОБЪЕКТОВ ПО ПРЕДПИСАННЫМ ТРАЕКТОРИЯМ Аннотация. Приведены новые алгоритмы синтеза законов управления движением управляемого объекта по заданной предписанной траектории. Рассматриваются два варианта синтеза - с использованием аналитического описания траектории движения и табличного, проиллюстрированные на модельных примерах. Результаты моделирования показали конструктивность и высокую эффективность процедур синтеза.
Ключевые слова: предписанная программа (траектория), закон управления, объект управления, вектор невязки, вектор состояния, конечно-разностное уравнение.
BATYRKANOV J. I., KADYRKULOVA K. K., MAMATOV D. N.
SYNTHESIS OF LAWS OF MOVEMENT CONTROL OF OBJECTS ALONG PRESCRIBED TRAJECTORIES Abstract. New algorithms for the synthesis of control laws for the implementation of the motion of a controlled object along a given prescribed trajectory are presented. Two variants of synthesis are considered, using an analytical description of the trajectory of motion and tabular description, illustrated with model examples. The simulation results showed the constructiveness and high efficiency of the synthesis procedure.
Keywords: prescribed program (trajectory), control law, controlled object, residual vector, condition vector, finite difference equation.
В различных практических областях ставятся задачи по обеспечению движения объекта по предписанным траекториям. Это задачи управления движением рабочего органа манипулятора, лазерным лучом, промышленными роботами, рабочим органом 3D-принтера, квадрокоптерами и. т. д. Проблемы синтеза законов управления предписанным движением, на данное время до конца не решены, это связано с трудностями при рассмотрении многомерных, нелинейных систем, а также с трудностями аналитического описания предписанных траекторий движения. В большинстве случаев на практике, например, при построении систем управления с промышленными роботами или применения 3D-принтеров, предписанную траекторию движения описать аналитически очень сложно. В этом случае используется подход синтеза на основе табличного задания предписанной траектории движения.
Синтез законов управления в случаях задания предписанной траектории движения в аналитической форме. Рассмотрим объект, описываемый математической моделью в виде
х = F(x) + G(x)u, (1)
т
где х — (х1,х2, ...,хп) — вектор состояния; т
u — (щ,и2,... ,um) — векторуправления;
F(^) — в общем случая нелинейная вектор-функция;
G(^) — матрица, элементы которой-нелинейные функции от " х ". Данная структура модели включает в себя и случай линейного объекта:
х = Ах + Ви,
где А, В - числовые матрицы.
Предписанная траектория движения задаётся в виде системы аналитических выражений:
х¥г(х,г)—0, r=l~s. (2)
Назначая далее требуемый закон отработки ошибки выполнения программы движения
в виде
^ = Иг(5,х, t), Rr(0, х, t) = 0, Sr — фг(х, t) Ф 0, (3)
синтезируется искомый закон управления из условия обеспечения Sr ^ 0 в виде
и = ъис^т(х)д-^, (4)
где коэффициенты Ci, г = l,s определяется из следующей системы:
Г^Чх)--!. ГЮЩ) — R,-(%. Fw)—%. i—TTs; (5)
а искомый вектор управления существует при условии
rank (G (х) • 'Zsi=1 Ci = rank G(^). (6)
Если данное условие не выполняется, то это говорит о невозможности осуществления движения управляемой системы по заданной (предписанной) траектории.
Пример синтеза алгоритмов осуществления предписанной траектории. В качестве примера рассмотрим управляемый объект, который описывается системой уравнений
(хi — х2 + иi;
х2 — хз; (7)
х3 — и2;
или
х = Ах + Ви, (8)
'0 -1 0\ /1 0^
где А = (001); В = (О 0
ч0 0 0/ \0 1/
Поставим задачу осуществления движения системы по траектории, описываемой системой уравнений
( *2, хз, О = + *2 + *з - 1 = 0;
1^2(х1,х2,х3,0 = х1 — 2х2 — 3х3 -5 = 0. ()
Для решения задачи синтеза предварительно выясним вопрос линейной т .
1
ПТ "■'г I тт
независимости векторов В' • Для этого определим
1
г.^1 = Г1 0 °1 . = Г1], ю 0 1 1 [1]'
в
1
в
1
т _ [1 0 0 . _ Г 1 1 ^ [0 0 1] 2 [—3].
Согласно [1] закону управления (4), имеем выражения искомых законов
1
(12Г1 + 4Г2 + 16x2 — 4хз); 1
«2 = 16 (4Г1 — 4*2 — 12хз).
(10)
Моделирование замкнутой системы управления с помощью ППП МЛТЬЛБ.
Уравнение замкнутой системы исходя из (7) и (10) определяется в виде
= 4 • Х2;
*2=*з; (11)
12
,х3 ----х3.
^ 3 16 3
1
Моделирование осуществляется на основе системы (11). На рисунке 1 показана модель, выполненная в пакете Simulink. Результаты моделирования показаны на рисунке. 2.
Таким образом, синтезированный закон обеспечивает движение системы по предписанной траектории, заданной в виде системы уравнений (9). Физическая реализация полученных синтезированных функций У1, У2 не вызывает никаких затруднений.
Модельный пример синтеза адаптивного закона управления программным движением. Пусть объект управления описывается системой
Х = ах + ви + Дах, (12)
/0 1\ (0\ Л /а11 а12\ где, а = ^ ; в = ^ ) ; Да = ^ ) - параметрические возмущения.
Рис. 1. Моделирование замкнутой системы управления в Simulink.
Рис. 2. Результаты моделирования для x1(í), X2(t) Хз(£).
Предписанная программа движения описывается гармоническим законом
X2
X(t) = A sin wt или ^(х1( х2) = х2 + - Л2=0.
(13)
Упр строится в виде:
Упр = (а(х) • ^(х, t) - 2xix2) —.
Окончательно уравнение замкнутой системы управления с учётом структуры регулятора вида
(14)
U = í/np — Сх,
где С - матрица параметрических возмущений,
4
2
представится в виде:
Х1 = х2 + а11х1 + а12х2;
х2 = а21 Х1 + а22х2 ш \Х1 + а0 (ч +
\Х1 + а0 (х1+ ^¡2- А2) х2\ - С1Х1 - С2Х2;
¿2= 22 (-2+
ш2 \ ш2
Проинтегрировав приведенные выражения, можно исследовать процессы х^), х2Ю, С^), С2(С) и наблюдать фазовые портреты с помощью пакета MATLAB.
Моделирование синтезированной адаптивной системы управления на МЛТЬЛБ 81тиЧпк. Зависимости х^), х2(1), С^), С2(1) можно исследовать, интегрируя выражения (17) с помощью пакета Simulink (рисунок 3). Полученные результаты моделирования показаны на рисунках 4-7, соотношение между изменением выхода параметры и скоростью изменения х2(€) иллюстрируется фазовым портретом, представленном на рисунке 8.
Рис. 3. Структурная схема моделирования синтезированной системы в пакете MATLAB 8тиНпк.
О 5 10 15 20
¡те оИ-ае!:: О_
Рис. 4. Процесс на выходе хх(£).
Рис. 5. Процесс на выходе х2(£).
Рис. 6. Процесс на выходе Сх00.
Рис. 7. Процесс на выходе С20.
Рис. 8. Фазовый портрет выходных сигналов хх(£) и Х2(£).
Данный фазовый портрет полностью подтверждает теоретические выводы и показывает процедуру синтеза (определения) искомых законов управления, когда предписанная траектория задается в аналитической форме.
Подход к синтезу законов управления в случаях задания предписанной траектории движения в табличной форме. Во многих практических важных случаях, например, в задачах робототехники, при автоматизации раскроя и конструирования одежды, использования лазерных технологий микроэлектроники, в системах 3D-технологий и др. аналитическое представление предписанной программы движения вызывает большие затруднения. В этих случаях предлагается следующий подход к синтезу. Пусть объект описывается системой
х = /(х,и, 0, (16)
т
где х = (х^,х2, ...,хП) — вектор состояния;
т
и = (%, и2,..., ит) — вектор управления.
Требуется синтезировать закон управления по осуществлению траектории движения управляемой системы, заданной в табличной форме (см. таблицу 1).
Таблица 1
Предписанная траектория движения, заданная в табличной форме
^2 ¿3
Х1 х10 Х11 х12 х13
х2 х20 Х21 х22 х23
Хп хп0 Хп1 хп2 хп2
Для удобства принимается ^ = к, к = 0, 1, 2..., т. е. вводятся абстрактные
дискретные моменты времени.
Математическая модель объекта записывается в дискретной форме
х(к + 1) — х(к) х(к + 1) — х(к) V / = ^х(к), и(к), к) или ^-{-^ = f(x(k), и(к), к).
Ее представляем в виде
х(к + 1) = х(к) + f(x(k), и(к), к)Д, (17)
где: х(к) - текущее состояние, х(к +1) - состояние на следующем шаге. Из выражения (17) можно определить и(£): и(к) = и(х(к), х(к + 1), к, Д).
Управление будет определяться из условия минимизации квадрата невязки:
||*табл(к +1)- Хтекущ(к + 1)|| ^ min. (18)
Для линейного объекта x = Ax + Bu вышеописанного процедура синтеза приводит к результату
u(k) = -¿(ВТВ)-1[2Вт5Хтабл(к+ 1) - 2BT(A8 + E)5x(k)] =
= -12(ВТВ)-1[ВТ5Хтабл(к+ 1) + BT(A5 + E)5x(k)]. (19)
Пример реализации предписанной траектории, заданной таблицей. Известно, что соответствующая математическая модель дискретного движения 3-х шаговых приводов по осям X, Y, Z описывается в виде следующей системы управлений
Xk+1 = xk + nkx • Lшх'
Ук+1 = Ук + пку • ЬшУ; (20)
Kzk+1 = + nkz •
отсюда
Г _ Хк+1-Хк . пкх = , >
ьшх
■ п» = Г-1ШГ: (21)
„ _ Zk+1-Zk
<nkz = — .
Компьютерное моделирование траекторного движения с применением пакета MATLAB, на основе таблицы 2 и уравнений (20), (21) проведено на рисунке 9.
Таблица 2
Пример табличного задания предписанной программы движения
время коорд."\. to=0 t1=1 t2=2 t3=3 t4=4
Хк 0 7 8 2,2 0
Ук 0 7 8 2,2 0
Zk 0 7 8 8 0
8 ^
6, • ^ „
4, -----''И/
2, _ _ -
о> 8 6 -"""" "г / ^ 8
4 о" 0 2 " 4 —■""Б
Рис. 9. Результат моделирования траекторного движения.
Результат моделирования (рис. 9) показывает, что действительно, движение происходит по предписанной траектории, заданной в таблице 2.
Таким образом представлены процедуры синтеза законов управления, когда предписанная траектория задается аналитически, и синтез законов в случае, когда предписанная траектория движения задается в табличной форме. Проведенное моделирование демонстрирует конструктивность и высокую эффективность предлагаемыхд процедур синтеза.
СПИСОК ЛИТЕРАТУРЫ
1. Батырканов Ж. И., Шаршеналиев Ж. Ш. Синтез систем управления с заданными показателями качества. - Бишкек: Илим, 1991. - 174 с.
2. Батырканов Ж. И., Кадыркулова К. К. Синтез законов управления по осуществлению движения управляемого объекта по предписанной программе // Вестник науки Костанайского социально-техн. унив. им. академика Зулхарной Алдамжар. Костанай. - 2013. - № 3. - С. 29-33.
3. Батырканов Ж. И., Кадыркулова К. К. Синтез законов управления для осуществления движения объекта по предписанной программе // Прикаспийский журнал: управление и высокие технологии. - 2015. - № 1 (29). - С. 143-155.
4. Батырканов Ж. И., Кадыркулова К. К., Мамбетдинов И. М. Разработка системы управления шаговыми приводами трехзвенного манипулятора [Электронный ресурс] // Огарев^Ы^. - 2018. - №13. - Режим доступа: http://joumal.mrsu.ru/arts/razrabotka-
8181ету-иргау1ешуа-8Иа§оуутьрпуоёать1;гех2уеппо§о-ташри1уа1ога (дата обращения: 20.10.2021).
5. Крутько П. Д. Обратные задачи динамики управляемых систем: Линейные модели. - М.: Наука, 1987. - 304 с.