Моделирование прыжка четырехзвенного робота

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


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

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

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

УДК 62−503. 5
МОДЕЛИРОВАНИЕ ПРЫЖКА ЧЕТЫРЕХЗВЕННОГО РОБОТА
Яцун С. Ф., Локтионова О. Г., Серебровский В. В., Волкова Л. Ю.
ФГБОУ ВПО «Юго-Западный государственный университет», Курск, e-mail: teormeh@inbox. ru
В статье представлена расчетная схема четырехзвенного робота, перемещающегося с отрывом от поверхности, соединения звеньев которого представляют собой две пары вращательного движения и одну пару поступательного движения. Вращательные пары используются для позиционирования объекта перед отрывом от поверхности, а поступательная пара выступает в роли разгонного модуля. Для исследуемого объекта разработана математическая модель и предложен алгоритм моделирования прыжка. В работе рассматривается реализация объектом прыжка, при которой во время позиционирования перед прыжком устройство взаимодействует с поверхностью корпусом, во время разгона на поверхности находится звено ноги, приземление и позиционирование после приземления происходит при взаимодействии корпуса с поверхностью.
В соответствии с разработанной последовательностью этапов прыжка осуществлено тестирование алгоритма и программы моделирования, получены закономерности перемещения устройства в зависимости от способа втягивания звеньев ноги во время этапа полета.
Ключевые слова: прыгающий робот, многозвенный механизм, этапы прыжка, позиционирование, разгон, полет, приземление
MODELLING OF THE JUMP OF THE FOURLINK ROBOT Jatsun S.F., Loktionova О.G., Serebrovsky V.V., Volkova L.Y.
South-West State University, Kursk, e-mail: teormeh@inbox. ru
The settlement scheme of the four-link robot moving with a jump from a surface which connections of links represent two couples of rotary motion and one couple of progress motion is presented in article. Rotary couples are used for object positioning before a jump from a surface, and the progress couple is represented the lift-off module. The mathematical model of movement of object is developed, the algorithm of modeling of a jump of the robot is offered. Realization of a jump of the object at which during positioning before jump the body of the device interacts with a surface, during lift-off on a surface there is a foot link, the landing and positioning after a landing occurs at body interaction to a surface is considered. According to developed sequence of stages of a jump testing of algorithm and the modeling program is carried out, regularities of movement of the device depending of a method of retraction of foot links during a flight stage are received.
Keywords: jumping robot, multilink mechanism, stages of the jump, positioning, lift-off, flight, landing
Роботы, перемещающиеся с отрывом от поверхности, являются объектами исследования многих ученых, таких как Б. Браун, Дж. Цеглин, С. Дубовский, П. Фиорини, М. Ковас, Д. Флориано [9−13], и крупных инженерных компаний, включая Бостон Дайнемикс [14]. Исследуемые роботы разнообразны по конструкции, массогабаритным параметрам, высоте и длине реализуемого прыжка. Но их можно классифицировать по ряду признаков: способам позиционирования до и после отрыва от поверхности, количеству звеньев, типу привода, посредством которого осуществляется разгон до отрыва от поверхности.
Среди способов позиционирования до полета наиболее распространенными являются поворот корпуса робота на колесах или ногах или же изменение угла наклона корпуса к поверхности за счет изменения положения его центра масс, а также поворот разгонного модуля относительно неподвижного корпуса. После приземления прыгающие роботы могут позиционироваться для достижения устойчивого положения, из которого возможна реализация следующего прыжка путем изменения геометрии звеньев устройства или же за счет изменения положения центра масс.
Еще одним классификационным признаком прыгающих роботов является количество входящих в них звеньев. Различают роботов двух-, трех- и четырехзвенных. Для отрыва роботов от поверхности могут использоваться различные приводы: пневматические, гидравлические, с накопителями энергии, работающие на топливно-воздушной смеси, а по виду движения, совершаемого звеньями в момент разгона, различают пары вращательного и поступательного движения.
В данной работе рассматривается четырехзвенный прыгающий робот, разгон ко -торого до отрыва от поверхности осуществляется парой поступательного движения, в качестве привода используется привод с накопителем энергии, причем в момент отрыва от поверхности с последней взаимодействует нога устройства, а при приземлении — корпус. Позиционирование объекта для реализации прыжка с заданными параметрами осуществляется путем поворота разгонного модуля относительно корпуса, позиционирования робота после приземления не требуется, т.к. следующий прыжок устройство может совершить с той из сторон корпуса, на которую произошло приземление. Приведен алгоритм моде-
лирования одного прыжка объекта, представлены результаты, полученные численным путем.
Математическая модель прыгающего робота
Будем рассматривать прыгающего робота, состоящего из четырех звеньев 1−4, первое из
которых является стопой, второе и третье образуют ногу, а четвертое представляет собой корпус (рис. 1). На звеньях 2 и 4 установлены приводы, обеспечивающие поворот звеньев 1 и 3 относительно звеньев 2 и 4. На звене 2 также установлен привод, позволяющий звеньям 2 и 3 поступательно перемещаться друг относительно друга [2, 7, 8].
Рис. 1. Расчетная схема четырехзвенного прыгающего робота
Прыжок робота происходит в вертикальной плоскости Оху с горизонтальной шероховатой поверхности, совпадающей с осью Ох. При разработке математической модели будем считать, что звенья 1 = 1 — 3 объекта являются абсолютно твердыми стержнями длинами I, а звено 4 — абсолютно твердым прямоугольником ААААа размерами 2а*2Ь. Масса т. каждого звена сосредоточена в центре его симметрии — точке С Расстояние I между точками О2 и С4 соответствует длине ноги.
Положение центров масс звеньев робота определяется радиусами-векторами
П =
2 =
Ґх1+11/2 соэф! +12/2совф2 у1 + 1Х/2 віп ф1 + /2/2 вігі ф2
гъ =
х, + /, /2 сое ф, + (/23 -/3/2)созф2 И + /, /2 эт ф, + (/23 -/3/2)зт ф2
V
— (*+/і/2С08ф1+/2зС08ф2
V —
4 І З'-і+А/^ФіНз 8Іпф2
(1)
(2)
(3)
(4)
Положение звеньев робота описывается вектором координат [7]
я = (л Ух* у4 Ф1 Ф2 Ф4 4з У & gt- (5)
где х1, у х4, у4 — координаты центров масс звеньев 1 и 4, (р1, ф2 и ф4 — углы поворота звеньев 1, 2 и 4, 123 — длина ноги робота. Углы ф1 и ф2 представляют собой углы между звеньями 1, 2 и положительным направлением оси Ох. Угол ф4 представляет собой угол, под которым сторона корпуса, А А наклонена к горизонтальной оси.
Для записи системы дифференциальных уравнений движения объекта используются уравнения Лагранжа второго рода. Кинетическая энергия системы определяется по формуле
Т =, (6)
г=1
где 1 = 1−4 — звенья робота.
Каждое звено робота совершает плоское движение, поэтому кинетическая энергия. -го звена вычисляется следующим образом
Tl=ml (i-+yf)/2+Jtil2, (7)
где /12, JA = т4(а +Ь) —
центральные моменты инерции звеньев-
yt — проекции скорости центра масс /-ого звена на оси системы координат- ф-. — угловая скорость /-го звена.
Система дифференциальных уравнений движения робота может быть записана в матричной форме
A (q)q + B (q)q2 + С (?)ф2/23 = F, (8)
где A (q), B (q), C (q) — матрицы коэффициентов- F — матрица обобщенных сил.
Прыжок устройства состоит из последовательности семи этапов, каждый из которых характеризуется определенным видом движения звеньев [5, 6]. Во время этапов 1−3 происходит позиционирование объекта для совершения прыжка, при этом корпус робота взаимодействует с поверхностью, а разгонный модуль, состоящий из звеньев 1−3, меняет свое положение относительно корпуса для реализации прыжка под требуемым углом к горизонту. Четвертый этап соответствует разгону устройства, во время которого звено 1 находится на поверхности, а звенья 3 и 4 приобретают скорость, достаточную для отрыва робота от поверхности. Этап 5 характеризует движение робота с отрывом от поверхности, при этом наблюдается втягивание звеньев 1 и 2 в корпус, а этапы 6 и 7 — приземление объекта на корпус и его позиционирование до тех пор, пока одна из сторон корпуса не будет лежать на поверхности.
На геометрические размеры звеньев робота наложены ограничения, обусловленные последовательностью этапов движения
/27 +1,& lt-Ь- /™ +1г& lt-а-, l2 & lt- b- l2 & lt- a-
/з & lt- b- I3 & lt- a- /& quot->--* (9)
3 3 sin ф2
где ф2 — угол наклона звена 2, при котором происходит разгон объекта до его отрыва от поверхности.
Прыжок исследуемого робота является программно-управляемым, причем управление осуществляется на этапах 1−5, ког -да происходит позиционирование и разгон устройства для отрыва от поверхности, а также непосредственно полет, этапы 6 и 7, во время которых осуществляется приземление, являются неуправляемыми. Управляющими воздействиями являются моменты, формируемые приводами вращательного движения, которые обеспечивают повороты звеньев робота на требуемые углы, а также сила, создаваемая линейным приводом, за счет которой происходит относительное перемещение звеньев 2 и 3. В данной работе будем рассматривать случай, когда указанные величины являются кусочно-постоянными функциями, численные значения которых на каждом из этапов прыжка являются константами.
Модель взаимодействия с поверхностью
При реализации одного прыжка робот взаимодействует с шероховатой поверхностью звеном 1 или 4 на одних этапах и перемещается с отрывом от поверхности на других. Будем считать, что при нахождении звена 1 или 4 на поверхности возникают распределенные силы трения и нормальной реакции, которые приводятся к центру приведения — точке К, расположение которой на данном этапе исследований не рассматривается. Сила взаимодействия данной точки с поверхностью может быть описана различными моделями трения: сухое кулоново трение, трение с непрерывно падающей характеристикой (не-кулоново трение), трение с уменьшенной динамической составляющей [3, 4]. Будем рассматривать случай, когда в точке К при взаимодействии с поверхностью будет возникать сила сухого трения, изменяющаяся по закону [1]:
Ffr-
-JN sgn (x^), если хк Ф 0-
-F0x, если і* = 0, |F0x& lt-JN-
-fNsgn (F0), если хк= 0, F0x& gt-JN.
(iG)
где F0x — горизонтальная проекция равнодействующей всех сил, кроме силы сухого трения, приложенных к звену, которое взаимодействует с поверхностью- / - коэффициент трения скольжения- N — нормальная
реакция в опорной точке К- хк — скорость точки К вдоль оси Ох.
Будем рассматривать случай, когда модуль возникающей силы трения всегда
меньше предельного значения
скольжение тела по поверхности отсутствует. Силами вязкого сопротивления в данной работе будем пренебрегать.
Алгоритм моделирования движения робота
Моделирование движения робота проводится по алгоритму, приведенному на рис. 2, 3. Определение этапа прыжка, в ко -тором находится объект, осуществляется
при помощи счетчика п. Значение п = 1 со- второй этап при п = 2, на котором стопа
ответствует первому этапу, заключающе- робота поворачивается до тех пор, пока не
муся в повороте ноги до достижения угла станет параллельной опорной поверхности
ф2=ф". После этого объект переходит во (ф1=ф°=тс — для прыжка вперед).
Рис. 2. Алгоритм моделирования одного прыжка робота (начало)
Рис. 3. Алгоритм моделирования одного прыжка робота (конец)
После выполнения указанного условия счетчик увеличивается на единицу п = 3, объект находится в третьем этапе, который заканчивается при достижении стопой опорной поверхности — у1 = 0. Четвертый этап (п = 4), во время которого объект разгоняется, завершается в момент отрыва стопы от поверхности, чему соответствует выполнение условия N = 0, начинается пятый этап (п = 5) движения устройства до тех пор, пока одна из точек корпуса А, у = 1−4 не начнет взаимодействовать с поверхностью У л — 0.
При приземлении происходит обнуление скорости точки (точек) контакта с поверхностью, чему соответствует шестой этап движения робота (п = 6), а затем (п = 7) наблюдается движение, которое закончится после того, как одна из сторон корпуса станет взаимодействовать с поверхностью.
Результаты численного моделирования
Преобразуем разработанную математическую модель реализации одного прыжка робота к безразмерному виду, используя масштабные коэффициенты: М = 0,05 кг, Т = 0,1 с, Ь = 0,1 м. Объектом моделиро-
вания является прыгающий робот, массы и геометрические размеры звеньев которого равны: т = 1, т = 1, т3 = 1, т4 = 7, а = 1, Ь = 1, 11 = 0,5, /2 = 0,9, 13 = 0,9. Начальными условиями моделирования являются следующие: г = 0, х4 = а, х4 = 0, у = Ь, у4 = 0,
ф4 = 0, ф4 = 0, ф1 = п, = о, ф2 = п/2, ф2 = 0.
& gt-'-4 10
4 / / & gt- 4 І I Г •:3 і • Ї І __ у
1-«- • /. -: / і .* / '-г/ '-.у «1 і 4 І * ^ «• * ¦ /1

Для тестирования разработанных алгоритма и программы моделирования прыжка робота был рассмотрен случай, когда во время этапа полета не происходит втягивания звеньев ноги в корпус. Это соответствует движению робота как материальной точки, брошенной под углом к горизонту.
10
15
20 х4
& gt-'-4
8
И 2
/ & quot-
/ *& quot-* …
«*
// / V
%
у / '. У
/ -і V • ¦- 2 V,
10
30 *4
30
20
10
А

я^__ & lt-
3. 5
4. 5

в г
Рис. 4. а, в — траектории движения центра масс корпуса при отсутствии втягивания ноги в полете, полученные программно, при, а — /°3 =4, И = 1,5: 1 — ф2 = 71/4, 2 — ф2 =71/3,
3-ф2 =4я/9, 4-Ф2 =я/2, е-ф2 =71/4, И = 1. 5: I /2°3 =3, 2 — /23 = 4, 3 — /2°3 = 5,
б, г — зависимости Н (Ф5). ?(*5) X X — программные, ООО — аналитические
Вращения корпуса в полете относительно его центра масс не происходит в связи с тем, что разгоняющая сила проходит через точку С Было проведено сравнение рассчитанных в программе высоты Н и длины Ь прыжка объекта, под которыми понимались наибольшие расстояния вдоль осей Оу и Ох с момента отрыва звена 1 от поверхности до завершения прыжка, с вычисленными аналитическим способом высотой и дальностью полета тела, брошенного под углом к горизонту, результаты которого приведены на рис. 4. На данном и последующих рисунках при-
няты обозначения: ф2 — угол наклона ноги к оси Ох, под которым приложена сила, осуществляющая отрыв робота от поверхности, /®з — скорость робота в момент начала этапа полета, И — значение ординаты центра масс корпуса робота в момент отрыва последнего от поверхности.
По приведенным графикам видно, что относительная погрешность между значениями высоты и длины прыжка, определенными программно и аналитически, не превышает 0,5%, что свидетельствует о достаточной точности разработанных алгоритма и программы.
б
а
Уа
N
ir И*'- Г N * 1 * а •
V * V* 2V
ю
15
20 Xt
20
15
10
1 *

н
~ ^ '- '- -
10

Г1 / 1 / 1 / 1. *• X/1
/ «1% / 4 L 2 3
20
15
10

1
.
1 * гг ¦ - -_]

10
и
20 Xj
10
F2i5
Рис. 5. а, в — траектории центра масс корпуса робота при, а — 1 — /23 =0, 2 — /23 = 2,5. 3 — /253 =5, 4 — /23 =7,5, в — 1 —23 =0, 2 —23 =1, 3 — -^23 = 2,5, 4 —23 = 5, б, г — высота и длина прыжка в зависимости от б — /23, г —
б
а
в
г
Так как при реализации прыжка роботом звенья ноги будут втягиваться в корпус во время полета, это движение будет оказывать влияние на траекторию центра масс корпуса и на значения высоты и длины прыжка. Рассмотрим два способа втягивания ноги
в полете: с постоянной скоростью /23 и под
действием постоянной силы _/^3. На рис. 5
приведены траектории движения точки С4 и зависимости высоты и длины прыжка от значений /23 и Т^.
По графикам рис. 5, а, в видно, что траектория прыжка робота при равномерном втягивании ноги в корпус имеет вид параболы, выпуклость которой направлена вверх, втягивание ноги под действием силы сильно меняет характер траектории.
Прыжок на наибольшие высоту и длину происходит при отсутствии втягивания
ноги в полете, а с увеличением скорости23 и силы -Р^з высота и длина прыжка убывают
по некоторым криволинейным зависимостям (рис. 5, б, г), причем при постоянной
скорости /23 кривая убывает достаточно
плавно, а при действии силы вначале на-
блюдается резкое падение высоты и длины прыжка, а затем их плавное убывание.
Заключение
В статье рассмотрен четырехзвенный прыгающий робот, состоящий из корпуса, ноги, образованной двумя звеньями, и стопы, прыжок устройства представлен в виде последовательности этапов, характеризующихся определенными видами движений звеньев. Для указанного объекта разработана математическая модель, в соответствии с которой осуществлено численное моделирование прыжка устройства по специальному алгоритму.
В статье приведены результаты движения робота в полете как материальной точки, для этого случая проведено тестирова-
ние алгоритма и программы, которое показало высокую сходимость с данными аналитического решения. Выявлено влияние на траекторию движения робота и на значения высоты и длины прыжка скорости втягивания звеньев ноги в полете, а также силы, под действием которой это втягивание осуществляется.
Работа выполнена в рамках гранта РФФИ № 10−08−769-а, госконтракта № П699 тема № 1. 109. 10ф.
Список литературы
1. Динамика управляемых движений вибрационных систем / Н. Н. Болотник, И. М. Зейдис, К. Циммерман и др. // Изв. РАН. ТиСУ — 2006. — № 5. — С. 157−167.
2. Волкова Л. Ю., Серебровский В. В., Яцун С. Ф. Исследование движения многозвенного робота, перемещающегося с отрывом от поверхности // Известия Юго-Западного государственного университета. — 2012. — № 1 (40). — Ч. 2. — С. 12−18.
3. Лушников Б. В. Испытательный стенд для идентификации динамических параметров сухого некулонова трения // Фундаментальные исследования. — 2012. — № 3. — Ч. 3. — С. 238−241.
4. Лушников Б. В. Компьютерное моделирование динамики элемента сухого некулонова трения // Известия Самарского научного центра Российской академии наук. -2010. — T. 12. — № 1(2). — С. 439−444.
5. Яцун С. Ф., Волкова Л. Ю. Исследование влияния закона втягивания ноги в полете на высоту и длину прыжка многозвенного робота // Materialy IX mezinarodni vedecko -prakticka conference «Modern! vymozenosti vedy — 2013». -Praha, Str. 77−81.
6. Яцун С. Ф., Волкова Л. Ю. Управление высотой и длиной прыжка робота путем его позиционирования и разгона // Известия ЮЗГУ Серия Техника и технологии. — 2012. -№ 2. — Ч. 1. — С. 210−213.
7. Яцун С. Ф., Волкова Л. Ю., Рублев С. Б. Исследование управляемого прыжка многозвенного робота // Актуальные вопросы технических наук (II): материалы междунар. заоч. науч. конф. — Пермь, 2013. — С. 62−65.
8. Яцун С. Ф., Рукавицын А. Н., Волкова Л. Ю. Исследование динамики управляемого прыжка робота // Известия Самарского научного центра Российской академии наук. -2012. — Т. 14. — № 4(5). — С. 1355−1358.
9. Brown, B., Zeglin, G. Control of a bow leg hopping robot // IEEE Int. Conf. on Robotics and Automation. — 1998. -№ 1. — P. 793−798.
10. Dubowsky S., Plante JS., Boston P. Low Cost Micro Exploration Robots for Search and Rescue in Rough Terrain // IEEE International Workshop on Safety, Security and Rescue Robotics, USA. — 2006. — P. 25−30.
11. Fiorini P., Hayati S., Heverly M., Gensler J. A Hopping Robot for Planetary Exploration // Proc. of IEEE Aerospace Conf., Snowmass. — 1999. — P 38−43.
12. Kovac M., Schlegel M., Zufferey J.C., Floreano D. A miniature jumping robot with self-recovery capabilities // IEEE/RSJ international conference on robotics and automation. — 2009. — P. 583−588.
13. Kovac M., Schlegel M., Zufferey J. -C., Floreano D. Steerable miniature jumping robot // Autonomous Robots. -2010. — № 28. — P. 295−306.
14. SandFlea — Leaps Small Buildings in a Single Bound Available at: http: //www. bostondynamics. com/robot_sandflea. html (accessed 5 July 2012).
References
1. Bolotnik N. N., Zeidis I.M., Zimmerman K. et. al. Dynamics of operated movements of vibration systems // Izv. RAN. TiSU. 2006. no. 5. pp. 157−167.
2. Volkova L. Yu., Serebrovsky V.V., Jatsun S.F. Research of movement of the multilink robot moving with a jump from a surface // Izvestia South-West State University. 2012. no. 1 (40). Part 2. pp. 12−18.
3. Lushnikov B.V. The test bench for identification of dynamic parameters dry nocoulomb friction // Basic researches. 2012. no. 3. Part 3. pp. 238−241.
4. Lushnikov B.V. Computer modeling of dynamics of an element dry nocoulomb friction // Izvestiya Samara scientific centre of Russian Academy of Sciences. 2010. Vol. 12. no. 1(2). P. 439−444.
5. Jatsun S.F., Volkova L. Yu. Research of influence of the law of retraction of a leg in flight on height and length of a jump of the multilink robot // Materialy IX mezinarodni vedecko -prakticka conference «Moderni vymozenosti vedy — 2013». Praha. 2013/ pp. 77−81.
6. Jatsun S.F., Volkova L. Yu. Control of height and length of a jump of the robot by its positioning and lift-off // Izvestia South-West State University. 2012. no. 2. Part. 1. pp. 210−213.
7. Jatsun S.F., Volkova L. Yu., Rublev S.B. Research of an operated jump of the multilink robot // Actual questions of technical science (II): materials international correspondence scientific conference. Perm, 2013. pp. 62−65.
8. Jatsun S.F., Rukavitsyn A.N., Volkova L. Yu. Research of dynamics of operated jump of the robot // Izvestiya Samara scientific centre of Russian Academy of Sciences. 2012. Vol. 14. no. 4(5). pp. 1355−1358.
9. Brown B., Zeglin, G. Control of a bow leg hopping robot // IEEE Int. Conf. on Robotics and Automation. 1998. no. 1. pp. 793−798.
10. Dubowsky S., Plante J.S., Boston P. Low Cost Micro Exploration Robots for Search and Rescue in Rough Terrain // IEEE International Workshop on Safety, Security and Rescue Robotics, USA. 2006. pp. 25−30.
11. Fiorini P, Hayati S., Heverly M., Gensler J. A Hopping Robot for Planetary Exploration // Proc. of IEEE Aerospace Conf., Snowmass. 1999. pp. 38−43.
12. Kovac M., Schlegel M., Zufferey J.C., Floreano, D. A miniature jumping robot with self-recovery capabilities // IEEE/RSJ international conference on robotics and automation, 2009. pp. 583−588.
13. Kovac M., Schlegel M., Zufferey J. -C., Floreano D. Steerable miniature jumping robot // Autonomous Robots. 2010. no. 28. pp. 295−306.
14. SandFlea — Leaps Small Buildings in a Single Bound Available at: http: //www. bostondynamics. com/robot_sandflea. html (accessed 5 July 2012).
Рецензенты:
Кобелев Н. С., д.т.н., профессор, заведующий кафедрой теплогазоснабжения и вентиляции, ЮЗГУ, г. Курск-
Игнатенко Н. М., д.т.н., профессор, заведующий кафедрой общей и прикладной физики, ЮЗГУ, г. Курск.
Работа поступила в редакцию 07. 08. 2013.

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