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

СИНТЕЗ АЛГОРИТМА РОБАСТНОГО УПРАВЛЕНИЯ ДВИЖЕНИЕМ МОБИЛЬНОГО РОБОТА ВДОЛЬ ГЛАДКОЙ ТРАЕКТОРИИ Текст научной статьи по специальности «Электротехника, электронная техника, информационные технологии»

CC BY
61
10
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
ТРАЕКТОРНОЕ УПРАВЛЕНИЕ / РОБАСТНОЕ УПРАВЛЕНИЕ ПО ВЫХОДУ / РАСШИРЕННЫЙ НАБЛЮДАТЕЛЬ / МОБИЛЬНЫЙ КОЛЕСНЫЙ РОБОТ

Аннотация научной статьи по электротехнике, электронной технике, информационным технологиям, автор научной работы — Хоанг Дык Тхинь, Пыркин А. А.

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

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

Похожие темы научных работ по электротехнике, электронной технике, информационным технологиям , автор научной работы — Хоанг Дык Тхинь, Пыркин А. А.

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

SYNTHESIS OF AN ALGORITHM FOR ROBUST CONTROL OF A MOBILE ROBOT MOVEMENT ALONG A SMOOTH TRAJECTORY

The problem of trajectory control of the movement of a mobile robot along a given continuous trajectory is considered. Mathematical model of the robot's movement may contain unknown parameters, and the movement trajectory is an arbitrary continuous curve with limited curvature. For presented nonlinear model of robot movement, transformation of the model to the normal form allows for synthesizing a robust controller using the extended observer method. The obtained control algorithm ensures the robot movement along a continuous trajectory with an error limited in the steady state, the maximum value of the error can be adjusted using the tuning parameters.

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

УДК 681.51

DOI: 10.17586/0021-3454-2022-65-7-500-512

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

Дык Тхинь Хоанг*, А. А. Пыркин

Университет ИТМО, Санкт-Петербург, Россия hoangducthinh93@gmail. com

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

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

Благодарности: работа выполнена при поддержке Президента Российской Федерации, грант № МД-3574.2022.4.

Ссылка для цитирования: Хоанг Дык Тхинь, Пыркин А. А. Синтез алгоритма робастного управления движением мобильного робота вдоль гладкой траектории // Изв. вузов. Приборостроение. 2022. Т. 65, № 7. С. 500—512. DOI: 10.17586/0021-3454-2022-65-7-500-512.

SYNTHESIS OF AN ALGORITHM FOR ROBUST CONTROL OF A MOBILE ROBOT MOVEMENT ALONG A SMOOTH TRAJECTORY

Duc Thinh Hoang*, A. A. Pyrkin

ITMO University, St. Petersburg, Russia hoangducthinh93@gmail.com

Abstract. The problem of trajectory control of the movement of a mobile robot along a given continuous trajectory is considered. Mathematical model of the robot's movement may contain unknown parameters, and the movement trajectory is an arbitrary continuous curve with limited curvature. For presented nonlinear model of robot movement, transformation of the model to the normal form allows for synthesizing a robust controller using the extended observer method. The obtained control algorithm ensures the robot movement along a continuous trajectory with an error limited in the steady state, the maximum value of the error can be adjusted using the tuning parameters.

Keywords: trajectory control, robust output-control, extended observer, wheeled mobile robot

Acknowledments: the work was supported by the President of the Russian Federation, grant N MD-3574.2022.4.

For citation: Hoang Duc Thinh, Pyrkin A. A. Synthesis of an algorithm for robust control of a mobile robot movement along a smooth trajectory. Journal of Instrument Engineering. 2022. Vol. 65, N 7. P. 500—512 (in Russian). DOI: 10.17586/0021-3454-2022-65-7-500-512.

Введение. В настоящей статье рассматривается задача траекторного управления движением мобильного робота вдоль заданной траектории [1—5]. Особенность данной задачи заключается в том, что математическая модель движения робота содержит неизвестные параметры, а функция, описывающая траекторию движения, может быть трансцендентной (не имеющей аналитического решения для обратной функции). Предлагается робастный регуля-

© Хоанг Дык Тхинь, Пыркин А. А., 2022

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

Постановка задачи. Рассматриваются мобильный робот, движущийся на плоскости с координатами (х(t),y(t)), и непрерывная траектория, которая может быть представлена в

виде гладкой кривой S : ys = ф(х5 ), где (xs, ys ) — координаты некоторой точки, принадлежащей кривой (см. рис. 1).

Допущение 1. Линейная и угловая скорость движения робота ограничены: | V| < Vmax,

IH < ®max .

Допущение 2. Максимальная кривизна траектории S во всем ее протяжении ограничена:

1

8 = — <8 ° r — °max '

где 8 — кривизна траектории, К — радиус кривизны в точке кривой £.

X X*

Рис. 1

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

Кинематическая модель движения робота описывается следующими уравнениями [6, 7]:

(1)

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

х

У = vy

в ш

ниях движения:

= T (в)

Vx Vy

(2)

где T (в) =

cos в - sin в sin в cos в

матрица поворота.

Динамическая модель движения робота определяется уравнениями

V. =

у

сс

-а.

0

0 -ау

0 0

0

0 -аш

"Vx " "Ьх 0 0

+ 0 Ьу 0 Ру

ш 0 0 Ьш_ М

(3)

где ах, ау, аю — инерционные параметры; Ьх, Ьу, Ьш — параметры, связанные с эффективностью управляющих воздействий, также предполагается, что их значения могут быть неизвестны; ¥х, ¥у и М — обобщенные продольная и поперечные силы и поворотный момент,

действующие на мобильный робот, развиваемые некоторыми движителями.

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

г 'I — 5 шах , Иш

г

V (г)-V *

— V

— ' т

(4)

НШ \е (г) — в шах , 11ш г 1 1 г

где е (г) — минимальное расстояние от робота до кривой; 5 = 0-0 — отклонение угла рысканья 0 от угла 0 , определяющего направление касательной к кривой в ближайшей точке от

робота; ешах, 5шах, ^ах — заданные значения допустимых отклонений робота от траектории

*

и скорости; V — заданная скорость движения.

Замечание 1. В рамках данной статьи допускается, что регулируемые параметры е (г),

5 (г) вычисляются или оцениваются на основе текущих координат х, у , скорости V и ориентации 0 (см., например, [7]).

Модель движения в нормальной форме. Введем в рассмотрение вспомогательную переменную ^, определяющую длину пройденного пути, и совместно с расстоянием е запишем модель движения робота вдоль непрерывной кривой [1]:

соб 0

- Бт 0*

Бт 0 соб 0*

(5)

Подставим в (5) выражение (2):

е

СОБ 0 - Бт 0 Бт 0 соб 0

СОБ 0 Бт 0

*

- Бт 0 СОБ 0 соб (0* -0) Бт (0* -0)

- Бт (0* -0) СОБ (0* -0)

Vx К,

Vx V.у

СОБ 5 - Бт 5 Бт 5 соб5

Vx V.

= Т (5)

V.х

V.

(6)

Для 5 имеем

где в = ■

<0_

о д д * <0

5 = 0 - 0 =ш---= ш - в8 = ш - в

— кривизна заданной траектории [1].

( соб 5- V. Бт 5),

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

Для получения полной модели движения робота вдоль траектории рассмотрим замену координат:

4 =

, 4 2 =

cos 5 - sin 5 0" "Vx "

sin 5 cos 5 0 Vy

s cos 5 s sin 5 1 ш

(7)

и введем обозначения

1 0 0

h = 0 , h2 = 1 , h = 0 , E (5, s) =

0 0 1

cos 5 - sin 5 0 sin 5 cos 5 0 -s cos 5 s sin 5 1

Заметим, что матрица E (5, s) является невырожденной: detE(5,s) = 1. Нетрудно получить выражение для обратной матрицы, определенной, как и матрица E (5, s), для всех 5 и s :

cos 5 sin 5 0 E-1 (5, s) = - sin 5 cos 5 0 s 0 1

Динамическую модель движения робота (3) перепишем в виде

Vx -ax 0

Vy = 0 -ay

ш 0 0

0 0

- аш

Vx

Vy ш

bx 0 0 by

0 0

0 0 Ьш

Fx Fy

M

= AE-1 (5, s)42 + Bu,

где

-ax 0 0 "bx 0 0 " Fx"

A = 0 - ay 0 , B = 0 by 0 , u = Fy

0 0 -аш_ 0 0 Ьш_ M

Дифференцируя элементы матрицы E (5, s), получаем

E(5,s) = [P (s)5 + P2 (s)] E(5,s),

"0 -1 0" " 0 0 0"

E (5, s) = 1 0 0 E (5, s)5 + 0 0 0

0 s 0 -s 0 0

где

"0 -1 0" " 0 0 0"

P (s) = 1 0 0 , p2 (s) = 0 0 0

0 s 0 -s 0 0

Дифференцируя (7), получаем

41 = 42,

"Vx " "Vx "

42 = E (5, s) Vy +E(5,s) Vy

ш ш

= [р (в)(5 + Р2 (в)]Е(5,в)Е"1 (5,+ Е(5,е)(АЕ"1 (5,+ Ви) =

= [р (в) (5 + р, (в)] ^2 + Е (5, в) АЕ"1 (5, в) ^ + Е (5, в) Ви.

Таким образом, замена координат (7) позволяет записать нелинейную модель движения мобильного робота вдоль гладкой траектории в нормальной форме:

41 = 42; 42 = Я(£ь ^ в) + % (4Ъ в) и ,

где нелинейные преобразования имеют вид

Я (41,42, в) = [ р (в)^ 42 + р (в)+2 (ИТ 41, в) ле-1 (ИТ 41, в)]42, % (41, в) = 2 (ИТ 41, в) в,

а переменный параметр в также может быть смоделирован в терминах нормальной формы нелинейной системы как нуль-динамика. В самом деле, изменение этого параметра допустимо при равенстве нулю выходных переменных е = 0 и 5 = 0.

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

4* =

* * * 5 = 50 + V г,

(8)

где желаемый пройденный путь 5 определяется известными значениями пройденного пути

* * /-^0 к моменту запуска управления и желаемой скорости движения V и может быть представлен в виде генератора

5* = Им , м = Ям,

где И = [1 0], Я =

0 1 0 0

, м (0) =

50 V *

Определим переменные отклонений

41 =41 - h\w1, 42 = 42 - Км2

и модель их динамики

41 = 42 - Км2 = 42 ,

42 =42 = Я (( ^ в) + % (( в) = Я (41,42, в, м) + % (4Ь в) и с нелинейным преобразованием

я(, 4 2, в, м) = [ р (в)ИТ (42+\м2)+р (в)+2 (ИТ 41, в) ЛЕ-1 (ИТ 41, в)] ( + \м2 )= = Я(41,42,в) + [Р (в)ИТ42 + Р (в) + 2(ИТ41,в)ЛЕ-1 (ИТ41,в)]].

В идеальном случае необходимо обеспечить 41 = 0 , 42 = 0. Тогда можно найти выражение у (м) для управления в установившемся режиме как функцию от задающего воздействия исходя из условия [8—10]

0 = Я(0,0, в) + [р (в) + 2(0, в) ЛЕ-1 (0, в)] \м2 + % (0, в) у (м),

откуда

У (м) = - %-1 (0, в) [ р (в) + 2 (0, в) ЛЕ-1 (0, в)] Ъ^2 =

"1" "0"

0 ахЬх -м2 + 0

0 1

(вЬг 1 -ва2Ь2Х )м2 .

(9)

5

*

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

о x (w ) = -y-laxb-lw2, 0 x = Опираясь на это свойство, можно сформировать внутреннюю модель по управлению в продольном направлении:

Лх = Ux , Fx =УхЛх + Ux , где ux — новое управление в продольном направлении (будет определено далее).

В поворотном направлении такого свойства нет, так как параметр s в общем виде носит переменный характер. Тем не менее заметим, что для прямых участков заданной траектории движения верно s = 0, а для участков, которые можно описать дугой окружности, справедливо s = const и s = 0 . Таким образом, если полагать, что заданная траектория представляет собой композицию прямых и дугообразных участков, то справедливо

Gz (w) = у-1 (sAz_1 -sazb-) w2 , 0z = ° ,

и целесообразно рассмотреть внутреннюю модель и в поворотном направлении:

Л = Uz , M = yzЛz + Uz ,

где uz — новое управление в поворотном направлении (будет определено далее), yz — по-

ложительный параметр.

В поперечном направлении внутренняя модель при такой постановке задачи (без возмущающих воздействий) не обязательна:

Ру = иу ,

где иу, наряду с их и й2, будет определено далее.

Рассмотрим вспомогательные переменные

Лх =Лх -0х (н), Лг =Лz -0г (н) и запишем агрегированную модель системы:

Л х = их, Л z = uz ,

4 =4 2,

"У x1 x " ux

4 2 = q ( 4 2, S w) + g ( s) 0 + g ( s) uy

_У z Л z _ uz _

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

q ( 4 2, s, w) = q ( 4 2, s, w)+g ( s)

где

Ух0х (Н) 0

_Уz0х (Н)_

Замечание 2. Важно отметить, что член (0,0, в, н) тождественно равен нулю в случае ¿ = 0 благодаря выбору функций н) и о^ (н) и является соизмеримо малой величиной при относительно малых значениях в . Выбрав законы управления в виде

их "-УхЛх"

Uy = 0

Üz _ _-УzЛz _

+ p(il, Í2.s'w)

(10)

(11)

(12)

где p((,^2,s,w) = g 1 ((,s)(((,I2,s,w)-^ili -^2^2) с некоторыми положительными параметрами £ и £2, получим динамику замкнутой системы в виде двух подсистем:

л х = -у хЛх+h p^ ^ s w);

Л z = -У z Л + h3T p ((^ s w);

li =l2,

12 =-k1|1 - k2|2-. Утверждение 1. Система

X = ф (x, s, w)

с вектором состояния X = col {лх, Лг, l1, l2) и преобразованием Ф (X, s, w), определенным в (11), (12), является асимптотически устойчивой при условии s = 0, а при |s | < д < да все траектории системы ограничены областью, зависящей от параметра д: X < МД .

Доказательство. Соответствующий выбор параметров £ и £2 позволяет обеспечить экспоненциальную устойчивость системы (12) и сходимость к нулю переменных | и I2. Благодаря структуре нелинейной функции p(li,I2,s,w) и свойству p(0,0,s,w) = 0 заключаем,

что переменные состояния внутренне устойчивых систем (11) стремятся к нулю. С учетом замечания 1 следует отметить, что при нарушении свойства s = 0 стремление к нулю переменных состояния будет также нарушено, однако система сохранит свойство устойчивости по входу, а переменные состояния будут ограничены, если ограничена переменная s .

Синтез робастного закона управления. Закон управления (10) не всегда может быть реализован, так как зависит от переменных I2, w и Лх z, которые могут быть неизмеряемы-

ми. Здесь такой закон управления будет заменен робастной версией с помощью расширенного наблюдателя [11—14]

(13)

где

их satN (их)

U = Üy = satn (ty)

Üz _ _satN (Uz )_

и„

= G-1

-£^1 - k212 -G|

(14)

г т ~ Г~ ~ г

где К = [-& -^2 ], 4 = 41 42 ; число N выбирается разработчиком, матрица с постоянными параметрами О должна быть невырожденной и выбрана из условия

||(g (li, s)-G )g-1|

< 1

где д — число, удовлетворяющее условию 0 < д < 1, а Я3 -векторы переменных ¿1, ¿2 и а являются состояниями расширенного наблюдателя вида

¿1 =^2 + ка2 (|1 ) ; 4 2 = а4 + ^^ + к2^1 (¿1 ),

а4 =кЧ (¿1 )

с настроечными параметрами ( «1 ) и к .

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

С =к2 (41 -41) ;

С2 = к(42 -42);

Сз = Я(в + g ( в)

У хЛх 0

У * лг

+ (g ( в)-о )и ( а4)-а4,

где й (¿1, ¿2,— выражение, полученное из (13), (14) заменой ¿1, ¿2 на ¿1, ¿2. Дифференцируя вектор С = (С1,С2,С3), получаем

С = к2 (¿1 - ¿1) = к2 (¿2 - ¿2 - к«2 (¿1 - ¿1)) = к (С2 - «2С1) ; С2 = к(422 ) =

= к

Я ( 4 2, в ^)+g ( в)

= к

( 4 2, в, ™ ) + g ( в)

У хЛ X 0

У * Л* _

У хЛх 0

У * Л*

^ (41, в)

й

и„

- а4 - Ом - к а

(41 -41)

( (41, в)-О )м

-а4

з

-к а

■(-41 ^

: кС3 + к (g ( в) - О) (м (41,42, а4 ) - й (41, 42, а4 )) - ка1С1 = к(С3 -а1С1) + Аъ

где

А1 = к

(g(в)-О)(м ^а4)-и(4l,42,04)) ;

С з = Я (41,42, в, ™) + g (41, в)

У хЛх 0

У * Л*

^ (41, в)

У хЛх 0

У *Л *

(4l, в)й + ( (4l, в)-О )й-а 4

= Я

( 42, в, ™ ) + g (4l, в)

у а У ХЛ X

0 + g (4l, в) 0

_У*Л*_ У * Л * _

+ £

(41,в)й + (g(41,в)-О)й -ка0С1

Л

= q

( е,w) + g (ii, e)

У хЛх 0

У z Л

+g

( е)

У хЛх 0

У z Л z

где

+£ (ii, е) U + (g (ii, е) - G) J (i, Gi) G-1 (K i -6 5) - KaoCi = A2 - (ji Ao - KaoC1 =A2 - kaoaoC1 - KaoCi,

Ao =(g (ii, e)-G )j (i, Gi) G-i;

A 2 = q ( i2, e, w)+ g (i1, e)

У хЛх

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

o

У z Л

+g

( e)

У хЛх o

У z Л z

+

+g (ii, е) + (g (ii, e)-G )j (i, Gi)G-iK i,

J (( Gi) — матрица Яшби, составленная путем дифференцирования функций насыщения (i3).

Получим модель ошибки оценивания:

C i C 2

C 3

= K

-a21 I o -aiI o I -ao I o o

Ci o

C 2 - o

C 3 I

Ao[ao o o]

Ci > o o

C 2 + I Ai + o

C 3 J o I

и перепишем ее в виде

где

C = K (( - BCCCAo) C + DC Ai + BC A2:

-a2I I o" "o" aoI "o" "1 o o"

= -aiI o I , BC = o CT = , CC = o = I , I = o 1 o

_-aoI o o I o o o o 1

Запишем модель замкнутой системы:

X = Ф (X, е, w) + g (X, е) A3 ;

C = к (( - BCCCAo) C + DC Ai + BC A2, где g(X,е) = g(ii,е), а A3 означает разницу между реализуемым регулятором (i3), (i4) и номинальным (io).

Поскольку модель замкнутой системы полностью удовлетворяет условиям утверждения io.2, приведенного в [i5], то полученные выше вычисления являются доказательством следующего утверждения.

Утверждение 2. Существует предел насыщения N, параметры ao, ai, a2 и значение

* *

к такие, что при к>к все траектории замкнутой системы ограничены и соответствуют выполнению цели управления (4).

Численное моделирование. Рассмотрим пример моделирования решения задачи траек-торного управления мобильном роботом с использованием предложенного подхода. Заданная гладкая траектория описывается уравнением y = х +1 - cos 2х и желаемая скорость движения

робота V = 1 м/с. Параметры динамической модели движения робота выбираются как

ах = 1, ау = 1, ат= 1, ьх = 1, ьу = 1 и Ьт= 1.

Выбираем значения параметров робастного регулято

1 0 0"

за:

К = [-100, -100], О =

0 1 0 0

N = 50,

а0 = 0,1, а1 = 4, а2 = 1, к = 10,

У х = 1> У * =1.

Результаты моделирования траектории движения мобильного робота приведены на рис. 2. Как видно на графиках, мобильный робот движется вдоль заданной траектории. Предложенный регулятор, используя оценки регулируемых параметров (s, е, 5), обеспечивает ограниченность ошибок по ориентации и боковому отклонения (рис. 3, а, б и 3, б соответственно).

у, м

10

0

траектория робота заданная траектория

а)

А?, м 0

-0,02 -0,04

5 10 х, м

Рис. 2

б)

е, м

0,8 0,6 0,4 0,2 0

0

в)

10

5, рад 0

-0,5

20

t, с

10

20

с

0

г, с

10 20 Рис. 3

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

5

0

0

траектории во избежание столкновения с препятствием. В данном случае траектория задается по четырем ориентирам А(0,0), 5(10,10), С(20,5), .0(30,20) (рис. 4, а); результат моделирования представлен на рис. 4, б. Из рис. 5 видно, что регулятор обеспечивает нулевую ошибку по продольному (а) и поперечному (б) отклонению от заданной траектории и по углу ориентации (б).

а)

О

б)

У, м 25

20

15

10

5

0

траектория робота заданная траектория

10 х, м

Рис. 4

а)

Ая, м 0

-0,01 -0,02 -0,03 -0,04

б)

е, м 0

-0,5

-1

И"

0

10 20

30

б)

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

8, рад 0,5 0

-0,5 -1 -1,5

40 /, с

10 20

30

40 /, с

0

30

40 /, с

10 20

Рис. 5

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

0

5

0

СПИСОК ЛИТЕРАТУРЫ

1. Бурдаков С. Ф., Мирошник И. В., Стельмаков Р. Э. Системы управления движением колесных роботов. СПб: Наука, 2ooi. 232 с.

2. Чепинский С. А., Мирошник И. В. Траекторное управление кинематическими механизмами нетривиальной конструкции // Научно-технический вестник СПбГУ ИТМО. 2oo4. № 3 (14). C. 4—io.

3. Капитанюк Ю. А., Чепинский С. А. Управление мобильным роботом по заданной кусочно-гладкой траектории // Гироскопия и навигация. 2oi3. № 2. С. 42—52.

4. Miroshnik I. V., Nikiforov V. O. Trajectory motion control and coordination of multilink robots. San-Francisco, 1996. ( Prepr. 13th IFAC World Congress).

5. Бушуев А. Б., Исаева Е. Г., Морозов С. Н., Чепинский С. А. Управление траекторным движением многоканальных динамических систем // Изв. вузов. Приборостроение. 2oo9. Т. 52, № 11. С. 5o—56.

6. Хоанг Д. Т., Пыркин А. А. Алгоритм траекторного управления движением мобильного робота без измерения координат положения // Научно-технический вестник информационных технологий, механики и оптики. 2o21. Т. 21, № 6. С. 858—865.

7. Хоанг Дык Тхинь, Пыркин А. А. Траекторное управление мобильным роботом в условиях неопределенности // Изв. вузов. Приборостроение. 2o21. Т. 64, № 8. С. 6o8—619.

8. Borisov O. I., Pyrkin A. A., Isidori A. Application of enhanced extended observer in station-keeping of a quadrotor with unmeasurable pitch and roll angles // IFAC-PapersOnLine. 2oi9. Vol. 52, N 16. P. 837—842.

9. Borisov O. I., Pyrkin A. A., Isidori A. Robust output regulation of permanent magnet synchronous motors by enhanced extended observer // IFAC-PapersOnLine. 2o2o. Vol. 53, N 2. P. 4881—4886.

10. Bobtsov A., Pyrkin A., Ortega R., Vukosavic S., Stankovic A., Panteley E. A robust globally convergent position observer for the permanent magnet synchronous motor // Automatica. 2oi5. N 61. P. 47—54.

11. Freidovich L., Khalil H. Performance recovery of feedback linearization based designs // IEEE Trans. on Automatic Control. 2oo8. N 53(io). P. 2324—2334.

12. Isidori A., Marconi L., Serrani A. Robust Autonomous Guidance. London: Springer Verlag, 2oo3.

13. Khalil H. High-Gain Observers in Nonlinear Feedback Control // Advances in Design and Control; Society for Industrial and Applied Mathematics. 2oi7.

14. Sidori A., Pyrkin A., Borisov O. An extension of a lemma of Dayawansa and its application in the design of extended observers for nonlinear systems // Automatica. 2oi9. Vol. io6. P. 178—183.

15. Isidori A. Lectures in feedback design for multivariable systems. Basel, Springer Intern. Publ., 2oi7.

Сведения об авторах

Дык Тхинь Хоанг — аспирант; Университет ИТМО, факультет систем управления и робо-

тотехники; E-mail: hoangducthinh93@gmail.com

Антон Александрович Пыркин — д-р техн. наук, профессор; Университет ИТМО, факультет систем

управления и робототехники; E-mail: a.pyrkin@gmail.com

Поступила в редакцию 25.o4.22; одобрена после рецензирования o5.o5.22; принята к публикации 31.o5.22.

REFERENCES

1. Burdakov S.F., Miroshnik I.V., Stel'makov R.E. Sistemy upravleniya dvizheniyem kolesnykh robotov (Motion Control Systems for Wheeled Robots), St. Petersburg, 2001, 232 p. (in Russ.)

2. Chepinsky S.A., Miroshnik I.V. Scientific and Technical Journal of Information Technologies, Mechanics and Optics, 2004, no. 3(14), pp. 4-10. (in Russ.)

3. Kapitanyuk Yu.A., Chepinsky S.A. Giroskopiya i Navigatsiya, 2013, no. 2, pp. 42-52. (in Russ.)

4. Miroshnik I.V., Nikiforov V.O. Prepr. 13th IFAC World Congress, San-Francisco, 1996, V. A., pp. 361-366.

5. Bushuev A.B., Isaeva E.G., Morozov S.N., Chepinsky S.A. Journal of Instrument Engineering, 2009, no. 11(52), pp. 50-56. (in Russ.)

6. Hoang D.T., Pyrkin A.A. Scientific and Technical Journal of Information Technologies, Mechanics and Optics, 2021, no. 6(21), pp. 858-865. (in Russ.)

7. Hoang Duc Thinh, Pyrkin A.A. Journal of Instrument Engineering, 2021, no. 8(64), pp. 608-619. (in Russ.)

512

flbiK Txuub Xoam, A. A. nupKun

8. Borisov O.I., Pyrkin A.A., Isidori A. IFAC-PapersOnLine, 2019, no. 16(52), pp. 837-842.

9. Borisov O.I., Pyrkin A.A., Isidori A. IFAC-PapersOnLine, 2020, no. 2(53), pp. 4881-4886.

10. Bobtsov A., Pyrkin A., Ortega R., Vukosavic S., Stankovic A., and Panteley E. Automatica, 2015, no. 61, pp. 47-54.

11. Freidovich L. and Khalil H. IEEE Transactions on Automatic Control, 2008, no. 10(53), pp. 2324-2334.

12. Isidori A., Marconi L., and Serrani A. Robust Autonomous Guidance, Springer, London.

13. Khalil H. High-Gain Observers in Nonlinear Feedback Control, Society for Industrial and Applied Mathematics, 2017.

14. Sidori A., Pyrkin A., Borisov O. Automatica, 2019, vol. 106, pp. 178-183.

15. Isidori A. Lectures in feedback design for multivariable systems, Basel, Switzerland, Springer International Publishing, 2017.

Data on authors

Duc Thinh Hoang — Post-Graduate Student; ITMO University, Faculty of Control Systems and Robotics;

E-mail: hoangducthinh93@gmail.com Anton A. Pyrkin — Dr. Sci., Professor; ITMO University, Faculty of Control Systems and Robotics;

E-mail: a.pyrkin@gmail.com

Received 25.04.22; approved after reviewing 05.05.22; accepted for publication 31.05.22.

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