Научная статья на тему 'Способы стабилизации двуногих роботов в положении стоя на подвижной опоре'

Способы стабилизации двуногих роботов в положении стоя на подвижной опоре Текст научной статьи по специальности «Математика»

CC BY
762
90
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
ШАГАЮЩИЙ РОБОТ / WALKING ROBOT / ПОДВИЖНАЯ ОПОРА / MOVABLE SUPPORT / СТАБИЛИЗАЦИЯ / STABILIZATION / СИСТЕМА УПРАВЛЕНИЯ / CONTROL SYSTEM

Аннотация научной статьи по математике, автор научной работы — Базылев Д.Н., Пыркин А.А., Маргун А.А., Зименко К.А., Кремлев А.С.

Предмет исследования. Рассматривается задача стабилизации двуногих шагающих роботов на поверхности, угол наклона и угловая скорость которой изменяется произвольно в ограниченном диапазоне. Методы. Предлагаются два способа стабилизации двуногих роботов. В первом способе требуется построение кинематической и динамической моделей робота. Динамические уравнения получены с помощью метода Эйлера-Лагранжа. Алгоритм управления основан на методе инверсной динамики, при котором исходная нелинейная динамическая модель линеаризуется обратной связью. Во втором способе стабилизации используется только кинематическая модель робота. Для данного подхода разработан гибридный регулятор. При низких угловых скоростях подвижной опоры стабилизация робота выполняется ПД-регулятором по ошибке углов отклонения вала сервоприводов. При относительно высоких угловых скоростях опоры в управлении дополнительно используются измерения гироскопа, установленного в торсе робота. В качестве цели управления для двух подходов было выбрано условие поддержания центра масс робота над центром опоры для обеспечения устойчивого положения. Основные результаты. Работоспособность и эффективность предложенных способов стабилизации двуногих роботов на подвижной поверхности продемонстрированы на примерах численного моделирования. Оба способа обеспечивают устойчивость балансирующих роботов при изменении угла наклона и угловой скорости подвижной поверхности в диапазонах jÎ (-50°; 50°) и wÎ (-40° / c; 40° / c) соответственно. Проведен сравнительный анализ данных подходов при одинаковых требованиях к показателям качества переходных процессов: время переходного процесса tп < 0, 2 с и перерегулирование s= 0%. Определены условия, при которых каждый из способов управления будет более эффективным при реализации на практике. Практическая значимость. Разработанные способы управления могут быть использованы для стабилизации подобных роботов, а также служить основой при построении регуляторов для более сложных моделей шагающих механизмов, имеющих большее число степеней свободы и осуществляющих ходьбу по подвижной опоре.

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

Approaches for stabilizing of biped robots in a standing position on movable support

Subject of research. The problem of stabilization for biped walking robots on the surface is considered. The angle and angular velocity of the movable surface varies randomly in a limited range. Methods. Two approaches of stabilization of biped robots are proposed. The first approach requires the construction of kinematic and dynamic models of the robot. Dynamic equations were obtained using the Euler-Lagrange method. The control algorithm is based on the method of inverse dynamics, in which the original nonlinear dynamic model is linearized by a feedback. The second stabilization algorithm uses only the kinematic model of the robot. A hybrid controller is developed for this approach. In the case of low angular velocities of the movable support the robot stabilization is performed by PD controller on the basis of the angle error of deflection of the servo shaft. In the case of relatively high angular velocities of the support the controller also uses the gyroscope readings mounted in the robot torso. Maintenance of the robot’s gravity center over the center of bearing area for providing a stable position was chosen as a goal of control in both approaches. Main results. Efficiency and effectiveness of the proposed approaches for stabilization of biped robots on the moving surface are demonstrated by the numerical simulation. Both methods provide stability of the balancing robots on changing the angle of inclination and angular velocity of the moving surface in the ranges fÎ(-50°; 50°) and wÎ(-40° / sec; 40° / sec), respectively. Comparative analysis of these approaches under identical requirements for quality indicators of transients is also provided: transient time tп < 0.2 sec and overshoot s = 0%. The conditions under which each of the control methods will be more effective in practice are identified. Practical significance. The developed control approaches are usable to stabilize similar robots, as well as to serve as a basis for the construction of regulators for more complex models of walking mechanisms that have a greater number of degrees of freedom and walk on a movable support.

Текст научной работы на тему «Способы стабилизации двуногих роботов в положении стоя на подвижной опоре»

НАУЧНО-ТЕХНИЧЕСКИИ ВЕСТНИК ИНФОРМАЦИОННЫХ ТЕХНОЛОГИИ, МЕХАНИКИ И ОПТИКИ май-июнь 2015 Том 15 № 3 ISSN 2226-1494 http://ntv.ifmo.ru/

SCIENTIFIC AND TECHNICAL JOURNAL OF INFORMATION TECHNOLOGIES, MECHANICS AND OPTICS

May-June 2015

Vol. 15 No 3 ISSN 2226-1494

http://ntv.ifmo.ru/en

УДК 681.51

СПОСОБЫ СТАБИЛИЗАЦИИ ДВУНОГИХ РОБОТОВ В ПОЛОЖЕНИИ СТОЯ НА ПОДВ ИЖНОЙ ОПОРЕ

Д.Н. Базылев3, А.А. Пыркин3, А.А. Маргун3, К.А. Зименко3, А.С. Кремлев3, Д.Д. Ибраев3,

М. Чехь

3 Университет ИТМО, Санкт-Петербург, 197101, Российская Федерация ь Университет Западной Богемии, 306 14, Пльзень, Чехия Адрес для переписки: bazylevd@mail.ru Информация о статье

Поступила в редакцию 17.07.14, принята к печати 03.04.15

doi:10.17586/2226-1494-2015-15-3-418-425

Язык статьи - русский

Ссылка для цитирования: Базылев Д.Н., Пыркин А.А., Маргун А. А., Зименко К.А., Кремлев А.С., Ибраев Д.Д., Чех М. Способы стабилизации двуногих роботов в положении стоя на подвижной опоре // Научно-технический вестник информационных технологий, механики и оптики. 2015. Т. 15. № 3. С. 418-425.

Аннотация

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

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

Основные результаты. Работоспособность и эффективность предложенных способов стабилизации двуногих роботов на подвижной поверхности продемонстрированы на примерах численного моделирования. Оба способа обеспечивают устойчивость балансирующих роботов при изменении угла наклона и угловой скорости подвижной поверхности в диапазонах ф е (-50°; 50°) и юе (-40° / с; 40° / с) соответственно. Проведен сравнительный анализ данных подходов при одинаковых требованиях к показателям качества переходных процессов: время переходного процесса tn < 0,2 си перерегулирование ст = 0% . Определены условия, при которых каждый из способов управления будет более эффективным при реализации на практике.

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

шагающий робот, подвижная опора, стабилизация, система управления. Благодарности

Работа выполнена при государственной финансовой поддержке ведущих университетов Российской Федерации (субсидия 074-U01). Работа была поддержана Министерством образования и науки Российской Федерации (проект 14.Z50.31.0031).

APPROACHES FOR STABILIZING OF BIPED ROBOTS IN A STANDING POSITION ON MOVABLE SUPPORT D.N. B3zylev3, A.A. Pyrkin3, A.A. M3rgun3, K.A. Zimenko3, A.S. Kremlev3, D.D. Ibraev3, M. Cechb

3 ITMO University, Saint Petersburg, 197101, Russian Federation b University of West Bohemia, Pilsen, 306 14, Czech Republic Corresponding author: bazylevd@mail.ru Article info

Received 17.07.14, accepted 03.04.15 doi:10.17586/2226-1494-2015-15-3-418-425 Article in Russian

For cit3tion: Bazylev D.N., Pyrkin A.A., Margun A.A., Zimenko K.A., Kremlev A.S., Ibraev D.D., Cech M. Approaches for stabilizing of biped robots in a standing position on movable support. Scientific and Technical Journal of Information Technologies, Mechanics and Optics, 2015, vol.15, no. 3, pp. 418-425.

Abstract

Subject of research. The problem of stabilization for biped walking robots on the surface is considered. The angle and angular velocity of the movable surface varies randomly in a limited range.

Methods. Two approaches of stabilization of biped robots are proposed. The first approach requires the construction of kinematic and dynamic models of the robot. Dynamic equations were obtained using the Euler-Lagrange method. The control algorithm is based on the method of inverse dynamics, in which the original nonlinear dynamic model is linearized by a feedback. The second stabilization algorithm uses only the kinematic model of the robot. A hybrid controller is developed for this approach. In the case of low angular velocities of the movable support the robot stabilization is performed by PD controller on the basis of the angle error of deflection of the servo shaft. In the case of relatively high angular velocities of the support the controller also uses the gyroscope readings mounted in the robot torso. Maintenance of the robot's gravity center over the center of bearing area for providing a stable position was chosen as a goal of control in both approaches. Main results. Efficiency and effectiveness of the proposed approaches for stabilization of biped robots on the moving surface are demonstrated by the numerical simulation. Both methods provide stability of the balancing robots on changing the angle of inclination and angular velocity of the moving surface in the ranges фе (-50°; 50°) and roe (-40° /sec; 40° /sec), respectively. Comparative analysis of these approaches under identical requirements for quality indicators of transients is also provided: transient time tn < 0.2 sec and overshoot a = 0%. The conditions under which each of the control methods will be more effective in practice are identified.

Practical significance. The developed control approaches are usable to stabilize similar robots, as well as to serve as a basis for the construction of regulators for more complex models of walking mechanisms that have a greater number of degrees of freedom and walk on a movable support. Keywords

walking robot, movable support, stabilization, control system.

Acknowledgements

This work was partially financially supported by the Government of the Russian Federation, Grant 074-U01. The work was supported by the Ministry of Education and Science of the Russian Federation (project 14.Z50.31.0031).

Введение

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

Движение двуногих роботов изучается свыше сорока лет. Большое количество статей посвящено простым моделям, таким как «циркульный робот». Устойчивое движение таких моделей изучается как для управляемых [1-4], так и для пассивных роботов, шагающих вниз по склону [4-7].

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

В работе [5] рассматривается поведение на наклонной поверхности плоского циркульного робота, имеющего два звена и две степени свободы, исследуется устойчивое пассивное движение робота. В [2, 5] используется принцип пассификации, позволяющий затрачивать намного меньше энергии на перемещение. Авторы работы [3] исследуют устойчивую ходьбу на горизонтальной поверхности плоского трех-звенного робота, имеющего три степени свободы. В настоящей работе рассматривается похожая модель, имеющая три звена и три степени свободы. Основное отличие данной работы от подобных заключается в том, что в настоящей работе исследуется задача планирования и стабилизации двуногих роботов, балансирующих на наклонной поверхности, угол которой изменяется произвольным образом в заданном диапазоне угловых координат и скоростей.

Научный интерес к задаче стабилизации движений двуногих роботов значительно возрос в последнее время. В первую очередь это связано с достаточным уровнем развития аппаратных и программных средств, что позволяет реализовывать на практике разработанные в теории алгоритмы. Экспериментальная проверка может проводиться на различных робототехнических наборах [10-12]. Настоящая работа является развитием алгоритмов управления двуногими роботами и планирования траекторий их движений, предложенных в предыдущих работах [13, 14].

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

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

Модели стабилизации

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

Общий вид двуногого робота представлен на рис. 1, а. Данный робот может быть представлен в виде упрощенной, так называемой «циркульной» модели, изображенной на рис. 1, б. Подобная упрощенная схема позволяет описывать двуногих роботов, балансирующих наклоном торса как вперед и назад, так и влево и вправо. Упрощенная модель является плоским шагающим механизмом и имеет три звена с массами т1, т2 и т3. Каждое звено представлено в виде прямого тонкого стержня длиной 2/,- и управляется моментом силы и, прикладываемым в точке соединения звеньев. Величина ^ - проекциия линии опоры робота на горизонтальную ось и зависит от угла наклона ф поверхности и положения ног робота.

q,

m,

m2

Ч2

l1 Ф

а б

Рис. 1. Общий вид (а) и упрощенная модель (б) циркульного двуногого робота

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

М(я) я +С(я,я)=и, (1)

где М(я) - матрица инерции; С(я, я) - матрица центростремительных, кориолисовых и потенциальных

сил, q = (q1 q2 q, )T - вектор обобщенных координат, u = (u1

Л 2 + A,

иъ )T - вектор управления,

M(q) = -0,5

A2: A,.

Aii + Ai, A21 A,1 + A,3

A11 + A12 Л A21 + A22

A,,

C(q, q) = -0,5

f B2 + в, Л B + B,

B + B2 ,

, , 4ml2 4

Для упрощения расчетов примем параметры робота равными щ = 1 кг, l ¡ = 1 м, I t = —,— = ,; получаем следующие значения коэффициентов матриц M (q) и C(q, q): B1 = -4q12 sin q1 cos q1 - 2q2¡ sin q2 cos q1 - 2q32 sin(q, - q1) - 4g sin q1, B2 = -4qf sin q1 cos q1 - 2g sin q2, B, = -4qf sin(q, - q1) - 2g sin q,,

f 1 2 Л

6, + 4 cos q1 2 cos q1 cos q2 2cos(q, - q1)

A j =

2cosq1 cosq2 2cos(q, - q1)

1

0

21

Известно, что тело, находящееся на горизонтальной плоскости, начинает падать, когда проекция положения его центра масс выходит за площадь опоры. Очевидно, что запас устойчивости робота зависит от положения его центра масс относительно центра проекции опоры Sx и внешних сил со стороны подвижной поверхности. Будем считать, что наклонная поверхность не имеет линейного ускорения. Тогда цель управления роботом - поддержание координат центра масс над центром линии опоры Sx:

X ^1 Sx, (2)

с 2 x

- центр масс робота по оси x. Из (2) получаем желаемые траектории q*, q*, q3:

q1 ^q* = a/2-ф, q2 ^q* =a/2 + ф, q3 ^q* = arcsin(0,5sinф), где a = q1 + q2 = const. При синтезе регулятора воспользуемся методом инверсной динамики [15], при котором строятся два регулятора для объекта управления: внутренний и внешний. Внешний регулятор представляет собой нелинейное управление:

u=M(q) a, + C(q,q) , (3)

где a = (aq1 aq2 a 3 )T - новое виртуальное управление. Подставляя (3) в (1), получаем линеаризованную систему при условии невырожденности матрицы M(q):

q=v (4)

При выборе внутреннего регулятора в виде

aq =-K,q -K,q + r , (5)

в котором r - новое управление, и подстановке (5) в (4) получим

q+K d q+K, q = r ,

где K = (Kp1 Kp 2 Kp3) и Kd = (Kd1 Kd 2 Kd 3) - коэффициенты внешнего по отношению к линеаризованной системе (4) пропорционально-дифференциального (ПД) регулятора.

Связывая r с желаемыми траекториями в форме

r=q*+K „ q* +K p

получаем модель ошибки в виде

e + Kde + Kpe = 0 .

Таким образом, внутренний регулятор со входом r и выходом aq представляет собой ПД-регулятор.

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

Второй шагающий двуногий робот, общий вид которого представлен на рис. 2, а, был собран из робототехнического набора Bioloid. Для построения кинематической модели была построена упрощенная модель данного робота, приведенная на рис. 2, б. На данном рисунке приведено схематичное изображение робота с одной стороны (вид сбоку), поэтому изображена только одна нога и торс робота. Параметры второй конечности робота такие же, как и у первой. Модель состоит из четырех звеньев и трех вращательных сочленений. Углы q1, q2, q3 могут быть измерены энкодерами серводвигателей, управление которыми может осуществляться с помощью встроенного регулятора прямым заданием желаемых траекторий. Массы звеньев обозначены m1, m2, m3 и M. Вращение звеньев происходит только в сочленениях робота, обозначенных точками О1, О2 и О3. Все остальные соединения считаются жесткими. Таким образом, данная модель имеет 4 степени свободы. В соответствии с обозначениями на рис. 2, б, были измерены следующие параметры модели робота: m1 = 165,1 г, m2 = 77,5 г, m3 = 29,2 г, M = 323,3 г, L = 100,4 мм, l1 = 53,9 мм, l2 = 40,2 мм, l3 = 66,1 мм, l4 = 8,9 мм, l5 = 34,8мм, l6 = 40,2мм, l7 = 42,5мм, a = 10,1, a = const = 37,3° .

Цель управления для этого робота - та же, что и для виртуальной модели, т.е. поддержание координат центра масс над центром линии опоры Sx:

x„ ^1 Sx =1L cos ф, (6)

с 2 x 2

m,x, + m2 x2 + m3 x3 + Mx, где xc =--центр масс двуногого робота по оси x.

m1 + m2 + m3 + M

M

q2

Ü2

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

m2

q1

O1

I2

а

(7)

Sx

a б

Рис. 2. Общий вид (а) и упрощенная модель (б) двуногого робота Bioloid

Координаты масс звеньев робота: x1 = l1 cos ф-12 sin Ф, x2 = x1 - a sin(a - ф) -1, sin(q1 + ф),

x, = x2 -14 sin(q1 + ф) + b cos(q1 + ф) - b cos(q2 - q1 - ф) +15 sin(q2 - q1 - ф), X4 = x, +16 sin(q2 - ql - ф) + /7 sin(q, + q2 - qx - ф).

Определим желаемые траектории робота. Если учесть, что угол наклона поверхности ф измерим, то хг также является известным. Тогда, комбинируя уравнения (6) и (7), получаем уравнение, которое содержит три неизвестных величины q¡, q2, q,. Следовательно, имеем бесконечное число подходящих траекторий q*, q*, q,, поэтому, чтобы получить определенные траектории, необходимо дополнить уравнение (6) некоторыми связями между желаемыми траекториями робота. Для сужения поиска желаемых траекторий робота q были добавлены следующие два уравнения связей:

q,+q 2 -q 1-ф = 0 (8)

q 2 -kq 1 = 0, k < 1. (9)

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

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

u¿ = Kpe + K d e, (10)

где K = (Kp1 Kp2 Kp,), Kd = (Kd1 Kd2 Kd,) - пропорциональные и дифференциальные составляющие регулятора соответственно; u¿ = (uL1 uL 2 uL,)T - вектор управляющих сигналов; e = (e1 e2 e,)T - вектор ошибок углов отклонения звеньев, e = q - q; e - вектор производных ошибок углов отклонения звеньев.

На больших скоростях ф к регулятору (10) добавлялись показания гироскопа:

u H = K р e + K d e + K g J 9dt

где K g = (Kg1 Kg 2

K , )T - масштабирующие коэффициенты.

ф

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

В разделе представлены результаты численного моделирования двух предложенных способов стабилизации двуногих роботов. Для объективного сравнения обеих систем управления были заданы одинаковые требования к показателям качества: время переходного процесса tп < 0,2 с и перерегулирование о = 0%. Коэффициенты пропорциональной и дифференциальной составляющих ПД-регулятора выбирались исходя из метода стандартных переходных характеристик. Для обеспечения нулевого перерегулирования в качестве характеристического полинома эталонной модели использовался полином Ньютона второго порядка. Исходя из условия 1п < 0,2 с, для каждой системы были получены Кл = 40, Кр1 = 400, / = 1,3.

Начальные угловые положения звеньев роботов q(0) = (91(0) д2 (0) (0))т выбирались в соответствии с желаемыми траекториями: q(0) = (30° 30° 0° )т для первой модели и q(0) = (45,62° 27,37° 18,25° )т .

На рис. 3, а, б, показаны графики изменения угла наклона и угловой скорости подвижной поверхности. Промежуток времени t е (0; 10) с соответствует высоким угловым скоростям наклонной поверхности, а на участке t е (10; 30) с происходит медленное изменение ее углового положения.

Моделирование способа стабилизации, учитывающего динамику робота, изображено на рис. 4. Рис. 4, а, иллюстрирует траектории q(t) = (^(0, ), 9з(0)Т циркульного робота, а на рис. 3, б, изображены графики ошибок е(/) = (е1 (/), е2 (/), е3 (/))т.

ф(0, ° 40

20

0

-20

-40

-60

ф(0, °/с 30 20 10 0 -10 -20 -30 -40

15 20 25 30 35 /, с 0 5 10 15

а б

Рис. 3. Графики углового положения (а) и скорости (б) наклонной поверхности

35 ^ с

°

60 40 20 0 -20

/\ ;/Д Г > 2 1

/ \1 \ /

\

у \] / \

\1У/ 3

е(0, ° 0,2 0,1 0 -0,1 -0,2

1 2

/....., 3

АЛ

у ^.х / У

к—.д /

.............

0 5 10 15 20 25 30

1 - дх((), 2 - ^(0, 3 - д3(Г)

35 и с

0 5 10 15 20 25 30

1 - е1( ), 2 - е2( ), 3 - е3( ) б

35 , с

9(0, ° 60 40 20 0 -20

Рис. 4. Графики траекторий (а) и ошибок (б) циркульного робота

е(0.

\ 1/ 2

"Л и 3

\"7

0,1 0 -0,1 -0,2

1

2

3

п

К / \'Л \

0 5 10 15 20 25 30 1 - 91(0, 2 - 92(0, 3 - 9э(0

35 t, с

0 5 10 15 20 25 30 35 ^ с

1 - е^), 2 - е2(0, 3 - еэ(0 б

Рис. 5. Графики траекторий (а) и ошибок (б) робота Вю!о1С

а

На рис. 5 аналогичным образом представлены переходные процессы в системе управления, основанной на способе стабилизации с использованием кинематических уравнений и измерений датчиков.

Как следует из графиков моделирования, при больших угловых скоростях подвижной поверхности обе системы управления демонстрируют достаточно высокую скорость сходимости текущих траекторий к желаемым и низкие величины ошибок. При медленном перемещении наклонной поверхности ошибки в каждой системе управления близки к нулю. Поскольку ошибки углов отклонения звеньев для каждого робота лежат приблизительно в одинаковом малом диапазоне et (t) e (-0,250; 0,250), i = 1,3 , то запасы устойчивости обеих систем определяются положением центра масс робота относительно проекции площади его опоры. В свою очередь, центр масс каждой модели и проекция площади опоры зависят от параметров робота и углового положения наклонной поверхности. При заданных параметрах и начальных положениях первая модель имеет больший запас устойчивости, чем второй робот.

При реализации на практике каждый из предложенных способов стабилизации будет обладать своими особенностями. Так, для первого способа стабилизации, использующего линеаризацию обратной связью, требуется точное измерение вектора состояний робота. Все параметры математической модели также должны быть известными. В противном случае при линеаризации в уравнении (4) появятся дополнительные слагаемые ДM(Дq) Д(( и ДС(Д(,Д(), которые могут привести систему в неустойчивое состояние. Поскольку расчет параметров в нелинейном регуляторе (3) должен производиться в режиме реального времени, то первый способ требует более высоких вычислительных мощностей, чем второй.

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

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

Заключение

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

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

Литература

1. Berkemeier M.D., Fearing R.S. Control of a two-link robot to achieve sliding and hopping gaits // Proc. IEEE Int. Conf. on Robotics and Automation. Nice, France, 1992. V. i. P. 2S6-29í.

2. Collins S., Ruina A., Tedrake R., Wisse M. Efficient bipedal robots based on passive-dynamic walkers // Science. 2005. V. 307. N. 5712. P. 10S2-10S5. doi: 10.1126/science.1107799

3. Grizzle W., Abba G., Plestan F. Asymptotically stable walking for biped robots: analysis via systems with impulse effects // IEEE Transactions on Automatic Control. 2001. V. 4б. N 1. P. 51-б4. doi: í0.1109/9.s9s695

4. Westervelt E.R., Grizzle J.W., Chevallereau C., Choi J.H., Morris B. Feedback Control of Dynamic Bipedal Robot Locomotion. Boca Raton-London-New York: CRC Press, 2007. 52S p.

5. Goswami A., Espiau B., Keramane A. Limit cycles in a passive compass gait biped and passivity-mimicking control laws // Autonomous Robots. 1997. V. 4. N 3. P. 273-2S6.

6. Freidovich L.B., Mettin U., Shiriaev A.S., Spong M.W. A passive 2-DOF walker: hunting for gaits using virtual holonomic constraints // IEEE Transactions on Robotics. 2009. V. 25. N 5. P. 1202-1208. doi: 10.1109/TR0.2009.2028757

7. McGeer T. Passive dynamic walking // International Journal of Robotics Research. 1990. V. 9. N 2. P. 6282.

8. Shiriaev A., Perram J.W., Canudas-de-Wit C. Constructive tool for orbital stabilization of underactuated nonlinear systems: virtual constraints approach // IEEE Transactions on Automatic Control. 2005. V. 50. N 8. P. 1164-1176. doi: 10.1109/TAC.2005.852568

9. Shiriaev A., Robertsson A., Perram J., Sandberg A. Periodic motion planning for virtually constrained mechanical system // Proc. 44th IEEE Conference on Decision and Control, and the European Control Conference (CDC-ECC'05). Seville, Spain, 2006. V. 2005. P. 4035-4040. doi: 10.1109/CDC.2005.1582793

10. Eaton M. Evolutionary humanoid robotics: past, present and future // Lecture Notes in Computer Science. 2007. V. 4850 LNAI. P. 42-52.

11. Thai C.N., Paulishen M. Using robotis bioloid systems for instructional robotics // Proc. IEEE Southeast Conference 2011. Nashville, USA, 2011. P. 300-306. doi: 10.1109/SEC0N.2011.5752954

12. Rokbani N., Zaidi A., Alimi A.M. Prototyping a biped robot using an educational robotics kit // Proc. Int. Conf. on Education and e-Learning Innovations (ICEELI 2012). Sousse, Tunisia, 2012. Art. 6360682. doi: 10.1109/ICEELI.2012.6360682

13. Bazylev D., Pyrkin A. Stabilization of biped robot standing on nonstationary plane // Proc. 18th IEEE Int. Conf. on Methods and Models in Automation and Robotics (MMAR 2013). Miedzyzdroje, Poland, 2013. P. 459-463.

14. Bazylev D., Kremlev A., Margun A., Zimenko K. Control system of biped robot balancing on board // Proc. 19th Int. Conf. on Methods and Models in Automation and Robotics (MMAR 2014). Miedzyzdroje, Poland, 2014. P. 794-799. doi: 10.1109/MMAR.2014.6957457

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

15. Spong M.W., Hutchinson S., Vidyasagar M. Robot Modeling and Control. NY: Wiley, 2005. 496 p.

Базылев Дмитрий Николаевич

Пыркин Антон Александрович

Маргун Алексей Анатольевич

Зименко Константин

Александрович

Кремлев Артем Сергеевич

Ибраев Денис Дамирович Чех Мартин

студент, лаборант, Университет ИТМО, Санкт-Петербург, 197101, Российская Федерация, bazylevd@mail.ru

кандидат технических наук, доцент, Университет ИТМО, Санкт-

Петербург, 197101, Российская Федерация, a.pyrkin@gmail.com

студент, лаборант, Университет ИТМО, Санкт-Петербург, 197101,

Российская Федерация, alexeimargun@gmail.ru

студент, инженер, Университет ИТМО, Санкт-Петербург, 197101,

Российская Федерация, kostyazimenko@gmail.com

кандидат технических наук, зам. декана, доцент, Университет

ИТМО, Санкт-Петербург, 197101, Российская Федерация,

kremlev_artem@mail.ru

студент, Университет ИТМО, Санкт-Петербург, 197101, Российская Федерация, ibray1522@gmail.com

кандидат технических наук, научный сотрудник, Университет Западной Богемии, 306 14, Пльзень, Чехия, cechyn@gmail.com

Dmitry N. Bazylev Anton A. Pyrkin Alexei A. Margun Konstantin A. Zimenko Artem S. Kremlev Denis D. Ibraev Martin Cech

student, laboratory assistant, ITMO University, Saint Petersburg, 197101, Russian Federation, bazylevd@mail.ru

PhD, Associate professor, ITMO University, Saint Petersburg, 197101, Russian Federation, a.pyrkin@gmail.com

student, laboratory assistant, ITMO University, Saint Petersburg, 197101, Russian Federation, alexeimargun@gmail.ru student, engineer, ITMO University, Saint Petersburg, 197101, Russian Federation, kostyazimenko@gmail.com

PhD, Deputy Dean, Associate professor, ITMO University, Saint Petersburg, 197101, Russian Federation, kremlev_artem@mail.ru student, ITMO University, Saint Petersburg, 197101, Russian Federation, ibray1522@gmail.com

PhD, researcher, University of West Bohemia, Pilsen, 306 14, Czech Republic, cechyn@gmail.com

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