CC BY
43
УДК 621.865
МОДЕЛИРОВАНИЕ ДВИЖЕНИЯ ТРЕХЗВЕННОГО РОБОТА С УПРАВЛЯЕМЫМИ СИЛАМИ ТРЕНИЯ ПО АБСОЛЮТНО ГЛАДКОЙ ГОРИЗОНТАЛЬНОЙ ПОВЕРХНОСТИ
Локтионова Оксана Геннадьевна д.т.н., доцент
Яцун Сергей Федорович д.т.н., профессор
UDC 621.865
MODELING OF THE MOTION OF THREE-LINK ROBOT WITH OPERATED POWER OF FRICTION ON ABSOLUTELY SMOOTH HORIZONTAL SURFACE
Loktionova Oksana Gennadievna Dr.Sci.Tech., associate professor
Yatsun Sergey Fedorovich Dr.Sci.Tech., professor
Рублев Сергей Борисович Rublev Sergei Borisovich
Волкова Людмила Юрьевна
Наумов Григорий Сергеевич
Юго-Западный Государственный Университет,
Курск, Россия
e-mail: teormehuhinbox. ru
В данной статье рассматривается трехзвенный робот, перемещающийся по гладкой горизонтальной поверхности. Разработана математическая модель объекта, представлены результаты численного моделирования перемещения устройства
Ключевые слова: ТРЕХЗВЕННЫЙ РОБОТ, ГЛАДКАЯ ПОВЕРХНОСТЬ, СИЛЫ ТРЕНИЯ, КОНТАКТНЫЕ ЭЛЕМЕНТЫ
Volkova Ludmila Yurievna
Naumov Grigorii Sergeevich South-West State University, Kursk, Russia
e-mail: teormehufrinbox. ru
In the given article we have shown the three-link robot, moving on smooth horizontal surface. The mathematical model of the object is designed, the results of the numerical modeling of the displacement device is presented
Keyword: THREE-LINK, SMOOTH SURFACE, POWER OF FRICTION, CONTACT ELEMENTS
Введение
Исследования в области создания механизмов, имитирующих поведение реальных биологических прототипов - новое, активно развивающееся направление развития науки. Имитация или копирование принципов поведения живых организмов позволяет создавать устройства, обладающие уникальными свойствами, которые находят конкретное практическое применение. Именно к таким устройствам относятся «змееподобные» роботы. В дальнейшем под змееподобным роботом будем понимать совокупность твердых тел связанных между собой шарнирами, которые оснащены приводами вращательного движения, позволяющими совершать звеньям относительное движение [2-9].
В настоящей работе исследуется характер движения звеньев при воздействии на них различных управляющих моментов.
Описание трехзвенного робота
Рассмотрим ползающего робота, состоящего из трёх звеньев, общий вид которого приведен на рис. 1. Звенья 1 и 2, 2 и 3 соединены между собой приводами вращательного движения 4 и 5. Взаимодействие робота с поверхностью происходит при помощи опорных элементов 6-9.
Описываемый робот отличается от известных тем, что крайние точки звеньев устройства оснащены опорными элементами 6-9, силы трения в которых с поверхностью являются управляемыми величинами, что достигается применением специальных приводов, изменяющих свойства контактных поверхностей [7]. Это приводит к тому, что в определенные моменты времени силы трения могут фиксировать на поверхности требуемые точки звеньев робота, а могут быть равны нулю. Отсюда вытекает то, что существуют две принципиально различные фазы движения объекта. В первой фазе при наличии сил трения можно говорить о движении робота по шероховатой поверхности, при этом происходит изменение положения центра масс объекта, во второй фазе - по гладкой поверхности, такой вид перемещения используется для изменения конфигурации устройства.
Фаза движения робота при отсутствии фиксации точек звеньев является наиболее сложной для моделирования, поэтому в данной работе уделено особое внимание исследованию поведения устройства именно в этой фазе.
i^l) чертеж по_л робота - Microsoft Word I I В И SS'-I
■ Файл Правка Вид Вставка Формат Сервис _.а6лица Окно Справка
j J а Ц л _? іі У Д -j4VI,4' '14 J J5 и
Веєдитє вопрос
X
j .-! Обычный + Time: v Timet New Roman
T 11
* ж К ч
А-Пйх1
*
3 ■ і ■ 2 1 і ■ 1 ■ і
I л ■
І1!1 Iі 2' Р-:' 3 ■ і ■ А ■ і
■ - ■
і ■ 6 ■ і 1 7 ■ і ■ Є ■ і 1 9 ■ і ■ 10 ■ і ■ 11 1 і ■ 12 ■ і ■ 13 1 і ■ 14 ■ і ■ 15 ■ і 1 16 ■ / ■ 17 ■
Г-J
Гм
Lfi
■JJ
г--.
00
■Т'
Г\1
Гч
Lfi
■JJ
г--.
00
■т-
= В
'3 ^ 4
ггг
j Рисование^ Автофигуры т \ ч □ о ді <4. О їй S -г . J ж ^ Т = Г.- - 2 Н J *
Стр. 1 Разд 1 1/1 Нз 2см Ст 1 Кол 2 русский (Рс ш
zynga
RU *
21:34 30.01.2013
Рис. 1. Общий вид робота: 1 - 3 - звенья, 4,5- приводы, 6 - 9 - опоры
Математическая модель робота
Для описания движения многозвенника введем абсолютную неподвижную систему координат Оху и относительные системы координат которые жестко связаны с точками 0\, 02, 0$. Углы ф, определяют повороты систем координат
относительно Оху (рис. 2).
При разработке математической модели будем считать, что все звенья робота /-1-КЗ являются абсолютно твердыми телами и представляют собой стержни длинами /,, массы т, которых сосредоточены в центрах их симметрии С,. Положение звеньев механической системы описывается вектором обобщенных координат:
Ч = (Ч\ 42 Чз си ЧзУ
в котором д\=хс\, д2=Ус\ ~ координаты центра масс звена 1 в системе Оху, <7з=Фь <?4=Ф2 и ^5=Фз - углы поворота звеньев.
Рис. 2. Расчетная схема робота
Система дифференциальных уравнений движения устройства записывается с использованием уравнений Лагранжа второго рода и в матричной форме имеет вид: тдрА(ф , В(ф - матрицы коэффициентов, /*’ - матрица обобщенных сил:
A(q)q + B(q)q =F
(3)
A(q) =
fau a12 % a\4 a15^ 'h\ b\2 bX3 b\4 *15'
a2l a22 a23 a24 a25 ^21 ^22 hi ^24 ^25
% a32 fl33 % % B(q) = h\ ^32 633 b34 b35
a4l a42 a43 $44 a45 Й41 ^42 b43 Й44 b45
4a51 a52 a53 a54 a55J h\ ^52 b53 ^54 b55 /
(4)
^ = (^11 F21 Fil F4l F5l f ' (5)
Коэффициенты матрицы A(q) определяются по формулам:
an=mx+m2 + m3 а12 = 0 <7r, =-(/1/2)sincp1(»72 +/и,) au = -(/2/2)sincp2(ff72 + 2m3) a15 = —/77- (/-, / 2)sinq>- a21 = 0 a22=m1 + m2 + m3 a23 ={lll2)cos(pl{m2 +m3) a24 = (/2/2)coscp2(/w2 + 2m3) a25 = ff73(/3/2)coscp3 a31 = ~{m2 +»7,)(/1/2)sincp1 a32 = (m2 + m^)(l1/2)cos(p = Jl + 0.25m2ll2 + 0.25m3l.2
a34 = (0.5m2 + m3)(/1/2/2)cos(cp1 -ф2) tf35 = ?w3 (/х/3/4)cos(<Pl -cp3) tf41 = -(/w2 + 2ff73)(/2/2)sincp2 я42 = (m2 + 2ff73)(/2/2)coscp2 tf43 = (0.5m2 + m3)(/1/2/2)cos(cp1 -ф2) tf44 = (J2 + 0.25m2l22 + тъ12) a45 = m3(l2l3/2)cos(q>2 -cp3) tf51 = -/w3 (/3 /2)sincp3 я52 = m3 (/3 /2)coscp3 я53 = m3 (1Л13 /4)008(9! _Фз)
^54 = (^2^3 /2)ОТ3 C0S(92 -Фз ) ^55 = + °-25
Коэффициенты матрицы 5(g) равны:
bn =0 bl2= 0 bl3 = ~(m2 + m3)fc/2)cosq>! bu = ~{m3 + 2ff73)(/2/2)sincp2 bl5 = -»73(/3/2)coscp3 621 =0 b22 = 0 623 = ~{m2 + m3)(ll/2)sin(pl b24 = ~(m2 + 2ff73)(/2/2)sincp2 b25 = -ff73(/3/2)sincp3 b3l = 0 b32 = 0 b33 = 0 634 = (0.5m2 + m3%l2/2)sin(<pL -ф2) b35 = m3(/^/4)sin(cpL -cp3)
? ? ? ? ? ? ?
Коэффициенты матрицы F записываются следующим образом:
Моделирование движения робота
В качестве объекта моделирования рассматривается трехзвенный робот, массы и длины звеньев которого равны: nij=\ кг, /,=1 м. В качестве начальных условий моделирования используются нулевые: 1=0 с, xCi=0 м, м/с, ус\=0 м, м/с, (р\=0 рад, ф2=0 рад, фз=0 рад.
Процесс нахождения численных значений угловых и линейных перемещений, скоростей и ускорений проведем в программной среде MathCad, с использованием специального алгоритма интегрирования, позволяющего считать вторые производные от обобщенных координат константами на интервале [/„ /, И], где h - изначально заданный шаг по времени.
Цель моделирования - исследование влияния действия моментов М12 (М2\) и М32 (М23) на перемещения звеньев системы при отсутствии фиксации звеньев на поверхности.
Рассмотрим движение робота под действием момента МЪ2, закон изменения которого описывается формулой:
при t* = 2 с, М32°=1 Нм.
Движение робота прекращается при достижении третьим звеном угла <рз=л.
Положения звеньев механизма на плоскости в некоторые моменты времени приведены на рис. 3.
Ol
04
О*
Ol
а
х о
04
03
&
Ol
в
04
Ol
ft
vcy • о,
O:
Oi.
04
0;5 A 01 y'
^ ^03
04 03
С
• -
02
Д
Рис. 3. Положения звеньев на плоскости в моменты времени: а) 1=0 с (начальное положение); б) 1=0,25 с; в) 1=0,5 с; г) 1=0,75 с; д) 1=0,9 с; е) 1=1,05 с (конечное положение) при действии моментаМ
32
fCl
Ус2
V
м
М 0.32 024 016 0.08 О
■0.08
•0.16
0.24
■0.35
-0.4
l ' 4 h
■Ц, II
Г) N.
**
/ j
* ■ ■ v /
* * \, >
<Р\ J ________ 4
0 0.2 0.4 0.6 0.8 1 12 1.4 1.6 1.8 2
ХС1 • ХС2 ’ ХСЗ ’м
а
<Pi з 2 1
0
1 2
<Рз
рад
* * J
i fe
/
/ «
-I
i*< * ■“
0 0.12 0.24 0 36 0.48 0.6 0.72 0.84 0.96 1.08 1.2 t, сек
Рис. 4. Графики, полученные в результате численного моделирования: а) траектории движения центров масс звеньев; б) график изменения углов поворота звеньев относительно абсолютной системы координат во времени
По данным графикам видно, что звенья системы совершают сложное движение, причем звенья 1 и 3 всегда вращаются против часовой стрелки, а второе звено вначале поворачивается навстречу звеньям 1 и 3, а затем меняет направления вращения на противоположное. Центр масс системы - точка С - при этом остается неподвижным.
В случае, если система движется под действием моментаМ2\, изменяющегося по закону:
при = 2 с, М21°=1 Нм,
до выполнения условия <р2=п, положения звеньев робота в фиксированные моменты времени имеют вид, представленный на рис. 4. По графикам видно, что звено 2 устройства поворачивается против часовой стрелки до тех пор, пока не выполнится условие (р2=п, звенья 1 и 3 при этом вначале вращаются по часовой стрелке, а затем меняют направление вращения и все звенья устройства поворачиваются против часовой стрелки. Положение центра масс системы также остается неизменным.
Ol
Ol ^ 02 С 03 4) 04 у
«>, ф, А
Oi
ft О: 9, ft
а
Ol
OS
Os
Ol
04
ft ft 04
В
х Оз
Ol ip-
х 03
С Г й
(К 02
д
Оз у*
04
-о Оз
Ol
Ol
Ж
Рис. 5. Положения звеньев на плоскости в моменты времени: а) 1=0 с (начальное положение); б) 1=0,25 с; в) 1=0,5 с; г) 1=0,75 с; д) 1=1 с; е) 1=1,25 с; ж) 1=1.5 с (конечное положение) при действии моментаМ;
21
■'а
с-;. м
04
0.32
0.24
0.16
008
О
-0.08
-0.16
-0.24
■0.32
-0.4
л
4
\
4
V
■**
О 0.2 0.4 06 08 1 12 1 4 1 6 1.8 2
Cl ’ С2 ’ СЗ
, М
а б
С1 С1 С1
Рис. 6. Графики, полученные в результате численного моделирования: а) траектории движения центров масс 3 звеньев; б) график изменения углов поворота СР| звеньев относительно абсолютной системы координат во времени
Рассмотрим движение объекта под действием моментов М12 и М32, имеющих одинаковые модули и противоположные направления и изменяющихся по следующим законам:
М32°, О<t<t*,
о, t>t*,
при ?* = 2 с, М12°= - 1 Нм, М32°= 1 Нм.
В этом случае наблюдается симметричное движение звеньев 1 и 3 относительно центра масс системы, звено 1 поворачивается по часовой стрелке, а звено 3 - против часовой, звено 2 движется поступательно в отрицательном направлении оси Оу
I7 С \ -5
Ol 02 <P> 03 ^ Ф ' 04
Оз 04
а
Ol
04
Ol
<Р, 02
03 Vi
с
-ф-
04
№
1 02
в
(04
С
02 03
д
Рис. 7. Положения звеньев на плоскости в моменты времени: а) 1=0 с (начальное положение); б) 1=0,2 с; в) 1=0,4 с; г) 1=0,6 с; д) 1=0,8 с (конечное положение) при действии моментов М12 иМ
32
Заключение
В работе рассматривается трехзвенный робот, силы взаимодействия опорных элементов которого с поверхностью являются управляемыми величинами. Представлена математическая модель объекта, описывающая фазы движения устройства при отсутствии взаимодействия опорных элементов конструкции робота с поверхностью, что соответствует движению робота по гладкой поверхности. Разработан алгоритм движения устройства, получены и проанализированы результаты численного моделирования перемещения робота по горизонтальной поверхности без учета сил сопротивления.
Список литературы
1. Лаврентьев М. А., Лаврентьев М. М. Об одном принципе создания тяговой силы движения // Журнал прикладной механики и технической физики. 1962. № 4. С.3-9.
2. Hirose S., Monshima /1. Design and control of a mobile robot with an articulated body // International Journal of Robotic Research. 1990. V. 9, No. 2. P. 99-115.
3. Hirose S. Biologically Inspired Robots: Snake-like Locomotors and Manipulators // Oxford: Oxford Univ. Press, 1993. 220 p.
4. Li N., Furuta K., Chemousko F. L. Motion Generation of the Capsubot Using Internal Force and Static Friction // Proc. 45th IEEE Conf. on Decision and Control, Manchester Grand Hyatt Hotel, San Diego, CA, USA, December 13-15, 2006. P. 6575-6580.
5. Burdick J. W., Radford J., Chirikjan G. S. A “sidewinding” locomotion gait for hyper-redundant robots // Proc. 1993 IEEE Intern. Conf. on Robotics and Automation. Atlanta, 1993. Vol. 3. P. 101-106.
6. Мальчиков A.B. Исследование движения плоского шестизвенного внутритрубного мобильного робота [Текст] / А.В. Мальчиков, С.Ф. Яцун, С.Б. Рублев // Известия Самарского научного центра Российской академии наук. - Самара. - 2012. - №4 (5). - С. 1263-1265.
7. Мальчиков А.В. Динамические опорные элементы ползающих роботов для движения по наклонным поверхностям [Текст] / А.В. Мальчиков, С.Ф. Яцун, А.И. Жакин // Известия Юго-западного государственного университета. - Курск. - 2012. - №2(41).Ч. 1- С.89-95.
8. Черноусько Ф.Л., Шундерюк М.М. Влияние сил трения на динамику двузвенного мобильного робота // ПММ. - 2010. - Т. 74, Вып. 1. - С. 22-36.
9. Болотник Н.Н., Фигурина Т.Ю., Черноусько Ф.Л. Оптимальное управление прямолинейным движением системы двух тел в сопротивляющейся среде // ПММ. - 2012. - Т. 76, Вып. 1. - С. 3-22.
1. Lavrent'ev М. A., Lavrent'ev М. М. Ob odnom principe sozdanija tjagovoj sily dvizhenija // Zhurnal prikladnoj mehaniki i tehnicheskoj fiziki. 1962. № 4. S.3-9.
2. Hirose S., Monshima /1. Design and control of a mobile robot with an articulated body // International Journal of Robotic Research. 1990. V. 9, No. 2. P. 99-115.
3. Hirose S. Biologically Inspired Robots: Snake-like Locomotors and Manipulators // Oxford: Oxford Univ. Press, 1993. 220 p.
4. Li N, Furuta K., Chemousko F. L. Motion Generation of the Capsubot Using Internal Force and Static Friction // Proc. 45th IEEE Conf. on Decision and Control, Manchester Grand Hyatt Hotel, San Diego, CA, USA, December 13-15, 2006. P. 6575-6580.
5. Burdick J. W., Radford J., Chirikjan G. S. A “sidewinding” locomotion gait for hyper-redundant robots // Proc. 1993 IEEE Intern. Conf. on Robotics and Automation. Atlanta, 1993. Vol. 3. P. 101-106.
6. Mal'chikov A.V. Issledovanie dvizhenija ploskogo shestizvennogo vnutritrubnogo mobil'nogo robota [Tekst] / A.V. Mal'chikov, S.F. Jacun, S.B. Rublev // Izvestija Samarskogo nauchnogo centra Rossijskoj akademii nauk. - Samara. - 2012. - №4 (5). - S. 1263-1265.
7. Mal'chikov A.V. Dinamicheskie opornye jelementy polzajushhih robotov dlja dvizhenija po naklonnym poverhnostjam [Tekst] / A.V. Mal'chikov, S.F. Jacun, A.I. Zhakin // Izvestija Jugo-zapadnogo gosudarstvennogo universiteta. - Kursk. - 2012. - №2(41).Ch. 1- S.89-95.
8. Chernous'ko F.L., Shunderjuk M.M. Vlijanie sil trenija na dinamiku dvuzvennogo mobil'nogo robota // PMM. - 2010. - T. 74, Vyp. 1. - S. 22-36.
9. BolotnikNN, Figurina T.Ju., Chernous'ko F.L. Optimal'noe upravlenie pijamolinejnym dvizheniem sistemy dvuh tel v soprotivljajushhejsja srede //PMM. - 2012. - T. 76, Vyp. 1. - S. 3-22.
