CC BY
67
Первые публикации
Программы и программные системы
Учебные программы
Студенческая весна
Общие проблемы инженерного образования
Инженер в современной России
Экобионика
Зарубежное образование
История технического прогресса
Будущий инженер
Вне рубрик
Расширеный поиск Подписаться на новости
ПОИСК
Ред.совет Специальности Рецензентам Авторам Архив
электронное научно-техническое издание
НАУКА и ОБРАЗОВАНИЕ
_Эл № ФС 77 - 30569. Государственная регистрация №0420900025. ISSN 1994-0408_
Синтез функций управления ходьбой двуногого шагающего робота при помощи упрощенной математической модели
# 02, февраль 2010
авторы: Семёнов С. E., Ломакин В. О., Кулаков Д. Б., Ковальчук А. К.
УДК 621.391.535.8
Задача синтеза динамически устойчивого движения двуногого шагающего робота чрезвычайно сложна. Насколько можно судить, к настоящему времени в общем виде она не решена. Однако управление динамической ходьбой можно осуществить, используя различные частные подходы. В данной статье представлены принцип и результаты синтеза программных траекторий движения двуногого шагающего робота по ровной горизонтальной поверхности в режиме динамической ходьбы при помощи упрощённой математической модели.
Воспользуемся моделью, представляющей робот состоящим из двух стержневых ног, обладающих массой и моментом инерции, и корпуса в виде точечной массы. Возмущениями, возникающими от движения ног в коленных шарнирах, а также при подъёме стоп при ходьбе, пренебрежём. Кроме того, представление корпуса точечной массой заставляет синтезировать лишь такие движения, при которых моменты инерции корпуса не проявляются, т.е. движения с постоянной ориентацией корпуса. Однако, именно такие движения представляют большой практический интерес. Также будем считать углы отклонения ног от вертикали малыми. Это позволит использовать линейные дифференциальные уравнения.
Рассматриваемая кинематическая схема представлена на рис. 1.
Примем следующие обозначения:
т1, т2 - массы опорной и переносимой ног,
Jl, J2 - моменты инерции опорной и переносимой ног относительно их центров масс (примем их равными, как в сагиттальной, так и фронтальной плоскостях),
M- масса корпуса,
xk , y/- горизонтальные координаты корпуса,
xc, yc - горизонтальные координаты переносимой стопы.
Рис. 1. Принятая в данной модели кинематическая схема робота
Движения в сагиттальной и фронтальной плоскостях будем рассматривать независимо (благодаря отсутствию проскальзывания между опорной стопой и опорной поверхностью). В качестве обобщённых координат выберем горизонтальные координаты корпуса и переносимой стопы. Уравнения движения запишем, используя уравнение Лагранжа второго рода. Примем, что опорная точка находится в начале координат. Уравнения плоского движения двухзвенного механизма с одной опорной точкой при принятых допущениях и ограничениях примут вид:
система уравнений движения вдоль х
(_ А^ п+ Ъс2 хс = +
СОБЫТИЯ
Восьмая открытая всероссийская конференция "Преподавание ИТ в России 2010"
17-я Всероссийская межвузовская научно-техническая конференция студентов и аспирантов "Микроэлектроника и информатика - 2010"
НОВОСТНАЯ ЛЕНТА
4.03.2010
II Всероссийская научно-практическая Интернет-конференция "Педагогические и технические аспекты применения технологий дистанционного обучения в учебном процессе вуза и
6.02.2010
Студенческий командный чемпионат мира по программированию; российские университеты подтвердили лидерство отечественной школы программирования
27.01.2010
Конкурс работ на соискание премий Правительства Российской Федерации 2010 года в области науки и техники
25.01.2010 Программа Десятой международной научно-практической конференции "Новые информационные технологии в образовании
13.01.2010 Ректор МГТУ им. Н.Э. Баумана Игорь Федоров; Ищем тех, кто в детстве не наигрался в машинки
вдоль оси y
школы
Логин
ВХОД
регистрация забыли пароль?
Пресс-релизы
Библиотека
Конференции
Выставки
Доска объявлений
Архив
Ассоциация технических Университетов Информация о проекте
Авторы
Координационный совет
«2 = во =
В этих выражениях
К-1
л _ ЪлаУ1 А; ^оДн _я1гАг
Решение системы запишем в следующем виде:
хс = Съв" + С^г^ + с^ 5П+ С+1 сов Л^
= С^ов** + С^ов** + Л^+ С+Г&нкЛ,
а = — «/„
& = -
Скорости стопы и корпуса
Для начальных условий
¡.=дг '-»О ' '"и)"
Если координаты опорной точки (хот, Уот)Т, а начальные условия заданы для момента времени ф, то
где
- с,^™ + с^е *™ + я* Л,(/- /0) + C4I +
„■"iP-W
At»-«
+c,
+ CiJb^^it-t0) + C4lb€os^(t-t0) + x0T, С^ skt ^(i - + C4jr rasljfi- f0) + Увг, yt -С,,«'1™ +QJA!iils(i-i0)+C+r6cOSjl(/-i0) + jior.
Рассмотрим симметричный относительно критической точки (корпус над опорной стопой, обе ноги вертикальны) шаг, при помощи которого реализуется ходьба с постоянной средней скоростью. В этом случае стопа и корпус проходят критическую точку одновременно. Положим, также, в начальный момент времени t=0. Зададимся средней скоростью движения иср, и коэффициентом двухопорности K.
Найдём такие начальные скорости vo , vc0 и время движения T, чтобы к концу одноопорной фазы при заданной средней
скорости выполнялось соотношение ,
а скорость движения переносимой стопы равнялась нулю vci=0. Для этого необходимо решить следующую систему уравнений:
= <\ав*л +С3евг^Л -C^bski tC^cns^ - v^Ty =0
/з -Cy/Lye^ -+ Cjl, cos^Y; -С4Л3 sn = О
f^C^K-arf* I СЪ(К Ь)ski I С4(К Ь)cosЗД = О
Для того, чтобы решать её численно методом Ньютона необходимы следующие частные производные:
Спустя время Т1 от критического начинается двухопорная фаза движения. В двухопорной фазе переносимая стопа неподвижна. Пусть опорная точка находится в начале координат. Соответствующие уравнения движения корпуса имеют вид:
at2x*=at0xt I <it0rt.
Коэффициенты этого уравнения вычисляются по прежним формулам. Однородное уравнение движения корпуса вдоль оси химеет вид:
Его характеристическое уравнение имеет два корня ^ и Ч2,
Если в начальный момент времени t=to, а координаты опорной точки (хот,уот), уравнения движения корпуса вдоль оси х в двухопорной фазе запишем в виде:
Продолжительность двухопорной фазы Т2 (время, за которое корпус переходит из положения х^х в положение Хк2 = Хс1/2)
Пусть сагиттальная плоскость ориентирована вдоль оси х, фронтальная, соответственно вдоль оси у. Тогда приведенные уравнения движения вдоль оси х позволяют синтезировать движение в сагиттальной плоскости, рассчитать длительность (от критического положения) Тх одноопорной фазы и Т2 двухопорной фазы (до момента смены опорной ноги). Общая длительность полушага Тп равна их сумме
=г1+т3
Если ширина следовой дорожки постоянна, можно принять, что движение переносимой стопы вдоль оси хсовершается в вертикальной плоскости, параллельной оси х. Таким образом, на протяжении всего шага координата у переносимой стопы остаётся неизменной, и для синтеза движения робота вдоль у на протяжении всего Тп можно использовать уравнения, полученные для двухопорной фазы.
Для обеспечения периодического движения с постоянной скоростью вдоль х необходимо, чтобы в начале шага скорость корпуса вдоль убыла такой, чтобы за время Тп корпус достигал критического положения (максимальное отклонение по у, при нулевой скорости вдоль у). Тогда, благодаря симметрии принятого движения в конце шага, корпус снова окажется в среднем положении и с той же скоростью, но направленной в другую сторону. Для расчёта необходимой начальной (из среднего положения) скорости вдоль у примем, что в начальный момент времени t=0 корпус находится в критическом положении, а у отсчитывается от опорной стопы (рис. 2).
Положение корпуса по у в критической точке
У, О
В(1КС +1) ечГ* + с_лЛ
ксв
Скорость, спустя время Тп
где
где
Рис. 2. Критическое положение корпуса во фронтальной плоскости
Знак, вычисленной таким образом начальной скорости, принимается в зависимости от того, какая нога опорная. Скорость должна быть направлена к опорной стопе.
Полученные выше соотношения позволяют сформировать управление на основном шаге, а также сформулировать задачу на стартовом шаге. На стартовом шаге из состояния покоя, когда корпус находится над опорной стопой, необходимо начать движение и сформировать
его таким образом, чтобы к концу одноопорной фазы стартового шага (в момент времени Тс) опорная стопа достигла положения хсс=хс2=хс1 с нулевой скоростью (исс=0), а корпус пришел в положение хкс=хк1 со скоростью укс= Ук1.
Управление движением на стартовом шаге реализуем, выбирая подходящую зависимость координаты переносимой стопы от времени (рис. 3). Сначала запишем уравнение движения корпуса, если движение стопы - известная функция времени. Для этого используем первое уравнение из системы, полученной для свободного движения робота в одноопорной фазе
и13 Х1+ ас 2 х. = ИиЛг + а^
в котором коэффициенты имеют прежние значения. Соответствующее однородное уравнение имеет вид
дп а^ О
Рис. 3. Зависимость у(Ц на стартовом шаге
Его характеристическое уравнение имеет два корня. Обозначим их 12 и -12. Здесь, как и прежде
Зависимость движения переносимой стопы от времени назначим в следующем виде:
В процессе движения реального робота это движение будет обеспечиваться приводами в следящем по положению режиме. Граничные условия:
Для обеспечения требуемых параметров движения в конце стартового шага будем варьировать Тс и С2, а Сц и С3 определим из граничных условий
Введем параметр
и запишем уравнения движения корпуса в следующем виде:
Далее для формирования управления роботом необходимо найти такие Кн и Тс , чтобы выполнялись условия XI (Тс) - хп
Для численного решения этой задачи используем следующие зависимости:
Х„„_ _ К. _ + ____ К.
2 - в
Для расчёта положения и скорости корпуса в реальном времени удобно использовать следующие выражения
в которых постоянные на шаге коэффициенты равны
где
где
К концу стартового шага (к моменту времени Тс+Т2) необходимо, чтобы во фронтальной плоскости корпус развил скорость У кп. Один из возможных вариантов достичь этого следующий. Разгон до необходимой скорости производится от положения У0 относительно опорной стопы ровно по тому же закону, что и на основном шаге. В исходном положении робот стоит на двух ногах, корпус робота расположен посередине. Из этого положения корпус должен достичь положения уо с нулевой скоростью, причем время, не меньшее Тс-Т1, он должен двигаться, опираясь на ногу, которая является опорной в фазе разгона в сагиттальной плоскости. Значит время <торм, большее, чем Тс-Т1 он должен тормозить по обратному закону, а отрезок времени ty-2■■■ty-l - разгоняться на другой ноге из исходного положения. Таким образом, необходимо отыскать положение корпуса, при котором необходимо сменить опорную ногу, и соответствующий момент времени ty-l. Для этого воспользуемся свойством непрерывности скорости.
Определим зависимость скорости от коррдинаты при следующих условиях:
- начальная скорость корпуса равна нулю,
- координата корпуса отн. опорной точки равна У0,
- на всем интервале скорость переносимой стопы равна нулю ,
- расстояние от переносимой стопы до опорной точки равно В. Тогда
Подставив в полученное соотношение в качестве начального условия У0 и В/2, получим два варианта его правой части, приравняв которые, получим уравнение. Его решение и есть искомая точка переключения уп, измеренная относительно опорной стопы. Решать это уравнение будем численно. Зная уп, по следующей формуле найдем момент времени, в который надо производить переключение
1 + + + - В/2) - В7 / 4
ВП + КГВ
(время отсчитано от момента ty-2).
Полученные выше соотношения, приближённо описывают один из множества возможных способов движения ДШР в режиме динамической ходьбы. Получены они, исходя из условия нулевых шарнирных моментов, что обеспечивает минимизацию мощности, расходуемой на движение реального робота. Однако, их не целесообразно использовать при больших углах отклонения ног от вертикали (по оценкам авторов - не более 200). Данные соотношения не могут быть использованы для управления роботом непосредственно, так как не учитывают множества факторов (например, удары, вертикальные движения стоп, изгиб ног в коленях). Однако, они могут быть использованы в качестве "отправной точки" для синтеза реальных реализуемых роботом законов управления, что было с успехом проделано авторами применительно к лабораторному образцу ДШР, разрабатываемому на каф. Э-10 совместно с МиПк МГТУ им. Н.Э.Баумана (Рис.4). Исполнительный механизм робота имеет 12 управляемых степеней подвижности, электрогидравлический следящий привод, рост 2,2 м и массу 200 кг. Приведённые в программном обеспечении системы управления роботом зависимости, аппроксимируются достаточно простыми функциями с малым числом параметров - отрезками прямых и синусоид. Затем,
полученные кривые, оптимизируются по небольшому числу параметров, с
Рис. 4. Лабораторный ДШР; вид спереди и сзади
целью минимизации динамических возмущений, возникающих в процессе ходьбы. Далее спроектированное таким способом движение отрабатывается реальным многостепенным исполнительным механизмом робота и реализуется его динамическая ходьба по ровной горизонтальной поверхности.
Список литературы
1. Белецкий В.В. Двуногая ходьба. М.: Наука, 1984. 287 с.
2. Вукобратович М. Шагающие роботы и антропоморфные механизмы. М.: Мир, 1976. 541 с.
3. Ковальчук А.К., Семёнов С.Е. Кинематический алгоритм управления движением двуногого шагающего робота // Вестник МГТУ им. Н.Э.Баумана. Приборостроение. М.: Изд-во МГТУ им. Н.Э.Баумана, 1996. № 1. С.57-69.
4. Ковальчук А.К., Кулаков Д.Б., Семёнов С.Е.. Принципы построения программного обеспечения системы управления антропоморфным шагающим роботом // Автоматизация и современные технологии. М.: Машиностроение, 2007. № 2.
5. Ковальчук А. К., Кулаков Д. Б., Семёнов С.Е., Горина Г.Ю. История и развитие антропоморфных шагающих роботов - как нового класса робототехнических средств для экстремальных условий // Наука и образование: электронное научно-техническое издание. М., 2006. № 12.
6. Ковальчук А.К., Кулаков Д.Б., Семёнов С.Е. Математическое описание кинематики и динамики исполнительных механизмов роботов с древовидной кинематической структурой // Известия вузов. Машиностроение. М., 2008. № 11. С.13-25.
7. Ковальчук А.К., Кулаков Д.Б., Семёнов С.Е. Блочно-матричные уравнения движения исполнительных механизмов роботов с древовидной кинематической структурой // Известия вузов. Машиностроение. М., 2008. № 12. С.5-21.
Публикации с ключевыми словами: шагающий робот, автономный электрогидравлический следящий привод Публикации со словами: шагающий робот, автономный электрогидравлический следящий привод Смотри так же:
• Концепция построения системы электрогидравлических следящих приводов двуногого шагающего робота
• Многокритериальная оптимизация автономного электрогидравлического следящего привода прямым адаптивным методом
Тематические рубрики:
. Наука в образовании: Электронное научное издание
Ассоциация технических Университетов Вузы
Информационное агентство
Координационный совет Новости УМО Вузов
[email protected] т^фпн (ялчч) 263-68-67 Q RSS Q STOCK GROUP
© 2003-2010 «Наука и образование: электронное научно-техническое издание»
