Математическое моделирование мобильного гусеничного робота

Тип работы:
Реферат
Предмет:
ТЕХНИЧЕСКИЕ НАУКИ


Узнать стоимость

Детальная информация о работе

Выдержка из работы

УДК 621. 864. 8
МАТЕМАТИЧЕСКОЕ МОДЕЛИРОВАНИЕ МОБИЛЬНОГО ГУСЕНИЧНОГО РОБОТА
Яцун С. Ф., Чжо Пьо Вей, Мальчиков А. В., Тарасова Е. С.
ФГБУВПО Юго-Западный государственный университет, Курск, Россия (305 040 г. Курск, ул. 50лет Октября,
94), e-mail: teormeh@inbox. ru_
В статье рассматривается гусеничный мобильный робот. Описана конструкция и принцип работы устройства, оснащенного двумя независимыми гусеничными движителями. Разработана математическая модель движения устройства по криволинейной траектории. Проведен анализ кинематики криволинейного перемещения гусеничного мобильного робота и определены основные закономерности его движения при заданном радиусе кривизны траектории. В работе описан процесс взаимодействия опорных катков гусеничных движителей с шероховатой поверхностью. Получены временные диаграммы поперечных проскальзываний. Установлен сложный характер зависимости величины поперечного проскальзывания от радиуса кривизны траектории, что говорит о необходимости учета поперечного проскальзывания при разработке динамических моделей движения устройства. Полученные результаты в дальнейшем будут использоваться при изучении динамики движения робота, в частности, величина проскальзывания и продольная скорость будут учитываться при определении сил сухого трения, действующих в точках контакта робота с поверхностью. Ключевые слова: мобильный гусеничный робот, кинематика, проскальзывание, траектория.
MATHEMATICAL MODELING OF MOBILE TRACKED ROBOT
Jatsun S.F., Kyaw Phyo Wai, Malchikov A.V., Tarasova E.S.
Southwest State University, Kursk, Russia (94, 50 let Oktyabrya, Kursk, 305 040, Russia), e-mail: teormeh@inbox. ru The article presents construction of mobile tracked robot, which is equipped electric motor of each track. As well as are developed kinematics analysis of mobile tracked robot'-s motions and defined the basic laws of motion at a given radius of curvature of the trajectory. In these work are described interaction of robot'-s track drive with rough surface, are illustrated graphics which can show time influence of slip in robot motion. And also are shown estimation of robot slip modeling and calculation. So received results in these research can used in future study of dynamics of tracked robot, especially, slip value and longitudinal speeds of robot may be used in definition of dry fraction force, which will appear at the points of track drive contact with rough
surface. _
Keywords: mobile tracked robot, kinematics, slipping, trajectory.
Введение
За последние десятилетия мировая робототехника и технологии, связанные с ними, развиваются стремительными темпами, приобретая все большую возможность использования мобильных роботов в различных областях человеческой деятельности. Для решения такого рода задач были разработаны несколько различных типов мобильных роботов, в том числе колесные роботы, гусеничные роботы, шагающие роботы, беспилотные летательные аппараты [1,7]. В данной работе рассматривается мобильный гусеничный робот, предназначенный для проведения поисковых операций. Выбор гусеничного движителя обусловлен рядом преимуществ, среди которых: маневренность, высокая проходимость, надежный контакт с поверхностью.
В данной статье представлен кинематический анализ движения мобильного гусеничного робота, оснащенного двумя независимыми гусеничными движителями.
Описание конструкции и принципа движения гусеничного робота
Конструкция гусеничного робота показана на рисунке 1.
----
Рис 1. Схема гусеничного робота
Гусеничный робот состоит из следующих основных частей: 1 — корпус, 2 — ведущий каток, 3 — гусеница, 4 — ведомый каток, 5 — система автоматического управления электроприводами устройства, 6 — батареи питания, 7 — поверхность, по которой перемещается робот.
Робот перемещается за счет сил трения, возникающих между опорной поверхностью (грунтом) и гусеничным движителем робота. Ведущий каток соединен посредством редуктора с двигателем постоянного тока, управляемым системой автоматического регулирования. Проскальзывание между ведущими катками и гусеницей отсутствует, поэтому угловые скорости вращения катков (ведущих и ведомых) равны.
В зависимости от алгоритма перемещения и информации с датчиков система автоматического регулирования формирует управляющие напряжения для электроприводов устройства. Для усиления слаботочных сигналов с контроллера системы управления используются силовые транзисторные ключи — драйверы двигателей.
Для поворота в горизонтальной плоскости система управления формирует различное напряжение питания для каждого из гусеничных движителей. Система навигации робота может включать как ультразвуковые датчики расстояния, оптические линейки для перемещения по контрастной линии, так и контактные датчики препятствий.
Кинематический анализ движения мобильного гусеничного робота
Положение робота одназначано определяется координатами центра масс корпуса С и углом поворота корпуса ф. При кинематическом анализе движения гусеничного робота решается задача определения положения, скорости центра масс робота и скорости точек С?, и
к.
В рамках данного исследования были рассмотрены движения робота по окружности и спиралевидной траектории. Для получения численного результата при моделировании движения использовался пакет МаШСаё.
Рис 2. Расчетная схема гусеничного робота На данной схеме приняты следующие обозначения: XOYZ — неподвижная система координат, — подвижная система координат, С, С2, С3, С4 — точки крепления
центров опорных катков- К1, К2, К3, К4 — точки контакта гусениц с поверхностью-
-* -* -* -* -* х1 -* х1 -* х1 -* х1
Ус, ус2, усъ,с4 — скорости точек крепления центра опорных катков- УС[, УС^, УС^, УС^ -
проекции скоростей точек крепления центров опорных катков на ось СХ- У^, уУ1, У^, -проекции скоростей точек крепления центра опорных катков на ось СУ- УК^, уК, УКъ, УК¦ -
-* х1 -* х1 -* х1 -* х1
скорости точек контакта опорных катков с поверхностью- УК, Ук2, Ук3, Ук4 — проекции
скоростей точек контакта опорных катков с поверхностью на ось СХ1- Уу, УК, Уу, У-
проекции скоростей точек контакта опорных катков с поверхностью на ось СУХ- со1, со2, с3, с4 — угловые скорости вращения опорных катков, 11 — расстояние от центра масс до 1-го и 4-го катка, 12 — расстояние от центра масс до 2-го и 3-го катка, ф — угол поворота корпуса
робота вокруг а, а2 — угол между линией СС1 и осью СУ1 (а1 для ?=1,4- а1 для 1=2,3 соответственно).
Определим радиус-вектор, описывающий движение корпуса робота в неподвижной системе координат:
Ус 0
где хС и уС — проекции радиус вектора в абсолютной системе координат.
Для определения скорости центра масс продифференцируем следующее выражение:
dr.
OC _
dt
Vc cos (y) & quot-v?"-
Vc sin (y) = vC1
0 0

При этом скорость центра масс в системе координат СХ1У121 будет иметь вид:, а в системе координат XOYZ:
=
V0 =
& quot-vc cosy & quot-vC1"-
vc siny = vC1
0 _ 0
vC cos^+y)
Vc 8ш (ф + у) = vC
0 0
Угловая скорость корпуса робота С определяется следующим образом:
w=
(о ^ о
ф,
Определим радиус-вектор точек закрепления катков гусеничного робота как:
^ = Гос + ~Гсс, Л = 1& quot-4
Скорости для этих точек могут быть получены как:
= ёос ёг ёг Ж
dr. drnr drCC dr. drOC r v
^ =±C или — = -OC + wxr
dt dt
vc = vc + w x rcc, —
CC
Аналогичным образом можем записать для точек контакта с поверхностью:
: (0)
-/о)
Г + Г
к,
C, K, 3
dt

yKt = У C, +
0 0
dr — + drc к,

dt dt
i j
w1y
0 0
— vK,
k
0
rC K

где у^ - скорость точек К1 в абсолютной системе координат.
T =
10
cos ф — sin ф 0 sin ф cos ф 0 0 0 1
T- =
10
cos ф sin ф 0 — sin ф cos ф 0 0 0 1
V (1) = T ~lv (0)
K 10 K
где у (К) — скорость точек К в относительной системе координат. Положение точек центров катков робота задается следующими проекциями: X = хс+?1) | Хс2 = Хс+?1 у -а)
[/с- = Ус + ?1у + а1)'- 1 Ус2 = Ус + ?1У -а1)'-
= Хс — ?2 С^(у + а2) _ ГХс4 = Хс — ?2 С08(у -а2)
|Ус, = Ус — ?2ЫП (Р+а2) '- 1 Ус4 = Ус — ?2^ ((р-а2)'-
где, хс, ус — координаты центра 1 -того катка (1 = 1,2,3,4), хс, ус — координаты центра масс гусеничного робота.
Пусть центр масс корпуса робота движется по окружности, координаты которого Гхс = Я сов ((#)
задаются уравнениями: /, где Я — радиус кривизны окружности, по которому
[ Ус = Я 8 т (с)
движется центр масс робота, С — угловая скорость корпуса робота. Будем считать, что когда С = р, подвижная ось сУ1 всегда направлена по касательной к траектории, и угол ф изменяется по заданному закону, то есть р = С + р0, где & lt-р0 — начальный угол, определяющий положение корпуса робота на траектории.
Г
--^



Ж'--


о хс X
Рис 3. Схема движения робота по траектории Проведем моделирование движения робота и определим траекторию. Результаты моделирования представлены на рис. 4−5.
Ки
X. М
1 — Г5 -I -0−5 0 о! з 1 ^
Рис. 4. Траектория движения робота при движении по окружности: 1, 2 — скорости катков забегающей гусеницы- 3, 4 — скорости катков
отстающей гусеницы
4 vcr. M/c
Л2
г3'-4
t, С
а) & quot-о: 4 fl s 1(1 г б): 4 «а 10
Рис 5. Временные диаграммы параметров движения робота по окружности 1, 2 -скорости катков забегающей гусеницы- 3, 4 — скорости катков отстающей гусеницы- а -зависимость скорости точек контакта робота с поверхностью от времени- б — зависимость скорости точек центров катков робота от времени
Отметим, что при движении по криволинейной траектории в точке контакта опорных катков с поверхностью возникает продольное проскальзывание. Для оценки величины проскальзывания осуществим моделирование движения гусеничного робота по спиралевидной траектории, при которой радиус окружности будет изменяться во времени, т. е. R = R (t).
В данном случае, координаты центра масс будут задаваться уравнениями:
fxC = R (t) cos (wt)
{ Ус = R (t)sin (wt)
Выполним численный расчет движения робота в MathCAD и получим график траектории движения робота. Также, построим графики зависимости скоростей точек контакта с поверхностью от времени. Результаты моделирования представлены на рис. 6−7.
Рис. 6. Траектория движения катков робота при спиральном движении: 1, 2 — скорости катков забегающей гусеницы- 3, 4 — скорости катков отстающей гусеницы
А V,
0. 5

м/с
4-^ '-
'-Л 3 —. -г-
. г'-
. -

& lt-1 -*'- ^ с ь.
а) б)
Рис 7. Временные диаграммы параметров спирального движения робота: 1, 2 -скорости катков забегающей гусеницы- 3, 4 — скорости катков отстающей гусеницы- а -зависимость скорости точек контакта робота с поверхностью от времени- б — зависимость скорости точек центров катков робота от времени Определим величину продольного скольжения катков робота. Для этого вычислим нормальную составляющую скорости каждого катка, воспользовавшись формулой:
^ ('-) = ^ (I) • С08(О)
Произведя необходимые вычисление в МаШСаё, получим графики проскальзывания каждого из катков робота.
Л к,
0. 18 г2 3-, 4 -.
!& gt-



Ь, м
гг#
а) ко б)
Рис. 8. Зависимость проскальзывания от радиуса кривизны: 1, 2 — скорости катков забегающей гусеницы- 3, 4 — скорости катков отстающей гусеницы Как видно из графика, величина продольного проскальзывания нелинейно зависит от радиуса кривизны криволинейной траектории. Характерной является точка, обозначенная на рис. 8, где Я=0,18 м, а 1=1,18 с. В данном случае скорость второго опорного катка робота, являющегося ведомым во внешней гусеничной паре, становится равной нулю. По сути, в этот момент времени робот начинает вращаться относительно этого катка. После этого момента, когда Я& gt-0,18 м, скорость всех катков имеет вид возрастающей прямой, так как радиус кривизны линейно изменяется во времени.
Заключение
В данной работе проведен анализ кинематики движения гусеничного мобильного робота, определены основные закономерности его движения при заданном радиусе кривизны траектории, полученные результаты в дальнейшем будут использоваться при изучении динамики движения робота, в частности, величина проскальзывания и скорость вдоль оси CYi будут учитываться при определении сил сухого трения, действующих в точках контакта робота с поверхностью.
Список литературы
1. Туладхар Д., Тарасова Е. С. Исследование процесса торможения двухколесного транспортного средства в сложных дорожных условиях // Известия Самарского научного центра Российской академии наук. — 2010. — Т. 12, № 4−3. — С. 634−636.
2. Туладхар Д., Лупехина И. В., Яцун С. Ф. Исследование динамики движения двухколесного транспортного средства (ДТС) в фазе торможения переднего колеса // Известия Юго-Западного государственного университета. — 2011. — № 1 (34). — С. 10−17.
3. Туладхар Д., Лупехина И. В., Яцун С. Ф., Политов Е. Н. Математическое моделирование динамики движения двухколесного транспортного средства (ДТС) в фазе торможения переднего колеса // Естественные и технические науки. — 2010. — № 6. — С. 578−581.
4. Ali.A. Moosavian, Arash Kalantari Experimental Estimation for Exact Kinematics Modelling and Control of a Tracked Mobile Robot // International Conference on Intelligent Robots and Systems. — 2008. — P. 95−100.
5. Guarnieri M., Kurazume R., Masuda H, Inoh T., Takita K., Debenest P. A Team of Tracked Robots for Special Urban Search and Rescue Operations // International Conference on Intelligent Robots and Systems. — 2009. — P. 2795−2800.
6. Roland S., Nourbakhsh R. Introduction to Autonomous Mobile Robots // Massachusetts Institute of Technology. — 2004. — P. 336.
7. Varun K. Raj, Sharschchandra V., Bidargaddi K.N., Krishnanand D. Ghose A Tracked Mobile Robot with Vision-based Obstacle Avoidance // International Conferences on Mechanisms and machines. — 2007. — P. 141−147.
Рецензенты:
Савин Л. А., д.т.н., профессор, заведующий кафедрой «Мехатроника и МИ», ФГОУ ВПО «Госуниверситет УНПК», г. Орел.
Кобелев Н. С., д.т.н., профессор, заведующий кафедрой теплогазоснабжения и вентиляции, ЮЗГУ, г. Курск.

ПоказатьСвернуть
Заполнить форму текущей работой