Научная статья на тему 'Моделирование кинематики шагающего робота'

Моделирование кинематики шагающего робота Текст научной статьи по специальности «Механика и машиностроение»

CC BY
1929
340
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
ШЕСТИНОГИЙ РОБОТ / ШАГАЮЩАЯ МАШИНА / КИНЕМАТИЧЕСКАЯ МОДЕЛЬ / ОБЛАСТЬ ДОСТИЖИМОСТИ / УПРАВЛЕНИЕ ПО ВЕКТОРУ СКОРОСТИ / HEXAPOD ROBOT / WALKING MACHINE / KINEMATIC MODEL / REACHABILITY AREA / CONTROL BY VELOCITY VECTOR

Аннотация научной статьи по механике и машиностроению, автор научной работы — Михайлов Владимир Валентинович, Соловьева Татьяна Николаевна, Попов Валерий Павлович

Цель: для конструирования системы управления шагающей машиной необходимо наличие кинематической и динамической моделей этой машины. Целью исследования является разработка кинематической модели для действующего макета шестиногого шагающего робота, позволяющей получить визуальное представление о его перемещении в пространстве при создании алгоритмов управления. Результаты: найдено математическое описание кинематической модели шестиногого шагающего робота в виде систем уравнений для определения положения узлов робота при заданных углах разворота звеньев конечностей. Получена система разностных уравнений, позволяющая провести моделирование движений робота при управлении по вектору скорости. На основании разработанной модели выполнена визуализация различных типов перемещения робота в пакете MatLab. Изменение углов расположения конечностей робота осуществляется с помощью гидроприводов, в связи с этим получены уравнения, определяющие связь величины выдвижения штоков гидроприводов и углов расположения конечностей. Для оценки возможностей перемещения робота построена область достижимости ступни и найдены аналитические границы этой области. Практическая значимость: разработанная модель может быть использована как основа построения динамической модели при разработке и апробации алгоритмов управления движением машины, а также для управления макетом машины в режиме следящего привода.

i Надоели баннеры? Вы всегда можете отключить рекламу.

Похожие темы научных работ по механике и машиностроению , автор научной работы — Михайлов Владимир Валентинович, Соловьева Татьяна Николаевна, Попов Валерий Павлович

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.
i Надоели баннеры? Вы всегда можете отключить рекламу.

Kinematic Modeling of a Walking Machine

Purpose: Developing control systems for walking machines requires their kinematic and dynamic models. The goal of this research is the development of a kinematic model for an active dummy of a hexapod walking machine, getting a visual representation of its movement in space. Results: A mathematical description is suggested for a kinematic model of a hexapod as systems of equations to determine the coordinates of the machine units with preset angles between the limb links. A system of difference equations has been obtained which allows you to model the robot motion, controlled by velocity vector. On the base of the model, various types of robot motion were simulated in MATLAB software package. Angles of the robot's limbs are operated via hydraulic drives, and special equations were obtained which determine the relation between the drive rod positions and the angles. To evaluate the robot locomotion ability, the area of its foot reachability was built, and the analytical bounds of that area were specified. Practical relevance: The developed model can be used as a basis for a dynamical model when designing and approbating the robot motion control algorithms, and for robot dummy control in the follow-up drive mode.

Текст научной работы на тему «Моделирование кинематики шагающего робота»

УДК 621.865.8

doi:10.15217/issn1684-8853.2015.6.50

МОДЕЛИРОВАНИЕ КИНЕМАТИКИ ШАГАЮЩЕГО РОБОТА

В. В. Михайлова, доктор техн. наук, профессор Т. Н. Соловьева6, канд. техн. наук, доцент В. П. Попов6, канд. техн. наук, доцент

аСанкт-Петербургский институт информатики и автоматизации РАН, Санкт-Петербург, РФ бСанкт-Петербургский государственный университет аэрокосмического приборостроения, Санкт-Петербург, РФ

Цель: для конструирования системы управления шагающей машиной необходимо наличие кинематической и динамической моделей этой машины. Целью исследования является разработка кинематической модели для действующего макета шестиногого шагающего робота, позволяющей получить визуальное представление о его перемещении в пространстве при создании алгоритмов управления. Результаты: найдено математическое описание кинематической модели шестиногого шагающего робота в виде систем уравнений для определения положения узлов робота при заданных углах разворота звеньев конечностей. Получена система разностных уравнений, позволяющая провести моделирование движений робота при управлении по вектору скорости. На основании разработанной модели выполнена визуализация различных типов перемещения робота в пакете Ма^аЬ. Изменение углов расположения конечностей робота осуществляется с помощью гидроприводов, в связи с этим получены уравнения, определяющие связь величины выдвижения штоков гидроприводов и углов расположения конечностей. Для оценки возможностей перемещения робота построена область достижимости ступни и найдены аналитические границы этой области. Практическая значимость: разработанная модель может быть использована как основа построения динамической модели при разработке и апробации алгоритмов управления движением машины, а также для управления макетом машины в режиме следящего привода.

Ключевые слова — шестиногий робот, шагающая машина, кинематическая модель, область достижимости, управление по вектору скорости.

Введение

Шагающие устройства обладают преимуществами перед любыми типами движителей при перемещении в условиях бездорожья, сложного рельефа и при преодолении препятствий. Конструктивные особенности таких устройств обеспечивают более простое (по сравнению с колесными или гусеничными машинами) решение задач герметизации и термостатирования в условиях глубокого вакуума, высоких давлений и больших градиентов температуры. Анализ характеристик шагающих движителей в сравнении с колесными и гусеничными приведен в работе [1].

Разработка математических моделей и действующих макетов шагающих роботов началась более 50 лет назад. В этих исследованиях принимали активное участие Д. Е. Охоцимский, А. К. Платонов, В. Б. Ларин и другие советские и российские ученые. Их работы посвящены задачам управления шагающим аппаратом, вопросам статической и динамической устойчивости и классификации различных походок [2-4]. За рубежом одна из первых работ в области шагающих роботов принадлежит сербскому академику Миомиру Вукобратовичу [5]. Весомый вклад в развитие шагающих машин внесли и сотрудники ГУАП [1, 6, 7]. Однако условия для создания реальных конкурентоспособных машин такого рода сложились лишь сейчас в связи с потребностями космической отрасли, необходимостью

проведения работ на морском дне, мониторинга энергосетей и нефтегазовых трубопроводов, а также в результате развития информационных и машиностроительных технологий [8, 9].

Традиционно задачи водителей колесного или гусеничного транспорта состояли в выборе и задании направления и скорости движения в соответствии с целями движения и дорожной обстановкой. Предполагается, что оператор шагающего робота должен выполнять аналогичные функции. Управлять движением звеньев конечностей для перемещения машины в заданном направлении, координировать движение ног во время рабочего перемещения и свободного переноса, выбирать тип походки и величину клиренса с учетом устойчивости машины должна бортовая компьютерная система. На ручное управление оператор может переходить в сложных условиях при преодолении препятствий, но и в этом случае его роль должна ограничиваться выбором мест постановки ноги и ее переносом, а также заданием локального направления перемещения машины на очередном шаге с учетом устойчивости. Для инструментальной поддержки действий оператора при этом может использоваться микроманипулятор — имитатор конечности, а для контроля устойчивости — представленное на дисплее расположение центра тяжести машины относительно зоны устойчивости.

Таким образом, одной из основных задач проектирования шагающего робота является раз-

работка системы управления. Для построения и отладки алгоритмов управления необходимо создать адекватную модель робота. На первом этапе строится кинематическая модель, в которой не учитываются вес звеньев робота и динамические связи между ними. Здесь робот рассматривается как совокупность материальных точек (узлов), характеризующихся некоторыми координатами и скоростями. Такая модель удобна для разработки различных вариантов перемещения конечностей робота и его платформы. Кинематическая модель позволяет получить уравнения движения отдельных узлов робота в каждом из вариантов перемещения и оценить его статическую устойчивость. На втором этапе разработки системы управления необходимо построить динамическую модель, учитывающую массу отдельных звеньев робота и динамические связи между звеньями. Основная задача системы управления — обеспечить движение звеньев по полученным на первом этапе уравнениям движения за счет подачи соответствующих управляющих сигналов с учетом динамической устойчивости робота.

Данная статья посвящена разработке кинематической модели шестиногого робота. В частности, для достижения этой цели решаются задачи:

— выбора совокупности систем координат, связанных с узлами машины;

— разработки кинематической модели конечности робота;

— разработки кинематической модели гидропривода;

— построения области достижимости для отдельной конечности робота;

— построения векторов скоростей стоп ног при прямолинейном движении машины и ее вращении вокруг осей координат;

— моделирования и визуализации различных вариантов движения машины.

Разработка

кинематической модели робота

Конкретным объектом моделирования является действующий макет шагающей машины (рис. 1), разработанный сотрудниками ГУАП и ЗАО «Арсенал-7» [1].

Платформа (корпус машины) представляет собой правильный шестиугольник, в вершинах которого расположены трехзвенные конечности (ноги машины). В отличие от живых организмов с шаровым бедренным суставом, шарниры бедренного сустава машины имеют одну степень свободы. Шарниры разнесены в пространстве, и между ними добавлено промежуточное звено. В точке крепления ноги к платформе происходит вращение вокруг вертикальной оси, а в точке крепления бедра к промежуточному звену — вра-

■ Рис. 1. Макет шагающей машины

щение вокруг горизонтальной оси. Коленный сустав имеет одну степень свободы — вращение вокруг горизонтальной оси. Для перемещения звеньев используются гидроприводы.

Возможны различные подходы к построению кинематической модели шагающей машины.

Например, в работе [1] представлено описание геометрической конструкции платформы шести-ногого робота и кинематической структуры конечностей. Положение платформы робота в пространстве задается следующими уравнениями [1]:

(xai - xaj ) + (Vai - yaj ) + (zai - zaj ) = R;

(xai - xa0 ) + (Vai - Va0 ) + (ai - za0 ) = r2 ;

Axai + BVai + Czai = 0

где i = 1,6, j = (i + 1) mod 6; xai, yai, zai — координаты точек закрепления ног; xa0, ya0, za0 — координаты центра платформы; A, B, C — параметры плоскости платформы; R — расстояние между точками крепления ног.

Переменными здесь являются координаты семи точек (центра платформы и точек закрепления ног) и три параметра плоскости платформы. Таким образом, общее количество переменных равно 24, а количество уравнений — 18. Наличие шести свободных переменных позволяет задать угловое положение плоскости платформы и положение ее центра (или любой другой точки).

Положение стоп ног машины определяется уравнениями

(i" 1)71!

xni +

(( sinpi + L2 sin(2 - pi ))cos

Рз +

Vci = yai +(L1 sin pi + L2 sin (p2 -pi ))

Рз +

3

(i - 1)л"

sci = L1 cos pi - L2 sin (p2 -pi ),

где I = 1,6; хс1, усР гс1 — координаты стоп ног; Ь2 — длины бедра и голени; Р1 — угол отклонения бедра от вертикальной оси; Р2 — угол поворота голени относительно бедра; Р3 — угол разворота бедра вокруг вертикальной оси.

В уравнениях ног дополнительными переменными являются углы разворота звеньев и координаты стоп. Общее количество дополнительных переменных равно 36. Таким образом, в целом модель машины описывается системой из 36 уравнений с 60 переменными. Количество свободных переменных равно 24, из них 6 переменных необходимы для задания положения платформы. Оставшиеся 18 переменных позволяют задать расположение стоп ног в произвольных точках области, границы которой определяются конструктивными особенностями звеньев и шарниров конечностей. Если положения стоп всех шести ног и корпуса зафиксированы, то система становится жесткой, свободные переменные в ней отсутствуют. При известном законе перемещения платформы машины траектории движения вершин всех опорных ног относительно платформы будут однозначно определены. Если количество опорных ног меньше шести, то условие «жесткости» сохраняется, поскольку положение или траектория переноса каждой из «свободных» ног также должны быть заданы.

Полученная система алгебраических уравнений является весьма громоздкой. Перейдем к более простому описанию, исключив уравнения платформы машины. При построении модели будем использовать три координатные системы: систему координат конечностей, систему координат машины и неподвижную систему для отображения движения машины в пространстве.

Центр системы координат конечности ХпУпЕп расположен в точке прикрепления ноги к платформе, плоскость ХпУп совпадает с плоскостью платформы, ось Уп направлена от центра платформы к точке крепления промежуточного звена к платформе, ось Еп — вертикально вверх (рис. 2).

Центр координатной системы корпуса ХтУтЕт расположен в центре шестиугольной платформы. Плоскость ХтУт совпадает с плоскостью платформы, ось Ут направлена в точку крепления первой ноги, ось Ет направлена вертикально вверх (рис. 3).

Неподвижная система координат ХУЕ служит для моделирования перемещения машины в пространстве. Все координатные системы — правые.

сп3

X,

ьп3

Zn

/ 1 \ «2

L1 „ L2 К4 Уп3

i^yХ3 \ ^ Y n

■ Рис. 2. Геометрическая модель конечности робота

■ Рис. 3. Система координат машины и нумерация ног

Общие геометрические характеристики машины следующие:

— расстояние между точками крепления ног — 25 см;

— длина бедра L1 — 48 см;

— длина голени L2 — 60 см;

— длина промежуточного звена L3 — 14,7 см;

— допустимые значения угла подъема бедра — -20о < а1 < 70о;

— допустимые значения угла поворота голени относительно бедра — 50о < а4 < 170о;

— допустимые значения угла разворота ноги -55о < а3 < 55о.

Кинематическая (геометрическая) модель ноги машины (см. рис. 2) в проекциях на собственную систему координат имеет вид

хпз = (( cosа-L + L sinа2 )cosаз; yn3 = (( cos а! + L2 sin а2 + L3 )sin аз;

zn3 = Li sin а! - L2 cos а2, (1)

где xn3, yn3, zn3 — координаты стопы; L1, L2, L3 — длины бедра, голени и промежуточного звена соответственно; а1, а2, а3 — углы подъема бедра, подъема голени (относительно вертикальной оси) и разворота бедра соответственно.

Угол а4 поворота голени относительно бедра связан с углами а1 и а2 соотношением а4 = а2 - а1 + + 90°. Переход к углу а2 связан исключительно с компактностью записи уравнений конечности.

Моделирование движения машины

Моделирование машины производится в пакете MatLab.

Для удобства проведения моделирования на основании (1) выполним дифференцирование этой системы уравнений. Результат в матричной форме имеет вид

d xn3 d а!

d t d t

d Уп3 = A d а2

d t d t

d zn3 d а3

d t d t .

0

где vx, vy, v2

жения стопы; A =

составляющие вектора скорости дви-

—L sin а^ cos аз Zq cos а2 cos аз —Z sin sin аз L2 cos а2 sin аз Z cosL2 sinа2

—sin аз (( cos + Lq sin а2 cos аз (( cos + Lq sin а2) 0

Разрешив систему уравнений относительно производных по углам разворота звеньев, получим

d ап

d t

d а2

dt

d аз

= A-

а г

После интегрирования системы и перехода к конечным разностям по формуле Эйлера найдем уравнения для определения углов разворота звеньев при заданном векторе скорости стопы ноги в системе координат конечности:

а1 (k +1) а1 (k) vx

а2 (k +1) = а2 (k) + A(k)"1 vy

аз (k +1)_ аз (k)_ _ vz _

S,

(2)

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

где 5 — шаг по времени.

Коэффициенты матрицы А пересчитываются на каждом шаге в соответствии с новыми значениями углов разворота звеньев ноги.

Модель машины в целом включает уравнения движения всех шести ног в их собственной системе координат. Координация движения ног обеспечивается общим шагом счета и движением стоп опорных конечностей по согласованным векторам скорости.

Первоначально в системе координат машины определяются векторы скорости стоп конечностей, обеспечивающие тот или иной закон движения платформы. Затем рассчитываются значения этих величин в системах координат конечностей и по уравнениям (2) определяются углы разворота звеньев конечностей на очередном шаге счета. После этого по уравнениям (1) находятся координаты узлов звеньев конечностей для анимации модели.

Последовательность вычислений в компьютерной модели машины, реализованной в пакете Ма^аЬ, показана на рис. 4.

Движение машины будет складываться из поступательного перемещения платформы и вращений платформы вокруг своих координатных осей. Поступательное перемещение платформы в пространстве может быть задано вектором ско-

рости центра масс (или любой другой точки платформы).

Для вращения платформы вокруг координатных осей вектор скорости стоп должен пересчи-тываться на каждом шаге в соответствии с положением стоп относительно оси вращения машины и угловой скорости ее вращения. Во всех случаях стопы опорных конечностей в системе координат машины должны двигаться по вектору, противоположному вектору скорости машины.

Для простоты восприятия анимированных изображений при визуализации использовалась модель машины с совмещенными шарнирами верхних частей ног, т. е. принято Ь3 = 0 (рис. 5).

Компьютерная модель позволяет имитировать и наблюдать различные сценарии движения: перемещение отдельной конечности при закреплении стопы или точки прикрепления бедра, движение корпуса машины при закрепленных стопах ног — покачивание, движение вверх-вниз, хула-хуп, вращение корпуса и др. Проблема реализации походок машины и формирования

■ Рис. 4. Последовательность вычислений при моделировании движения машины

Z, см

100 80 60 40 20 0 100

50 , 0 , ^ -50 ' % -100

100

50

-100

■ Рис. 5. Трехмерная модель робота

1

стереотипов движения является самостоятельной задачей и в данной работе не рассматривается.

Кинематическая модель гидроприводов

Изменение положения конечностей робота в пространстве происходит за счет изменения углов между звеньями конечностей. В свою очередь величины углов зависят от величин выдвижения штоков гидроприводов. Кинематика работы гидроприводов звеньев ног также может быть представлена в форме геометрической модели. Такая модель для гидропривода голени показана на рис. 6, где Ь4 = 30 см, Ь5 = 3 см, а5 = 10° — конструкционные параметры; в3 — величина выдвижения штока привода голени. Звенья Ь2 и Ь5 жестко связаны (звено Ь2 является продолжением звена Ь5).

По геометрическим моделям могут быть найдены зависимости величин выдвижения штоков

п

■ Рис. 6. Геометрическая модель гидропривода поворота голени

а) В3, см 0,28

J_I_I_I_1_

0 400 800 1200 1600 0 400 800 12001600

с с

б) в3, см в3, см

0,4

0,2 0

"0 400 800 1200 1600 0 400 800 12001600

с с

■ Рис. 7. Графики выдвижения штоков гидроприводов бедра (а) и голени (б) при покачивании корпуса машины (слева) и движениях вверх-вниз (справа)

от углов разворота звеньев ноги. Так, для гидропривода голени получим

=

I 2 2

•^¿4 + - 21*4 ¿5 СОВ С

где а6 = 180° - а4 - а5; ЬА, Ь5, а5 — конструкционные параметры; а4 — угол подъема голени.

Уравнение для величины выдвижения штока гидропривода бедра выглядит аналогично.

В качестве примера на рис. 7 показаны графики выдвижения штоков гидроприводов бедра и голени для конечности, ориентированной в направлении вектора скорости платформы. Графики слева соответствуют поступательному перемещению платформы машины из исходного положения влево, затем вправо и снова влево, в исходное положение. Графики справа соответствуют движению платформы из исходного положения вверх, затем вниз и снова вверх, в исходное положение.

Отметим, что данные о динамике выдвижения штоков гидроприводов, рассчитанные на компьютерной модели, могут быть непосредственно использованы для управления движением механического макета машины в режиме следящего привода.

Область достижимости ступни робота

Одной из задач, возникающих на кинематическом уровне, является задача построения области достижимости для ступни ноги робота. Область достижимости ступни определяется длинами звеньев ноги (длиной бедра и голени), а также допустимыми углами отклонения, указанными выше.

Углы а1 и а4 (см. рис. 2) задают возможные движения ступни в плоскости ноги. Границы допустимой области в этой плоскости могут быть получены путем поочередного закрепления одного из углов в предельном положении и варьирования второго угла в рамках допустимых значений (рис. 8).

Область достижимости ступни в плоскости ноги представляет собой криволинейный четырехугольник, стороны которого — дуги окружностей. Рассмотрим эти окружности.

Дуга 1 представляет собой траекторию ступни при повороте максимально выпрямленной ноги (угол между бедром и голенью а4 = 170°) вокруг оси Хп в пределах допустимых значений а1. Центр соответствующей окружности У2 + = #2 будет лежать в начале координат, а ее радиус

Я =^¿1 + ¿2 - 21^ ¿2 сов а4 = = >/482 + 602 - 2 • 48 • 60 • сов 170° «1 07,6 см.

Zn, см 100 80 60 40 20 0 -20 -40 -60 -80

— ----- 3 ?°o о о

1 0 0 о о- -о о о

Jr M \ о о о -Q___ о О

2 \

\ -- 'c

4

-20 0 20 40 60 80 100 120

Yn, см

■ Рис. 8. Разрез области достижимости ступни

Дуга 2 представляет собой траекторию ступни при повороте максимально согнутой ноги (угол между бедром и голенью а4 = 50°) вокруг оси Хп в пределах допустимых значений а1. Центр соответствующей окружности У + = также будет лежать в начале координат, а ее радиус

= у1482 + 602 - 2 • 48 • 60 • cos50° ;

46,92 см.

Дуга 3 представляет собой траекторию ступни при сгибании максимально поднятой ноги (угол подъема бедра а1 = 70°) в пределах допустимых значений а4. Центр соответствующей окружности (Уп - Уп3)2 + (%п - = £§ является точкой расположения колена при максимально поднятом бедре Уп3 = Х1сов70° и 16,42 см, 2п3> = 1,^^70° и и 45,11 см, а ее радиус будет равен ¿2.

Дуга 4 представляет собой траекторию ступни при сгибании максимально опущенной ноги (угол подъема бедра а1 = -20°) в пределах допустимых значений а4. Центр соответствующей окружности (Уп - Уп4)2 + (%п - %п4)2 = 1*2 является точкой расположения колена при максималь-

Литература

1. Игнатьев М. Б. Кибернетическая картина мира. Теория сложных систем. — СПб.: ГУАП, 2011. — 448 с.

2. Охоцимский Д. Е., Голубев Ю. Ф. Механика и управление движением автоматического шагающего аппарата. — М.: Наука, 1984. — 310 с.

3. Охоцимский Д. Е., Платонов А. К., Кирильчен-ко А. А., Лапшин В. В. Шагающие машины: пре-

но опущенном бедре Уп4 = Х1сов(-20°) и 45,11 см, Zn4 = Х1в1п(-20°) и -16,42 см, а ее радиус будет равен Ь2.

Полная область достижимости ступни в трехмерном пространстве образуется поворотом полученного криволинейного четырехугольника вокруг вертикальной оси в пределах допустимых значений а3.

Живые организмы при перемещении почти никогда не используют всю область достижимости конечностей. Движение происходит в зоне, наиболее удобной для согласования рабочих и холостых перемещений конечностей и оптимальной с энергетических позиций. В качестве такой зоны в модели машины могут быть приняты сфера или эллипсоид максимального радиуса, вписанные в трехмерную область достижимости (вертикальный разрез такой сферы показан пунктиром на рис. 8). Перемещение стопы прекращается при достижении поверхности сферы. Центр сферы является точкой, в которой находятся стопы робота перед началом перемещения, и конечной точкой положения стоп при завершении движения в заданном направлении. Холостой перенос ног может выполняться по поверхности сферы.

Заключение

Получена кинематическая модель шестиного-го шагающего робота в виде системы уравнений. Для организации моделирования различных движений робота построена система разностных уравнений. Найдены уравнения, связывающие величины выдвижения штоков гидроприводов и углы расположения конечности. Построена область достижимости ступни робота и найдены ее аналитические границы. Выполнена реализация полученной кинематической модели в пакете Ма^аЬ.

На следующем этапе работы предполагается рассмотреть динамические задачи управления движением шестиногого шагающего робота, а также задачи формирования походок и интеллектуализации управления при движении по сложному рельефу.

принт. — М.: ИПМ АН СССР, 1989. № 87. — 36 с.

4. Ларин В. Б. Управление шагающим аппаратом. — Киев: Наукова думка, 1980. — 168 с.

5. Vukobratovic M. Legged Locomotion Robots and Anthropomorphic Mechanisms. — Mihailo Pupin Institute, 1975. — 541 p.

6. Ignatev M. B., Kulakov F. M., Mikhailov V. V., Jure-vitch E. I. Control Algorithms of Adaptive Walking Machine //Proc. of the 4th Symp. on Autom. Contr.

in Space, Dubrovnik, 6-10 September 1971. Beograd, 1971. P. 175-184.

7. Ястребов В. С., Игнатьев М. Б., Кулаков Ф. М., Михайлов В. В. Подводные роботы. — Л.: Судостроение, 1977. — 368 с.

8. Лапшин В. В. Механика и управление движением шагающих машин. — М.: Изд-во МГТУ им. Н. Э. Баумана, 2012. — 199 с.

9. Павловский В. Е. О разработках шагающих машин: препринт. — М.: ИПМ РАН, 2013. № 101. — 32 с.

UDC 621.865.8

doi:10.15217/issn1684-8853.2015.6.50 Kinematic Modeling of a Walking Machine

Mikhailov V. V.a, Dr. Sc., Tech., Professor, mwwcari@gmail.com Solov'eva T. N.b, PhD, Tech., Associate Professor, al2tn@yandex.ru Popov V. P.b, PhD, Tech., Associate Professor, valery-popov2009@yandex.ru

aSaint-Petersburg Institute for Informatics and Automation of RAS, 39, 14 Line, V. O., 199178, Saint-Petersburg, Russian Federation

bSaint-Petersburg State University of Aerospace Instrumentation, 67, B. Morskaia St., 190000, Saint-Petersburg, Russian Federation

Purpose: Developing control systems for walking machines requires their kinematic and dynamic models. The goal of this research is the development of a kinematic model for an active dummy of a hexapod walking machine, getting a visual representation of its movement in space. Results: A mathematical description is suggested for a kinematic model of a hexapod as systems of equations to determine the coordinates of the machine units with preset angles between the limb links. A system of difference equations has been obtained which allows you to model the robot motion, controlled by velocity vector. On the base of the model, various types of robot motion were simulated in MATLAB software package. Angles of the robot's limbs are operated via hydraulic drives, and special equations were obtained which determine the relation between the drive rod positions and the angles. To evaluate the robot locomotion ability, the area of its foot reachability was built, and the analytical bounds of that area were specified. Practical relevance: The developed model can be used as a basis for a dynamical model when designing and approbating the robot motion control algorithms, and for robot dummy control in the follow-up drive mode.

Keywords — Hexapod Robot, Walking Machine, Kinematic Model, Reachability Area, Control by Velocity Vector.

References

1. Ignatev M. B. Kiberneticheskaia kartina mira. Teoria slozh-nykh system [Cybernetic Picture of the World. Complicated Systems' Theory]. Saint-Petersburg, GUAP Publ., 2011. 448 p. (In Russian).

2. Okhotsimsky D. E., Golubev Iu. F. Mekhanika i upravlenie dvizheniem automaticheskogo shagaiushchego apparata [Mechanics and Motion Control of an Automatic Walking System]. Moscow, Nauka Publ., 1984. 310 p. (In Russian).

3. Okhotsimsky D. E., Platonov A. K., Cirilchenko A. A., Lapshin V. V. Shagaiushchie mashiny [Walking Machines]. Moscow, IPM AN SSSR Publ., 1989, no. 87. 36 p. Preprint (In Russian).

4. Larin V. B. Upravlenie shagaiushchim apparatom [Control of Walking Machine]. Kiev, Naukova dumka Publ., 1980. 168 p. (In Russian).

5.

6.

Vukobratovic M. Legged Locomotion Robots and Anthropomorphic Mechanisms. Mihailo Pupin Institute, 1974 . 541 p. Ignatev M. B., Kulakov F. M., Mikhailov V. V., Jurevitch E. I. Control Algorithms of Adaptive Walking Machine. Proc. 4th Symp. on Autom. Contr. in Space. Dubrovnik, 1971. P. 175-184.

Yastrebov V. S., Ignatev M. B., KulakovF. M., Mikhailov V. V. Podvodnye roboty [Underwater Robots]. Leningrad, Su-dostroenie Publ., 1977. 368 p. (In Russian). Lapshin V. V. Mehanika i upravlenie dvizheniem shagajushhih mashin [Mechanics and Motion Control of Walking Machines]. Moscow, Moskovskii gosudarstvennyi tekhnicheskii univer-sitet imeni N. E. Baumana Publ., 2012. 199 p. (In Russian). Pavlovskij V. E. O razrabotkah shagajushih mashin [About Walking Machines' Developement]. Moscow, IPM RAN Publ., 2013, no. 101. 32 p. Preprint (In Russian).

7

i Надоели баннеры? Вы всегда можете отключить рекламу.