Пути7730569239840# 10, октябрь О. Г. Андрианова

• Название: Пути7730569239840# 10, октябрь О. Г. Андрианова
• Анкор: fewfew fewfw
• Дата: 23.01.2022
• Размер: 363.57 Kb.
• Имя файла: andrianova_art.pdf
• Тип: Задача; #339410

электронное научно- техническое издание bНАУКА и ОБРАЗОВАНИЕ
Эл № ФС77 - 30569. Государственная регистрация №0421100025. ISSN Моделирование движения колесного робота по заданному
пути
77-30569/239840
# 10, октябрь О. Г. Андрианова
УДК 519.6
МГТУ им. Н.Э. Баумана [e-mail]
1. Введение
Задача следования колесного робота по заданному пути привлекает внимание многих исследователей в связи с проблемами, возникающими в сельском хозяйстве, в строительстве, при добыче полезных ископаемых.
Требуется, чтобы колесный робот из некоторого начального положения достиг заданной линии движения (заданного пути) и двигался вдоль нее с постоянной скоростью. При движении вдоль заданного пути решается задача стабилизации.
Отметим, что планирование пути является отдельной задачей. Как правило, для колесных роботов задают достаточно гладкую кривую, проходящую через заданную последовательность контрольных точек. Такая кривая может быть задана кубическими параметрическими сплайнами и кубическими
В-сплайнами Поскольку кривая, построенная с использованием В-сплайнов, не всегда проходит через заданные контрольные точки, будем рассматривать кривые,
заданные кубическими сплайнами.
Известны различные подходы к решению задачи следования по заданному пути. Так, в [2, 3] соответствующее управление находится с использованием кинематической модели на основе преобразования системы к цепной форме. В

[4] предложен метод преобразования системы по части переменных к специальному виду, допускающему линеаризацию обратной связью.
Целью настоящей работы является анализ предложенного в [4] подхода сточки зрения теории нормальной формы аффинной системы [5], а также уточнение расчетных формул и анализ результатов математического моделирования процессов управления движением колесного робота по различным путям. Кинематическая модель колесного робота
Рис. 1. Модель колесного робота
Следуя [4], приведем модель движения колесного робота, учитывающую динамику привода рулевого механизма. Робот представлен абсолютно твердой платформой и колесной системой с четырьмя недеформируемыми колесами.
Предполагается, что колеса находятся в точечном контакте с поверхностью и движутся без проскальзывания. Два задних колеса являются ведущими, а два передних отвечают за поворот платформы.
Положение робота на плоскости задается двумя координатами целевой точки o
, y и ориентацией продольной оси робота, определяемой углом, №10 октябрь 2011 г

?
t между положительным направлением оси
X
A
и вектором скорости линейной скорости v
"Cредний" угол поворота передних колес
?
задается соотношением tg ? = где u
| мгновенная кривизна пути расстояние между передними и задними колесами.
Передние колеса не могут повернуться мгновенно. Для учета динамики механизма поворота колес к кинематической модели добавляют уравнение = где угловая скорость вращения привода рулевого механизма, выступающая в качестве управления. Кинематические уравнения движения робота совместно с уравнением динамики привода имеют вид o
= v cos ?
t
,
?
y o
= v sin ?
t
,
?
?
t
= v u(?),
?? = На угол поворота передних колеси управление наложены ограничения | ? V , |?| ? ?.
3. Преобразование системы к нормальной форме
В [4] предъявлена замена по части переменных, приводящая систему к специальному виду. Такой подход представляется не совсем верным, поскольку в этом случае решается задача стабилизации системы на некотором многообразии, что без анализа характера движения поэтому многообразию не дает полного представления о поведении системы, замкнутой предложенным управлением. Поэтому представляется целесообразным получить расчетные формулы для стабилизирующего управления на основе теории нормальной формы аффинной системы Руководствуясь подходом, предложенным в [4], получим формулу для стабилизирующего управления с необходимыми уточнениями и дополнениями.
Напомним, что
O
точка робота, которая должна следовать по заданному пути. В качестве выхода выберем расстояние от точки o
, y до ближайшей http://technomag.edu.ru/doc/239840.html
3

Рис. 2. Расчетная схема точки заданного пути (x m
, y мгновенный центр кривизны пути в точке = r(s) = 1/c(s)
,
r(s)
| радиус кривизны пути в точке значение кривизны в точке угол между касательной к пути в точке
M
и осью = ?
t
? ?
c
. Полагаем, что при движении робота вдоль целевой кривой в положительном направлении выполняется ?
?| Введем систему координат, ось направлена ортогонально касательной к заданному пути в точке, а ось p
| по касательной к пути в этой точке в направлении движения.
В качестве независимой переменной возьмем длину пути, пройденного роботом до текущего момента времени, и заменим производные повременив уравнениях (2) производными по
?
Первой фазовой переменной выберем z
1
| расстояние от точки
O
до точки, которое будем вычислять с учетом направления движения робота вдоль пути sign(?) |OM где = ?y
0
s
(x m
? x o
) + x
0
s
(y m
? y Построим нормальную форму [5] системы (2) по выходу y = Так как v sin ?
?
, то z
0 1
=
?
z
1
?
?
= sin В качестве второй фазовой переменной примем z
2
= sin Дифференцируя обе части этого равенства по, №10 октябрь 2011 г

получим z
0 2
= cos ?
? ?
?
0
= cos ?
? (?
0
t
? ?
0
c
) = cos ?
?
u ?
c cos ?
?
1 + c Определим третью фазовую переменную формулой z
3
= cos ?
?
u ?
c cos ?
?
1 + c и продифференцируем ее по 3
= ? sin ?
? ?
?
0
u ?
c cos ?
?
1 + c z
1
!
+ cos ?
?
u ?
c cos ?
?
1 + c z
1
!
0
= ? V ? где f =
z
2
z
2 3
1 ? z
2 2
+
c
0
s cos
3
?
?
(1 + c z
1
)
2
?
c z
2
z
3 1 + c z
1
?
?
c
2
(1 ? z
2 2
)z
2
(1 + c z
1
)
2
?
c c
0
s z
1
cos
3
?
?
(1 + c z
1
)
3
,
(7)
? =
cos ?
? l Соотношение (7) существенно отличается от аналогичного выражения, полученного в [4]. Отличия связаны с учетом зависимости производной кривизны по пройденному пути.
Заметим, что 6= 0
, если cos ?
? 6= 0
. Для выхода y = в указанной области определена относительная степень выхода, равная 3. Следовательно, в окрестности каждой точки области замена по части переменных z
невырождена
[6]. Будем предполагать, что замена переменных справедлива во всей области.
Пусть
? = s
, тогда ?
?
1+c Таким образом, уравнения (2) в координатах z, в виде заготовки" запишутся так z
0 1
= z
2
,
z
0 2
= z
3
,
z
0 3
= ? V ? f,
?
0
=
cos ?
?
1+c z
1
(9)
http://technomag.edu.ru/doc/239840.html
5

Последнее уравнение (9) не содержит управления, что существенно облегчает анализ нулевой динамики системы. Нулевая динамика при z
1
= 0, z
2
=
0, z
3
= имеет вид ?
?
1 + c z
1
= так как z
0 1
= z
2
= sin ?
? = 0, ?
? = 0, cos ?
? = Для интерпретации полученного результата перейдем от производной по
?
к производной по t
?
? = v ?
0
= Выражение (10) описывает движение с постоянной скоростью по желаемому пути. Синтез закона управления
Поскольку коэффициент
?
при управлении не обращается в ноль в области cos ?
? 6= 0
, воспользуемся методом линеаризации по части переменных для построения стабилизирующего управления =
f ? где) = b
1
z
1
+ b
2
z
2
+ Получаем линейную замкнутую систему z
0
= A Подходящим выбором вектора b = [b
1
, b
2
, b
3
]
T
матрицу
A
всегда можно сделать гурвицевой, обеспечивая асимптотическую устойчивость замкнутой системы в переменных При моделировании будем учитывать ограничение на управление | ? Ї
V
,
примем его в виде =
?
?
?
?
?
?
?
? Ї если ? ? Ї
V
;
V,
если
|V | < Ї
V
;
Ї
V если ? Ї
V
(12)
При этом нулевая динамика не является устойчивой, однако обеспечивается решение задачи движения вдоль заданного пути с постоянной скоростью, №10 октябрь 2011 г

5. Пример Рассмотрим случай, когда заданный путь представляет собой прямую, проходящую через начало координат под углом рад коси абсцисс.
Примем линейную скорость робота равной 2.00 мс, длину | 2.45 м.
Зададим начальные условия равными x(0) = мм рад, ?(0) = 0.00
рад
Ограничение на управление примем равным
Ї
V = 0.13
рад/с.
Общее уравнение заданного пути имеет вид x + B y + C = где = 1, B = ?1, C = Расстояние от текущей точки до заданного пути будем считать по формуле z
1
= sign(?) |OM где = ?y
0
s
(x m
? x o
) + x
0
s
(y m
? y o
),
|OM | =
Ax o
+ By o
+ C
?
A
2
+ Результаты моделирования представлены на рис. 3 { Рис. 3. Заданный путь и путь робота http://technomag.edu.ru/doc/239840.html
7

Рис. 4. Зависимость угла ориентации робота ?
t от времени Рис. 5. Зависимость угла поворота колес ? от времени Рис. 6. Зависимость управления V от времени t
77-30569/239840, №10 октябрь 2011 г

6. Задание пути с помощью кубических параметрических сплайнов
Будем задавать путь кубическим параметрическим сплайном, проходящим через контрольные точки в порядке их следования.
Пусть дан набор контрольных точек на плоскости, заданных своими координатами где r
i
= r i
(x i
, y Введем параметр s
i
=
P
i?1
j=1
l j
,
s i
| длина пройденного пути до ой точки i
=
p
(x i+1
? x i
)
2
+ (y i+1
? y i
)
2
, i = 1, (n ? Построим две функции x = и y = ?(s)
, которые представляют собой нормальные кубические полиномы, проходящие через заданный набор точек. Пример Зададим начальные условия равными x(0) = мм рад, ?(0) = 0.00
рад
Координаты контрольных точек удовлетворяют параметрическим уравнениям эллипсам м. Зададим путь кубическим параметрическим сплайном, проходящим через эти точки.
При построении управления используется производная кривизны, которая разрывна при таком задании пути. С целью сглаживания зададим производную кривизны сплайном. Для этого кривизну пути в контрольных точках находим по известной формуле c =
| ?xЁ
y ? ?
y Ё
x|
( ?x
2
+ и аппроксимируем кубическим сплайном. Производную кривизны получим непосредственным дифференцированием полученного сплайна.
Для нахождения модуля расстояния от текущей точки до заданного пути вычислим расстояние от текущего положения до всех контрольных точек. Если для трех контрольных точек выполняется условие http://technomag.edu.ru/doc/239840.html
9

?(O, r i?1
) > ?(O, r и, r i
) < ?(O, r i+1
)
, то с помощью стандартной функции) в MatLab находим минимальное расстояние между i ? ой и i + ой контрольными точками, которое будет равно Графики зависимости кривизны и производной кривизны от пройденного пути показаны на рис. 7 { Рис. 7. Зависимость кривизны c от пройденного пути Рис. 8. Зависимость производной кривизны c
0
s от пройденного пути Результаты моделирования представлены на рис. 9 { 13.
77-30569/239840, №10 октябрь 2011 г

Рис. 9. Заданный путь и путь робота
Рис. 10. Зависимость углов ?
t и ?
c от времени Рис. 11. Зависимость угла поворота колес ? от времени t http://technomag.edu.ru/doc/239840.html
11

Рис. 12. Зависимость управления V от времени Рис. 13. Расстояние от целевой точки до заданного пути, №10 октябрь 2011 г

8. Заключение
В настоящей работе проанализирован предложенный в [4] подход к построению управления сточки зрения теории нормальной формы аффинной системы и уточнены расчетные формулы. Показано, что в случае задания пути кубическим параметрическим сплайном, проходящим через все контрольные точки, первая производная кривизны полученной кривой не является непрерывной, и разработан алгоритм сглаживания первой производной. Предложен алгоритм нахождения расстояния до заданного пути. Методами математического моделирования показана работоспособность предложенного метода синтеза управления, обеспечивающего движение колесного транспортного средства по заданому пути с постоянной скоростью. В частности, вычислительные эксперименты подтверждают правильность полученных формул для расчета управления.
Работа выполнена при финансовой поддержке гранта РФФИ и проекта 2.1.1/11818 ведомственной целевой программы "Развитие научного потенциала высшей школы (Список литературы. Гилимьянов РФ. Планирование пути колесного робота по зашумленным измерениям в задаче управления движением вдоль криволинейной траектории Дис. ... канд. техн. наук. Москва, 2010. 125 с. Thuilot B., Cariou C., Martinet P., Berducat M. Automatic Guidance of a Farm
Tractor Relying on a Single CP-DGPS // Autonomous Robots. 2002. V. 13. P.
53-71.
3. Fang H., Fan R., Thuilot B., Martinet P. Trajectory tracking control of farm vehicles in presence of sliding // Robotics and Autonomous Systems. 2006. V.
54. №. 10. P. 828-839.
4. Гилимьянов РФ, Пестерев А.В., Рапопорт Л.Б. Управление движением колесного робота в задаче следования вдоль криволинейного пути // Известия
РАН. Теория и системы управления. 2008. Т. 47, № 6. С. 158{165.
5. Isidori A. Nonlinear control systems. London: Springer-Verlag, 1995.
http://technomag.edu.ru/doc/239840.html
13

6. Крищенко А.П. Преобразование нелинейных систем и стабилизация программных движений // Труды МВТУ им. Н.Э. Баумана. 1988. № 512. С, №10 октябрь 2011 г

e l e c t r o n i c s c i e n t i f i c a n d t e c h n i c a l p e r i o d i c a l
SCIENCE and EDUCATION
El № FS77 - 30569. №0421100025. ISSN 1994-0408
Path following simulation of wheeled vehicle
77-30569/239840
# 10, October 2011
O. G. Andrianova
Bauman Moscow State Technical University [e-mail]
Stabilization algorithm of the wheeled vehicle on the planned path is studied by means of numerical modeling. Synthesis of stabilization algorithm is based on theory of normal form of the affine system. Smoothing algorithm of the first derivative of curvature in the case of setting the path by parametric cubic spline is suggested. Methods of finding distance from the wheeled vehicle to the planned path are considered. Efficiency of the method is shown, high sensitivity of control to curvature of the path is established.
References
1. Gilim'janov R.F. Planirovanie puti kolesnogo robota po zashumlennym izmerenijam v zadache upravlenija dvizheniem vdol' krivolinejnoj traektorii:
Dis. ... kand. tehn. nauk. Moskva, 2010. 125 s.
2. Thuilot B., Cariou C., Martinet P., Berducat M. Automatic Guidance of a Farm
Tractor Relying on a Single CP-DGPS // Autonomous Robots. 2002. V. 13. P.
53-71.
3. Fang H., Fan R., Thuilot B., Martinet P. Trajectory tracking control of farm vehicles in presence of sliding // Robotics and Autonomous Systems. 2006. V.
54. №. 10. P. 828-839.
4. 4. Gilim'janov R.F., Pesterev A.V., Rapoport L.B. Upravlenie dvizheniem kolesnogo robota v zadache sledovanija vdol' krivolinejnogo puti // Izvestija
RAN. Teorija i sistemy upravlenija. 2008. T. 47, № 6. S. 158{165.
5. Isidori A. Nonlinear control systems. London: Springer-Verlag, 1995.
6. Krishhenko A.P. Preobrazovanie nelinejnyh sistem i stabilizacija programmnyh dvizhenij // Trudy MVTU im. N.Je. Baumana. 1988. № 512. S. 69{87.
http://technomag.edu.ru/doc/239840.html
15