УДК 681.5
Выбор кинематической структуры и исследование динамики древовидного исполнительного механизма робота-краба
А.К. Ковальчук
В настоящее время большое внимание уделяется исследованию и созданию транспортных средств, использующих для своего перемещения принцип шагания. Возможность таких механизмов перемещаться при отсутствии сплошной колеи, по сильно пересеченной местности и в условиях завалов, а также их высокая проходимость, делает их применение более эффективным, по сравнению с гусеничными и колесными машинами, для выполнения специальных операций.
Исполнительные механизмы шагающих роботов имеют древовидную кинематическую структуру. Оптимальный выбор структуры таких механизмов и исследование их динамики является важной научно-технической задачей при их проектировании.
В статье рассмотрена кинематическая схема исполнительного механизма восьминогого шагающего робота, оснащенного двумя манипуляторами. В качестве биологического прототипа при выборе схемы использован скелет краба. Кинематика и динамика исполнительного механизма робота описана методом, основанным на совместном использовании матриц (4x4), имеющих широкое применение в робототехнике и теории графов.
В системе MATLAB с помощью специально составленной программы моделирования исследована кинематика и динамика древовидного исполнительного механизма робота. Получены численные значения элементов матриц A(q), B(q, ¿1), C(q) и H(q), входящих в уравнение динамики робота, а также значения моментов в степенях подвижности.
Предложенный в работе алгоритм выбора древовидных кинематических структур исполнительных механизмов роботов и исследования их динамики, а также программа моделирования в системе MATLAB являются эффективным средством, позволяющим сократить сроки проектирования перспективных образцов шагающих роботов.
Ключевые слова: шагающий робот, древовидный исполнительный механизм, уравнение динамики робота.
Choosing the Kinematic Structure and Dynamics Study of Tree-like Robot Crab Actuator
A.K. Kovalchuk
Currently, much attention is given to research and création of vehicles that use the principle of walking for its moving. The ability of such mechanisms to
КОВАЛЬЧУК Александр Кондратьевич (МГТУ им. Н.Э. Баумана)
KOVALCHUK Alexander Kondratyevich
(Moscow, Russian Federation, Bauman Moscow State Technical University)
move in the absence of a solid track, across rugged terrain and under the rubble, as well as high passability, makes their use more efficient, compared to the tracked and wheeled vehicles, and to carry out special operations. Walking robots actuators have a tree-like kinematic structure. Optimal choice of such mechanisms structure and dynamics study are the important scientific and technical problem while designing. The article considers the kinematic scheme of the actuator eight-legged walking robot, equipped with two manipulators. The skeleton of a crab was used as biological prototype while choosing the kinematic scheme. The kinematics and dynamics of the robot actuator are described by a method based on the combined use of matrices (4 4) that have a wide application in robotics, and graph theory. Kinematics and dynamics of the tree-like robot actuator were investigated within MATLAB using a specially compiled simulation program. The proposed algorithm of tree-like kinematic structures choice of the robots actuators and dynamics study, as well as simulation program within MATLAB are the effective means to reduce the time of designing of robots advanced models.
Keywords: walking robot, tree-like actuator, robot dynamics equation.
I I ри создании роботов, выполняющих работы в экстремальных условиях, ученые и конструкторы уделяют большое внимание изучению их биологических прототипов, которым характерны перемещения без сплошной колеи и высокая проходимость в сложных дорожных условиях. Оригинальные кинематические схемы (КС) их скелетов, доведенные до совершенства в ходе биологической эволюции, являются образцом для подражания при создании робототехнических систем, перемещение которых основано на принципе шагания.
Огромное число двуногих шагающих роботов, роботизированных манекенов и экзоске-летонов, работающих как в автоматическом, так и в копирующем режимах, создано на основе биологического прототипа скелета человека [1-6].
Изучение кинематической структуры скелета человека и животных позволило фирме Boston Dynamics (США) при финансировании Агентства передовых исследовательских про-
ектов США (Defense Advanced Research Projests Agency-(DARPA) создать такие шагающие роботы, как Pet Man, Little Dog, Big Dog, Rise и др. Примером роботов нового класса, так называемых морфороботов, может служить робот Sguish Bot, который может изменять свою форму, а также жесткость и пластичность своего материала по программе, определяемой оператором или условиями перемещения [7].
При разработке исполнительного механизма (ИМ) восьминогого шагающего робота в качестве его биологического прототипа предлагается использовать КС скелета краба.
У краба восемь ног и две клешни, что позволяет ему устойчиво передвигаться, так как в любой момент времени возможна опора на четыре ноги. При этом, благодаря наличию двух клешней, он может эффективно взаимодействовать с окружающей средой.
Трехмерная модель робота-краба, КС которого соответствует скелету его биологического прототипа, представлена на рис. 1.
Кинематическая схема ИМ робота-краба, имеющая древовидную структуру, приведена на рис. 2. При выборе этой кинематической схемы ИМ робота-краба использовался предложенный в работе [8] алгоритм, позволяющий восстановить КС животного по изображениям его скелета.
В статье [9] описан эффективный метод построения уравнений кинематики и динамики
Рис. 1. Трехмерная модель робота-краба
МАШИНОСТРОЕНИ
ИМ шагающих роботов с древовидными КС, который основан на совместном использовании матриц (4x4), имеющих широкое применение в робототехнике и теории графов [10-12].
Исполнительный механизм робота представляется в виде древовидного направленного графа. Звенья ИМ являются вершинами графа, а соединяющие их сочленения — дугами.
За корень дерева (звено с номером 0) принимается окружающее пространство, в котором находится робот. Звенья ИМ робота нумеруют с 1-го и далее по возрастанию, от корня дерева
к его листьям, без пропусков. При этом должно выполняться условие, что собственный номер звена меньше номера любого звена-потомка. Номер обобщенной координаты ИМ, как и номер соответствующего сочленения, тот же, что и у звена, присоединяемого этим сочленением к предыдущему звену.
Поскольку корпус шагающего робота не закреплен к неподвижному основанию, то общее число степеней его свободы равно N +6, где N — число степеней подвижности его ИМ.
Для «привязки» ИМ робота к абсолютной системе координат и описания его движения
Рис. 2. Кинематическая схема ИМ робота-краба
в пространстве вводится фиктивная кинематическая цепь, соединяющая корпус робота с неподвижной в абсолютной системе фиктивной стойкой. Эта фиктивная цепь состоит из невесомых звеньев (0 — 5 — три поступательных и три вращательных неуправляемых кинематических пар 5-го класса) и характеризует положение и ориентацию корпуса робота в абсолютной системе координат.
Древовидную кинематическую структуру ИМ робота можно также представить с помощью матрицы достижимости Б — квадратной матрицы, каждый элемент которой = 1, если ¡-я вершина достижима из вершины у. Размерность матрицы Б равна числу звеньев ИМ робота.
Согласно определению достижимости диагональные элементы матрицы у = 1. При нумерации звеньев ИМ в соответствии с изложенными выше правилами, получаемая матрица достижимости Б имеет вид нижней треугольной матрицей.
Таким образом, как матрица достижимости Б, так и древовидный граф, представляющий кинематическую структуру робота-краба (рис. 3), отражают взаимное расположение и достижимость звеньев его ИМ.
Воспользуемся изложенной в работе [9] методикой и запишем уравнение динамики ИМ робота относительно обобщенных координат в следующем блочно-матричном виде:
Л(ч)ч + В(4,4)- СМ/в0 - Н(ч)пв0 = Т, (1)
где 4 — вектор обобщенных координат ИМ; т — вектор-столбец моментов, развиваемых приводами робота; /в0, п0— блочные матрицы внешних си л и моментов, приложенных к звеньям со стороны окружающей среды; Л(4) — матрица инерционных коэффициентов системы; В(4, 4) — матрица коэффициентов, зависящая от обобщенных координат и их производных; С(4) — матрица коэффициентов при внешних силах, действующих на ИМ; Н(4) — матрица коэффициентов при моментах, приложенных к звеньям механизма.
Уравнение (1) моделировалось с помощью специально разработанной программы в среде MATLAB, состоящей из набора процедур, за-
Рис. 3. Древовидный граф, представляющий кинематическую структуру ИМ робота-краба
писанных в виде ш-файлов [13]. Достоинством этой программы является то, что она применима для исследования ИМ роботов с произвольной древовидной КС. Особенность конкретной КС отражается в содержании пускового файла, в котором хранится информация о параметрах Денавита — Хартенберга, массах, моментах инерции, координатах центров масс ИМ, приложенных внешних силах и моментах.
Исходными данными для расчета компонентов уравнения (1) являются:
• й;^], ^Щ], а;[рад] — параметры Денавита — Хартенберга [11], получаемые при построении КС робота-краба, представленные в таблице;
• параметры звеньев ИМ робота: масса, моменты инерции, координаты центров масс звеньев, получаемые по результатам 3D-моде-лирования конструкции робота или его технической документации. При моделировании были приняты следующие допущения: масса каждого звена ИМ равна 1 кг, массы фиктивных звеньев равны нулю. Моменты инерции звеньев, принимаемых за однородные стержни, определяются относительно осей, которые проходят через центры масс этих звеньев и параллельны осям основных связанных систем
МАШИНО©ТРОЕНИ
координат. Значения этих моментов принимаются равными единице;
♦ матрица достижимости Б для КС робота-краба имеет вид (62x62). Процедура вычисления элементов этой матрицы в работе [13] автоматизирована.
Параметр Денавита — Хартенберга ©„ рад й„ м А,, м а,, рад
1 п+д1 0 0 п/2
2 -п/2+ д2 0 0 п/2
3 -п/2+ д3 0 0 п/2
4 -п/2+ д4 0 0 п/2
5 -п/2+ д5 0 0 п/2
6,1 0+ д6 0 0 п/2
6,2 0 0 0 п
6,3 -п/2 0 0,02 0
6,4 п/2 0 -0,02 п
6,5 -п/2 0 0,04 0
6,6 п/2 0 -0,04 п
6,7 -п/2 0 0,055 0
6,8 п/2 0 -0,055 п
6,9 -п/2 0 0,07 0
6,10 п/2 0 -0,07 п
6,11 -п/2 0 0,085 0
6,12 п/2 0 -0,085 п
7 п/2+ д7 0,015 0 п/2
8 п+д8 0 -0,01 п/2
9 -п/2+ д9 0 0 п/2
10 -п/2+ я10 0,015 0 п/2
11 п+я11 0 -0,01 п/2
12 -п/2+ я12 0 0 п/2
13 п+д13 0,02 0 п/2
14 п+д14 0 -0,015 п/2
15 п+д15 0 0,015 0
16 0+ я16 0 0,02 0
17 п/2+ я17 0 0 п/2
18 0+ я18 0,02 0 п/2
19 п+д19 0 -0,015 п/2
20 п+д20 0 0,015 0
21 0+ я21 0 0,02 0
22 п/2+ д22 0 0 п/2
23 0+ д23 0,015 0 п/2
Параметр Денавита — Хартенберга ©,, рад й,, м А, м а,, рад
24 п/2+ д24 0 0,06 0
25 0+ д25 0 0,04 0
26 0+ д26 0 0,04 0
27 0+ д27 0 0 -п/2
28 0+ д28 0,015 0 п/2
29 п/2+ д29 0 0,06 0
30 0+ д30 0 0,04 0
31 0+ я31 0 0,04 0
32 0+ д32 0 0 п/2
33 0+ д33 0,015 0 п/2
34 п/2+ д34 0 0,06 0
35 0+ д35 0 0,04 0
36 0+ д36 0 0,04 0
37 0+ д37 0 0 -п/2
38 0+ д38 0,015 0 п/2
39 п/2+ д39 0 0,06 0
40 0+ д40 0 0,04 0
41 0+ я41 0 0,04 0
42 0+ д42 0 0 п/2
43 0+ д43 0,015 0 п/2
44 п/2+ д44 0 0,06 0
45 0+ д45 0 0,04 0
46 0+ д46 0 0,04 0
47 0+ д47 0 0 -п/2
48 0+ д48 0,015 0 п/2
49 п/2+ д49 0 0,06 0
50 0+ д50 0 0,04 0
51 0+ я51 0 0,04 0
52 0+ д52 0 0 п/2
53 0+ д53 0,015 0 п/2
54 п/2+ 54 0 0,06 0
55 0+ д55 0 0,04 0
56 0+ д56 0 0,04 0
57 0+ д57 0 0 -п/2
58 0+ д58 0,015 0 п/2
59 п/2+ д59 0 0,06 0
60 0+ д60 0 0,04 0
61 0+ я61 0 0,04 0
62 0+ д62 0 0 п/2
В результате моделирования ИМ робота-краба с помощью программы [13] получены
значения элементов матриц Л(<) (62x62), В(<\,<4)
(62x1), С(ч) (62x62), Н(ч) (62x62), входящих в уравнение (1), а также значения вектора-столбца т (62x1) — моментов, развиваемых приводами робота, представлены ниже:
33 1,040507629
34 —1,27425Е—16
35 5,09702Е—17
36 5,09702Е—17
37 5,01721Е—33
38 -1,040507629
39 -7,19766Т—16
40 —6,18372Е-18
41 1,13954Е-16
42 1,20138Е-17
43 1,040507629
44 -1,27425Е-16
45 5,09702Е-17
46 5,09702Е-17
47 5,01721Е-33
48 -1,040507629
49 -7,19766Е-16
50 -6,18372Е-18
51 1,13954Е-16
52 1,20138Е-17
53 1,040507629
54 -1,27425Е-16
55 5,09702Е-17
56 5,09702Е-17
57 5,01721Е-33
58 -1,040507629
59 -7,19766Е-16
60 -6,18372Е-18
61 1,13954Е-16
62 1,20138Е-17
Выводы
Предложенный в работе алгоритм выбора древовидных кинематических структур ИМ роботов и исследования их динамики, а также программа моделирования в системе МА^АВ являются эффективным средством, позволяющим сократить сроки проектирования перспективных образцов шагающих роботов.
Элемент матрицы т, Нм
1 0
2 0
3 0
4 0
5 0
6 0
7 -0,171675
8 -4,20482Е-17
9 -0,024525
10 0,171675
11 4,20482Е-17
12 0,024525
13 -9,3195
14 -2,28262Е-15
15 -6,597225
16 -4,0221
17 -0,7848
18 9,3195
19 3,4239Е-15
20 6,597225
21 4,0221
22 0,7848
23 1,040507629
24 -1,27425Е-16
25 5,09702Е-17
26 5,09702Е-17
27 5,01721Е-33
28 -1,040507629
29 -7,19766Е-16
30 -6,18372Е-18
31 1,13954Е-16
32 1,20138Е-17
Литература
1. Вукобратович М. Шагающие роботы и антропоморфные механизмы: Пер. с англ. М.: Мир, 1976. 541 с.
2. Белецкий В.В. Двуногая ходьба. М.: Наука, 1984. 287 с.
3. Ковальчук А.К., Кулаков Д.Б., Семенов С.Е. Управление исполнительными системами двуногих шагающих роботов. Теория и алгоритмы / Под ред. А.К. Ковальчука. М.: Изд-во МГОУ, 2007. 160 с.
4. Ковальчук А.К., Ахметова Ф.Х., Водолажский В.В. Обзор моделей двуногих шагающих роботов / Под ред. А.К. Ковальчука. М.: Изд-во МГОУ, 2007. 92 с.
5. Ковальчук А.К., Ахметова Ф.Х., Водолажский В.В. Роботы-футболисты. Проблемы создания и управления / Под ред. А.К. Ковальчука. М.: Изд-во МГОУ, 2007. 108 с.
6. Лапшин В.В. Механика и управление движением шагающих машин. М.: Изд-во МГТУ им. Н.Э. Баумана, 2012. 200 с.
7. Военные роботы Boston Dynamics http://ru.wikipedia. org/wiki/BigDog. (Дата обращения 15.04.2013).
8. Pupkov K.A., Kovalchuk A.K., Kulakov D.B. Usage of Biological Prototypes for Kinematical Scheme Construction of Modern Robots // Preprints of the 13th IFAC Symposium on Information Control Problems in Manufacturing. 3—5 June 2009, Moscow P. 1829-1834.
9. Ковальчук А.К., Кулаков Д.Б., Семенов С.Е. Блоч-но-матричные уравнения движения исполнительных механизмов роботов с древовидной кинематической структурой // Известия высших учебных заведений. Машиностроение. 2008. № 12. С. 5—21.
10. Медведев В.С., Лесков А.Г., Ющенко А.С. Системы управления манипуляционных роботов. М.: Наука, 1978. 416 с.
11. Зенкевич С.Л., Ющенко А.С. Основы управления ма-нипуляционными роботами. М.: Изд-во МГТУ им. Н.Э. Баумана, 2004. 480 с.
12. Алексеева А.А., Таланов В.А. Графы и алгоритмы. Структуры данных. Модели вычислений. М.: Изд-во Бином, 2006. 319 с.
13. Программа моделирования древовидных исполнительных механизмов шагающих роботов / А.К. Ковальчук, Л.А. Каргинов, Д.Б. Кулаков и др. Свидетельство о регистрации программ для ЭВМ № 2012610398. 10.01.2012.
References
1. Vukobratovich M. Shagaiushchie roboty i antropomorfnye mekhanizmy [Walking robots and anthropomorphic mechanisms]. Moscow, Mirpubl., 1976. 541 p.
2. Beletskii V.V. Dvunogaia khod'ba [Biped walking]. Moscow, Nauka publ., 1984. 287 p.
3. Koval'chuk A.K., Kulakov D.B., Semenov S.E. Upravlenie ispolnitel'nymi sistemami dvunogikh shagaiushchikh robotov. Teoriia
i algoritmy [Management of executive systems of two-legged robots. Theory and Algorithms]. Moscow, MGOU publ., 2007. 160 p.
4. Koval'chuk A.K., Akhmetova F.Kh., Vodolazhskii V.V. Obzor modelei dvunogikh shagaiushchikh robotov [Overview of models of two-legged walking robots]. Moscow, MGOU publ., 2007. 92 p.
5. Koval'chuk A.K., Akhmetova F.Kh., Vodolazhskii V.V. Roboty-futbolisty. Problemy sozdaniia i upravleniia [Robot footballers. The problems of building and managing]. Moscow, MGOU publ., 2007. 108 p.
6. Lapshin V.V. Mekhanika i upravlenie dvizheniem shagaiushchikh mashin [Mechanics and Motion Control walking machines]. Moscow, MSTU named after N.E. Bauman, 2012. 200 p.
7. Voennye roboty Boston Dynamics [Military Robots Boston Dynamics]. Availabie at: http://ru.wikipedia.org/wiki/BigDog. (Accessed 15 April 2013).
8. Pupkov K.A., Kovalchuk A.K., Kulakov D.B. Usage of Biological Prototypes for Kinematical Scheme Construction of Modern Robots. Preprints of the 13th IFAC Symposium on Information Control Problems in Manufacturing. 3-5 June 2009, Moscow, pp. 1829—1834.
9. Koval'chuk A.K., Kulakov D.B., Semenov S.E. Blochno-matrichnye uravneniia dvizheniia ispolnitel'nykh mekhanizmov robotov s drevovidnoi kinematicheskoi strukturoi [Block-matrix equations of motion of the actuators of robots with kinematic tree structure]. Izvestiya Vysshikh Uchebnykh Zavedenii. Mashinostroenie [Proceedings of Higher Educational Institutions. Machine Building]. 2008, no. 12, pp. 5—21.
10. Medvedev V.S., LeskovA.G., Iushchenko A.S. Sistemy upravleniia manipuliatsionnykh robotov [Robotic manipulator control system]. Moscow, Nauka publ., 1978. 416 p.
11. Zenkevich S.L., Iushchenko A.S. Osnovy upravleniia manipuliatsionnymi robotami [Management Basics manipulative robots]. Moscow, MSTU named after N.E. Bauman publ., 2004. 480 p.
12. Alekseeva A.A., Talanov V.A. Grafy i algoritmy. Struktury dannykh. Modeli vychislenii [Graphs and algorithms. Data Structures. Computing model]. Moscow, Binompubl., 2006. 319 p.
13. Koval'chuk A.K., Karginov L.A., Kulakov D.B. Programma modelirovaniia drevovidnykh ispolnitel'nykh mekhanizmov shagaiushchikh robotov [The simulator tree actuators walking robots]. Svidetel'stvo o registratsiiprogramm dlia EVM № 2012610398 [The certificate of registration of computer programs no. 2012610398]. 10.01.2012.
Статья поступила в редакцию 20.04.2013
Информация об авторе
КОВАЛЬЧУК Александр Кондратьевич (Москва) — кандидат технических наук, доцент кафедры «Гидромеханика, гидромашины и гидропневмоавтоматика». МГТУ им. Н.Э. Баумана (105005, Москва, Россия, 2-я Бауманская ул., д. 5, стр. 1, e-mail: alexkov2012@rambler.ru).
Information about the author
KOVALCHUK Alexander Kondratyevich (Moscow) — Cand. Sc. (Eng.), Associate Professor of «Hydromechanics, Hydraulic Machines and Hydropneumoautomation» Department. Bauman Moscow State Technical University (BMSTU, building 1, 2-nd Baumanskaya str., 5, 105005, Moscow, Russian Federation, e-mail: alexkov2012@rambler.ru).