Научная статья на тему 'МОДЕЛИРОВАНИЕ ПОЛУАВТОМАТИЧЕСКОГО РЕЖИМА УПРАВЛЕНИЯ ДВИЖЕНИЕМ ДВУНОГИХ ШАГАЮЩИХ РОБОТОВ В СИСТЕМАХ ВИРТУАЛЬНОГО ОКРУЖЕНИЯ'

МОДЕЛИРОВАНИЕ ПОЛУАВТОМАТИЧЕСКОГО РЕЖИМА УПРАВЛЕНИЯ ДВИЖЕНИЕМ ДВУНОГИХ ШАГАЮЩИХ РОБОТОВ В СИСТЕМАХ ВИРТУАЛЬНОГО ОКРУЖЕНИЯ Текст научной статьи по специальности «Механика и машиностроение»

CC BY
17
3
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
ДВУНОГИЙ ШАГАЮЩИЙ РОБОТ / МОДЕЛИРОВАНИЕ / ШАБЛОН ХОДЬБЫ / УСТОЙЧИВОСТЬ / ТОЧКА НУЛЕВОГО МОМЕНТА / ИНВЕРСНАЯ КИНЕМАТИКА / ВИРТУАЛЬНЫЙ ПУЛЬТ / ПД-РЕГУЛЯТОР / СИСТЕМА ВИРТУАЛЬНОГО ОКРУЖЕНИЯ

Аннотация научной статьи по механике и машиностроению, автор научной работы — Страшнов Евгений Владимирович, Финагин Леонид Алексеевич

Рассматриваются методы и подходы для полуавтоматического управления движением двуногих шагающих роботов в системах виртуального окружения. Предлагаемые решения включают генерацию шаблона ходьбы, расчет инверсной кинематики и синтез ПД-регуляторов с обратной связью по показаниям датчиков углов. Для того чтобы обеспечить статическую и динамическую устойчивость шагающего робота, генерация траекторий его движения реализуется с применением критерия точки нулевого момента (ТНМ) и модели обратного маятника с виртуальной высотой. При этом генерация шаблона ходьбы осуществляется путем решения задачи инверсной кинематики методом Левенберга-Марквардта для вычисления углов поворота в сочленениях робота. Для реализации полуавтоматического управления движением шагающего робота в виртуальном окружении задействован подход, основанный на технологии функциональных схем и виртуальных пультов управления. Апробация предложенных методов и подходов проводилась в программном комплексе виртуального окружения VirSim и показала их адекватность и эффективность для моделирования движения шагающего робота с сохранением его равновесия

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

SIMULATING A SEMI-AUTOMATIC MOTION CONTROL MODE OF BIPEDAL WALKING ROBOTS IN VIRTUAL ENVIRONMENT SYSTEMS

The paper considers methods and approaches for semi-automatic motion control of bipedal walking robots in virtual environment systems. The proposed solutions include generating a walking pattern, calculating inverse kinematics, and synthesis of PD-controllers with feedback based on the angle sensor readings. To ensure the static and dynamic stability of the walking robot, generating its movement trajectories is implemented using the criterion of zero moment point (ZMP) and the inverse pendulum model with virtual height. In this case, the walking pattern is generated by solving the problem of inverse kinematics using the Levenberg-Marquardt method to calculate the rotation angles in the robot joints. To implement semi-automatic motion control of a walking robot in a virtual environment, an approach based on the technology of functional diagrams and virtual control panels is used. Testing the proposed methods and approaches is carried out in the VirSim virtual environment software package and shows their adequacy and efficiency for modelling a walking robot movement while maintaining its balance.

Текст научной работы на тему «МОДЕЛИРОВАНИЕ ПОЛУАВТОМАТИЧЕСКОГО РЕЖИМА УПРАВЛЕНИЯ ДВИЖЕНИЕМ ДВУНОГИХ ШАГАЮЩИХ РОБОТОВ В СИСТЕМАХ ВИРТУАЛЬНОГО ОКРУЖЕНИЯ»

Автоматизация и моделирование в проектировании и управлении. 2022. № 3 (17). С. 57-67.

ISSN 2658-3488 print, ISSN 2658-6436 online Automation and modeling in design and management. 2022. № 3 (17). P. 57-67.

Научная статья

Статья в открытом доступе

УДК 004.942

doi: 10.30987/2658-6436-2022-3-57-67

МОДЕЛИРОВАНИЕ ПОЛУАВТОМАТИЧЕСКОГО РЕЖИМА УПРАВЛЕНИЯ ДВИЖЕНИЕМ ДВУНОГИХ ШАГАЮЩИХ РОБОТОВ В СИСТЕМАХ ВИРТУАЛЬНОГО ОКРУЖЕНИЯ

Евгений Владимирович Страшнов 1, Леонид Алексеевич Финагин 2

2 Федеральный научный центр Научно-исследовательский институт системных исследований Российской академии наук, г. Москва, Россия

1 strashnov_evg@mail.ru, http://orcid.org/0000-0003-0937-4052

2 antifin@mail.ru, http://orcid.org/0000-0003-0420-2323

Аннотация. Рассматриваются методы и подходы для полуавтоматического управления движением двуногих шагающих роботов в системах виртуального окружения. Предлагаемые решения включают генерацию шаблона ходьбы, расчет инверсной кинематики и синтез ПД-регуляторов с обратной связью по показаниям датчиков углов. Для того чтобы обеспечить статическую и динамическую устойчивость шагающего робота, генерация траекторий его движения реализуется с применением критерия точки нулевого момента (ТНМ) и модели обратного маятника с виртуальной высотой. При этом генерация шаблона ходьбы осуществляется путем решения задачи инверсной кинематики методом Левенберга-Марквардта для вычисления углов поворота в сочленениях робота. Для реализации полуавтоматического управления движением шагающего робота в виртуальном окружении задействован подход, основанный на технологии функциональных схем и виртуальных пультов управления. Апробация предложенных методов и подходов проводилась в программном комплексе виртуального окружения VirSim и показала их адекватность и эффективность для моделирования движения шагающего робота с сохранением его равновесия.

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

Финансирование: исследование выполнено при финансовой поддержке РФФИ в рамках научного проекта № 20-07-00371.

Для цитирования: Страшнов Е.В., Финагин JI.A. Моделирование полуавтоматического режима управления движением двуногих шагающих роботов в системах виртуального окружения // Автоматизация и моделирование в проектировании и управлении. 2022. №3 (17). С. 57-67. doi: 10.30987/2658-6436-2022-3-57-67.

Original article Open Access Article

SIMULATING A SEMI-AUTOMATIC MOTION CONTROL MODE OF BIPEDAL WALKING ROBOTS IN VIRTUAL ENVIRONMENT SYSTEMS

Evgeny V. Strashnov1, Leonid A. Finagin2

2 Federal State Institution "Federal Scientific Centre "Research Institute for System Research of the Russian Academy of Science"

1 strashnov_evg@mail.ru

2 antifin@mail.ru

Abstract. The paper considers methods and approaches for semi-automatic motion control of bipedal walking robots in virtual environment systems. The proposed solutions include generating a walking pattern, calculating inverse kinematics, and synthesis of PD-controllers with feedback based on the angle sensor readings. To ensure the static and dynamic stability of the walking robot, generating its movement trajectories is implemented using the criterion of zero moment point (ZMP) and the inverse pendulum model with virtual height. In this case, the walking pattern is generated by solving the problem of inverse kinematics using the Leven-berg-Marquardt method to calculate the rotation angles in the robot joints. To implement semi-automatic motion control of a walking robot in a virtual environment, an approach based on the technology of functional diagrams and virtual control panels is used. Testing the proposed methods and approaches is carried out in the VirSim virtual environment software package and shows their adequacy and efficiency for modelling a walking robot movement while maintaining its balance.

© Страшнов E.B., Финагин JI.A., 2022

57

Keywords: bipedal walking robot, simulation, walking pattern, stability, zero moment point, inverse kinematics, virtual consolé, PD controller, virtual environment system

Financing: ehe study was carried out with the financial support of the Russian Foundation for Basic Research within the framework of scientific project No. 20-07-00371.

For citation: Strashnov E. V., Finagin L. A. Simulating a semi-automatic motion control mode of bipedal walking robots in virtual environment systems. Automation and modeling in design and management, 2022, no. 3 (17). pp. 57-67. doi: 10.30987/2658-6436-2022-3-57-67

Введение

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

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

Задаче моделирования управления движением ДТТТР посвящено множество работ. Один из подходов основан на синтезе управления с помощью модели мышц [2] и генерации правдоподобных человеку движений. Однако такой подход применим только для анимации антропоморфных персонажей, но не для управления роботами. Существует ряд решений [3 - 5], которые базируются на концепции точки нулевого момента (ТНМ) [6] для обеспечения равновесия ДТТТР Непосредственное применение этого критерия к математической модели робота является затруднительным, поэтому широкое распространение получили упрощенные модели движения ДТТТР Примером служит модель обратного маятника с виртуальной высотой [7], которая позволяет повысить точность вычисления ТНМ для расчета траектории движения робота в режиме офлайн.

В работе предлагаются методы и подходы для моделирования полуавтоматического управления ДТТТР в системах виртуального окружения. Предлагаемые решения основаны на генерации шаблона ходьбы с вычислением траекторий движения центра масс и стоп робота для реализации его основных движений. Для обеспечения статической и динамической устойчивости робота приметается модель обратного маятника с виртуальной высотой, метод Левенберга-Маркварда для расчета инверсной кинематики и ПД-регуляторы. Апробация предлагаемых методов и подходов для моделирования движения ДТТТР проводилась в программном комплексе виртуального окружения VirSim [8] с применением оригинальной технологии функциональных схем и виртуальных пультов управления.

Задача управления движением виртуального шагающего робота

Рассмотрим ДТТТР который представляет собой систему шарнирно связанных звеньев, где манипуляторы (руки) служат для захвата объектов, а педипуляторы (ноги) для его перемещения. На рис. 1 показана созданная в системе компьютерного моделирования 3ds Мах виртуальная модель ДТТТР [9], движение которого осуществляется под действием электроприводов, установленных в сочленениях робота.

Движение педипуляторов описывается с помощью обобщенных координат q¡ и q, размерности N. Педипуляторы в модели на рис. 1 имеют по семь степеней свободы {N = 7): три степени свободы для бедра, одна степень для колена и три степени свободы для ступни. Управляющими параметрами являются векторы напряжений щ и иг, которые подаются на электроприводы педипуляторов робота.

Рис. 1. Виртуальная модель двуногого шагающего робота Fig. 1. Virtual model of bipedal walking robot

Для описания движения (ходьбы) робота рассматриваются следующие системы координат: мировая система координат (MCK) Oxyz, система координат торса робота, начало которой совпадает с центром масс робота, и системы координат ступней робота. Тогда положение и ориентация торса робота задается вектором рс и матрицей Rc, а для ступней -векторами />/, р, и матрицами R/, R, .

Задача управления движением ДТТТР заключается в обеспечении перемещения робота с сохранением равновесия (без его падения). При синтезе управления роботом предполагается, что верны следующие допущения:

1) перемещение робота выполняется без участия рук;

2) в процессе движения торс робота сохраняет вертикальное положение;

3) движение торса робота происходит на постоянной высоте;

4) стопы всегда параллельны плоскости поверхности и их движение выполняется только в саггитальной плоскости.

Структура предлагаемой системы управления движением робота показана на рис. 2.

Шаблон ходьбы Управление движением

Fig. 2. Structure of robot control scheme

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

выполняется расчет напряжении, подаваемых на электроприводы педипуляторов, обеспечивая тем самым заданное движение. Опишем предлагаемые методы управления движением ДТТТР более подробно.

Генерация шаблона ходьбы робота

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

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

Рассмотрим первый шаг робота, который выполняется левой ногой. Пусть для удобства МСК расположена посепепине между ступнями робота в его изначальном положении. Тогда зададим траекторию р? = {х^.у^г!1) движения стопы левой ноги на отрезке / е [0,7)] следующим образом:

f(t) = -x0= const; yf(t) - - j

С Л

7Tt

1 - COS —

T

V 1fJ

чо=-2

1-cos

T

.f )

(1)

где Л"() - расстояние от МСК до стопы робота; Ь - длина шага; 7", - время выполнения

первого шага; Н - максимальная высота подъема стопы ноги.

Первый шаг выполняется с обеспечением статической устойчивости робота и включает следующую последовательность действий (рис. 3, а): перенос центра масс робота на правую ногу, перемещение левой ноги на шаг вперед по траектории (1) и перенос центра масс в

середину между стопами с разгоном до заданной скорости у^- — у^у, 0)Т.

(а) (б)

Рис. 3. Первый шаг робота (а) и движение с фазой опоры на левую ногу (б) Fig. 3. Robot first step (a) and single support phase on the left foot (b)

Воспользуемся кубическим многочленом для задания траектории движения центра масс робота на третьем этапе выполнения первого шага робота. Пусть Та - время движения

робота на этом этапе. Тогда, используя граничные условия л'^(0) = хи; х1'(Та) = 0; х^ (0) = 0 ;

= ^ Ус(0) = 0; у1(Та) = Ы2- 0) = 0 и = получим траекторию

движения центра масс робота на отрезке I е [0, Та ]:

V

СУ

т

/Л0 =

_су_

т2

V а

L

Т:

f +

а J

" J

f}L

v2 Г;

i

су

Зх-,

Т

Г + х,

о >

(2)

« J

Г.

Г ; zd (/) = -0 = const.

а J

Прямолинейное движение ДТТТР является цикличным повторением движений правой и левой ноги. Рассмотрим очередной шаг робота, где левая нога является опорной, а правая нога находится изначально позади (см. рис. 3, б). Пусть траектория р? = (.хг>Уг'2г)Т движения стопы правой ноги на отрезке I е [0, Г ] задается как:

г ~ д

<(0

: const; уг (!) = L

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

1 - cos —

V

Т„

s J

1 - cos

2nt

T„

(3)

i J

где Г - время выполнения шага.

Для вычисления траектории движения центра масс робота воспользуемся критерием ТНМ динамической устойчивости робота [6] и моделью обратного маятника с виртуальной высотой [7]. Тогда координаты ТНМ (рх,р%1) связаны с координатами центра масс (х,ус) робота посредством уравнений:

СЦ, .. pzn ..

рх=хс--Pv - Ус--

8 8

(4)

где g - ускорение свободного падения; 20 - высота маятника; аир- постоянные.

В модели (4) величины а20 и (Зг,, задают виртуальную высоту маятника для двух разных плоскостей. В системе координат стопы левой ноги робота будет рх— 0 и ру = 0, а соотношения (4) сводятся к дифференциальным уравнениям:

хс~ — хс = 0; ус-^-ус = 0.

azn

Решая эти уравнения, после обратного преобразований в МСК получим траекторию движения центра масс робота на отрезке ? е ]:

4 (0 = -*о + С1 expaj) + С2 exp(-Aj); ydc (t) = L + C3 exp(l/) + C4 exp(-kvf);

(5)

zl'(J) - z0 - const,

где kx = yjg/ az0 ; kv = yjg / Pz0 ; константы C;, /' = 1,4 вычисляются из граничных условий хе(0)=0, = yc(0) = L/2, yc(Ts) = 3L/2 путем решения системы линейных

уравнений. При этом для (5) должно быть выполнено v^.'. = xd (0) и vd — .

Траектории движения стоп левой ноги и центра масс робота в фазе движения с опорой на правой ногу задаются аналогично выражениям (3) и (5).

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

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

Рассмотрим поворот ДТТТР направо по часовой стрелке на угол ср , который выполняется с обеспечением статической устойчивости робота. Последовательность действий показана на рис. 4.

Рис. 4. Поворот робота вправо с фазой опоры на левую (я) и правую (б) ногу Fig. 4. Robot rotation to the right with support on the left foot (a) and the right foot (b)

На первом этапе центр масс робота смещается на левую ногу и выполняется движение

стопы правой ноги (см. рис. 4, а) по траектории, задаваемой вектором р? = (Хг,Уг>гг)Т матрицей Я? — г) поворота на угол Ф^ СО вокруг оси г, которые вычисляются как:

и

где Тг - время переноса стопы правой ноги.

На втором этапе центр масс ДТТТР переносится на правую ногу с поворотом корпуса на угол ф и выполняется движение стопы левой ноги (см. рис. 4, б) по траектории, задаваемой

вектором р? = (х?,у?,2?)Т и матрицей Ц? - Д(ф['(0,г):

1 - cos

27Zt

Л

Z

(6)

г J

(7)

где Т, - время переноса стопы левой ноги.

На последнем этапе центр масс ДТТТР переводится в середину опоры двух ног. Поворот ДТТТР влево против часовой стрелки осуществляется аналогично траекториям (6) и (7) с фазами опоры сначала на левую ногу робота, а затем на правую.

Инверсная кинематика. Задача инверсной кинематики для педипуляторов ДШР формулируется следующим образом: зная координаты стоп и торса робота (положения и ориентации) требуется найти углы в суставах педипуляторов робота. Другим словами, для заданных Рг> &ггР?1 ^>Рс> Яс необходимо найти и ц?.

Для решения этой задачи воспользуемся итерационным методом Левенберга-Марквардта [10]. Опишем применение этого метода на примере вычисления углов qr правого педипулятора робота. Пусть рг (ц,) и 11, (дг) - положение и ориентация стопы, которые

и В этом

вычисляются путем решения задачи прямой кинематики для заданных р; случае вектор невязки определяется как: — (ел^г),е2(.дг)У, где ех{(\г) = р^ —ргС*?,-) —

- невязка по положению стопы; е2(_с]г) — )7 /?г(£7, )^ - невязка по ориентации стопы;

а (К) - эквивалентное представление ориентации в виде вектора оси мгновенного вращения.

Идея метода Левенберга-Марквардта заключается в том, что на каждом шаге итерации задача формулируется в виде минимизации функции:

+ ~- Я,,к,4 ~ Н ~]кАЯг,к, (8)

где к - номер итерации; цгк - углы поворотов правого педипулятора робота на к-ой итерации; Шв - диагональная весовая матрица (размерностью 6 на 6); Щг - диагональная матрица демпфирования (размерностью А' на Лг); /к - матрица Якоби (размерностью 6 на Л').

На каждом шаге итерации минимизация (8) выполняется по следующему правилу:

ЙТМ-. 1 = Чг,к + и^дк, Нк = Лши]к + Шп, дк = Цшвек, (9)

где Нк - матрица Гессе (размерностью Л^ на Ы).

С использованием (9) и заданием начального значения д- = 0 итерации

продолжаются до тех пор, пока не будет выполнено |А^'.д|<в, / = 1,уУ , где в - заданное число.

Аналогичным образом реализуется решение задачи инверсной кинематики для левого педипулятора робота.

Синтез управления роботом

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

решения этой задачи рассмотрим ПД регуляторы с обратной связью по показания датчиков углов (/{(£) и Тогда напряжения /// и //,-, подаваемые на электроприводы педипуляторов,

формируются в следующем виде:

»!,«) = -кр (ч,ЛО-ч;1АО)-К (^/ДО-ЙСО); (ю)

"г , (0 = ~кР (ч,. , (О - й (0) - К (ч,. , (О - ¿(1А (о), / = Ш,

где кр > 0 и кс] > 0 — коэффициенты ПД регулятора.

Напряжения электроприводов ограничены по модулю величиной г/тах. Поэтому на практике значения ип и игП вычисленные по формуле (10), необходимо скорректировать следующим образом: если ии > ытях, то ии = ытях; если ии < -«тах, то ии = -«тах. Аналогичным образом корректируются напряжения иг;.

Результаты моделирования

Предложенные методы и подходы управления движением ДТТТР были реализованы в программном комплексе виртуального окружения Уп81т [8], созданном в ФГУ ФНЦ НИИСИ РАН. В этом программном комплексе реализация системы управления роботом осуществляется с применением технологии виртуальных пультов и функциональных схем. Идея такого подхода заключается в том, что пользователь взаимодействует с элементами виртуального пульта [9] (например, нажимает на кнопки) и задает команды на выполнение движений манипуляторов и педипуляторов робота. Логика управления роботом подчиняется функциональной схеме, которая создается в специальном редакторе из набора связанных линиями блоков, куда входят блоки элементов виртуального пульта, датчиков, исполнительных устройств и т.д.

На каждом шаге моделирования по командам, поступающим от виртуального пульта управления, выполняется расчет управляющих сигналов, согласно созданной функциональной схеме. Полученные значения управляющих сигналов далее подаются на исполнительные устройства робота. Такой подход был задействован для полуавтоматического управления ДТТТР Для генерации шаблона ходьбы робота была использована среда МаЙаЬ, в которой в режиме офлайн был выполнен расчет траекторий д1и 1,(0 для основных движений робота с их последующей записью в текстовые файлы. На рис. 5 показан фрагмент упрощенной функциональной схемы для управления одним электроприводом педипулятора ДТТТР в полуавтоматическом режиме.

Рис. 5. Функциональная схема управления Fig. 5. Block diagram scheme

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

Моделирование полуавтоматического режима управления ДТТТР проводилось в программном комплексе VirSim на примере решения задачи поиска и дезактивации радиоактивного объекта. Основные параметры моделирования приведены в табл 1.

Таблица 1

Параметры моделирования

Table 1

Simulation parameters

Параметр Значение Параметр Значение Параметр Значение

L 20 см Tf 1,0 с а 0.1

Н 10 см 0,75 с ß 1

хо 10,09 см ^ S 1,5 с 8 10"12

-0 120 см т,- 1,0 с К 1

* ф 45° Т, 1,0 с К, 0,005

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

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

Рис. 6. Управление движением ДШР в полуавтоматическом режиме с помощью виртуального пульта Fig. 6. Motion control ofBWR in semi-automatic mode using virtual panel

Заключение

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

Список источников:

References:

1. Юревич, Е.И. Основы робототехники: учеб. пособие, 4-е изд., перераб. и доп. // СПб: БХВ-Петербург, 2017.-304 с.

2. Flexible Muscle-Based Locomotion for Bipedal Creatures / T. Geijtenbeek, M. van de Panne, A. Frank van der Stappen // ACM Transactions on Graphics 32. -2013. - No. 6. doi: 10.1145/2508363.2508399.

3. Modeling, simulation and optimization of bipedal walking // K. Mombauri, K. Berns. - Springer. -2013. -298 p.

4. Biped walking pattern generation based on spatially quantized dynamics / S. Kajita, M. Benallegue, R. Cisneros, T. Sakaguchi, S. Nakaoka, M. Morisawa, K. Kaneko, F. Kanehiro // IEEE-RAS 17th International Conference on Humanoid Robotics, Birmingham, UK. -2017. - pp. 599-605. doi: 10.1109/HUMANOIDS. 2017.8246933.

5. Feedback control of dynamic bipedal robot locomotion, ser. Control and Automation // E. Westervelt, J. Grizzle, C. Chevallereau, J. Choi, B. Morris. - Boca Raton: CRC Press, June 2007. - 503 p.

6. Zero-moment point - thirty-five years of its life / M. Vukobratovic, B. Borovac //International Journal of Humanoid Robotics. - 2004. -No. 1. - pp. 157-173. doi: 10.1142/S0219843604000083.

7. An effective trajectory generation method for bipedal walking / Т. Ha, C.-H. Choi // Robotics and Autonomous Systems. - 2007. - No. 55. - pp. 795-810. doi: 10.1016/j.robot.2007.06.001.

8. Система виртуального окружения VirSim для имита-ционно-тренажерных комплексов подготовки космонавтов / М.В. Михайлюк, А.В. Мальцев, П.Ю. Тимохин, Е.В. Страшнов, Б.И. Крючков, В.М. Усов // Пилотируемые полеты в космос. - 2020. - Т. 37 - № 4. - С. 72-95. doi: 10.34131/MSF.20.4.72-95.

9. Командный режим управления виртуальным двуногим шагающим роботом / Е.В. Страшнов, И.Н. Миро-ненко, Л.А. Финагин // Труды НИИСИ РАН. - 2020. -Т. 10. -№ 4. - С. 33-39.

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

10. Sugihara, Т. Solvability-unconcerned inverse kinematics based on Levenberg-Marquardt method with robust damping // 9th IEEE-RAS International Conference on Humanoid Robots, Paris, France.-2009-pp. 555-560. doi: 10.1109/ICHR.2009.5379515.

1. Yurevich E.I. Fundamentals of Robotics. St. Petersburg: BHV-Petersburg; 2017.

2. Geijtenbeek T., Van de Panne M., Frank van der Stappen A. Flexible Muscle-Based Locomotion for Bipedal Creatures. ACM Transactions on Graphics 32. 2013 (6). doi: 10.1145/2508363.2508399.

3. Mombauri K., Berns K. Modelling, Simulation and Optimization of Bipedal Walking. Springer; 2013.

4. Kajita S, Benallegue M, Cisneros R, Sakaguchi T, Nakaoka S, Morisawa M, Kaneko K, Kanehiro F. Biped Walking Pattern Generation Based on Spatially Quantized Dynamics. In: Proceedings of IEEE-RAS 17th International Conference on Humanoid Robotics; Birmingham (UK): 2017. p. 599-605. doi: 10.1109/HUMANOIDS. 2017.8246933.

5. Westervelt E., Grizzle J., Chevallereau C., Choi J., Morris B. Feedback Control of Dynamic Bipedal Robot Locomotion, ser. Control and Automation. Boca Raton: CRC Press; 2007.

6. Vukobratovic M., Borovac B. Zero-Moment Point -Thirty-Five Years of Its Life. International Journal of Humanoid Robotics. 2004;1:157-173. doi: 10.1142/S0219843604000083.

7. Ha T., Choi C.-H. An Effective Trajectory Generation Method for Bipedal Walking. Robotics and Autonomous Systems. 2007;55:795-810. doi: 10.1016/j.robot. 2007.06.001.

8. Mikhailyuk M.V., Maltsev A.V., Timokhm P.Yu., Strashnov E.V., Kryuchkov B.I., Usov V.M. VirSim Virtual Environment System for Simulation Training Complexes for Cosmonaut Training. Manned Spaceflight Scientific Periodical. 2020;37(4):72-95. doi: 10.34131/MSF.20.4.72-95.

9. Strashnov EV, Mironenko IN, Finagin LA. Command Mode for Virtual Bipedal Walking Robot Control. In: Proceedings of NIISI RAS: 2020;10(4). p.33-39.

10. Sugihara T. Solvability-Unconcerned Inverse Kinematics Based on Levenberg-Marquardt Method with Robust Damping. In: Proceedings of the 9th IEEE-RAS International Conference on Humanoid Robots; Paris (France):2009. p.555-560. doi: 10.1109/ICHR. 2009.5379515.

Информация об авторах

Евгений Владимирович Страшнов

научный сотрудник Федерального государственного учреждения «Федеральный научный центр Научно-исследовательский институт системных исследований Российской академии наук»

Леонид Алексеевич Финагин

научный сотрудник Федерального государственного учреждения Федеральный научный центр Научно-исследовательский институт системных исследований Российской академии наук»

Information about authors: Evgeny Vladimirovich Strashnov

Researcher of the Federal State Institution «Scientific Research Institute for System Analysis of the Russian Academy of Sciences»

Leonid Alekseevich Finagin

Researcher of the Federal State Institution «Scientific Research Institute for System Analysis of the Russian Academy of Sciences»

Вклад авторов: все авторы сделали эквивалентный вклад в подготовку публикации.

Contribution of the authors: the authors contributed equally to this article.

Авторы заявляют об отсутствии конфликта интересов.

The authors declare no conflicts of interests.

Статья поступила в редакцию 22.06.2022; одобрена после рецензирования 02.08.2022; принята к публикации 05.08.2022.

The article was submitted 22.06.2022; approved after reviewing 02.08.2022; accepted for publication 05.08.2022.

Рецензент - Подвесовский А.Г., кандидат технических наук, доцент, Брянский государственный технический университет.

Reviewer - Podvesovskij AG., Candidate of Technical Sciences, Associate Professor, Bryansk State Technical University.

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