CC BY
11Нелинейная динамика. 2012. Т. 8. № 2. С. 289-307. Полнотекстовая версия в свободном доступе http://nd.ics.org.ru
УДК: 532.5
М8С 2010: 37^0 37^5 70Е18 70Е25 70Н45
Как управлять шаром Чаплыгина при помощи роторов
А. В. Борисов, А. А. Килин, И. С. Мамаев
В работе исследуется управление при помощи трех гиростатов движением динамически несимметричного уравновешенного шара на плоскости, при условии, что шар катится без проскальзывания в точке контакта. Показана полная алгебраическая управляемость данной системы, указаны законы управления, обеспечивающие движение вдоль заданной траектории на плоскости и задающие необходимую ориентацию системы; приведены явные законы управления, осуществляющие простейшие движения рассматриваемой системы.
Ключевые слова: неголономная связь, неголономное распределение, управление, теорема Рашевского - Чжоу, дрейф
Получено 10 марта 2012 года После доработки 2 июня 2012 года
Работа выполнена в ФГБОУ ВПО «УдГУ» при поддержке гранта Правительства РФ для государственной поддержки научных исследований, проводимых под руководством ведущих ученых в российских образовательных учреждениях ВПО (дог. №11.034.31.0039), ФЦП «Развитие научного потенциала высшей школы» (2012-2014 гг., 1.1248.2011 «Неголономные динамические системы и проблемы управления») и ФЦП «Научные и научно-педагогические кадры инновационной России» (2009-2013 гг. «Научно-образовательный центр “Регулярная и хаотическая динамика”» ГК №02.740.11.0195). Работа А. А. Килина поддержана грантом президента РФ поддержки молодых кандидатов наук МК-8428.2010.1.
Борисов Алексей Владимирович [email protected]
Килин Александр Александрович [email protected]
Мамаев Иван Сергеевич [email protected]
Институт компьютерных исследований Удмуртский государственный университет 426034, Россия, г. Ижевск, ул. Университетская, д. 1
Содержание
1. Введение
290
2. Уравнения движения и первые интегралы .
3. Полная управляемость на нулевом моменте
292
295
4. Явное управление вдоль траектории
298
4.1. Геометрические и динамические свойства качения на нулевом моменте . . . 298
4.2. Качение шара вдоль заданной траектории
301
5. Примеры
303
303
304
5.1. Качение по дуге окружности
5.2. Качение по синусоиде (слалом)
1. Введение
В работе изучено управление при помощи гироскопов движением динамически несимметричного уравновешенного шара по плоскости в предположении, что скорость точки контакта обращается в ноль (то есть проскальзывание отсутствует). Как известно, в таких случаях мы имеем дело с системой с неинтегрируемыми (неголономными) связями. В работах последних десятилетий динамический анализ таких систем и вопросы их управления представляют собой предмет активного исследования (например, см. статьи [5, 17, 18] и библиографию к ним, работы по так называемым неголономным манипуляторам [20, 22]). В настоящее время разного рода управление движением шара, движущегося по плоскости или другим поверхностям, подробно рассматривается в различных работах в связи с созданием различных систем передвижения, использующих шаровую форму мобильного робота, имеющего ряд преимуществ по сравнению с обычными колесными экипажами. Использование сферической оболочки для передвигающихся устройств восходит еще ко второй половине XIX века, интерес к такой конструкции особенно возрос в конце XX века в связи с развитием электроники и мобильной робототехники, инициированном, в частности, космическими исследованиями и созданием средств передвижения не только на Земле, но и на других планетах [50]. Исторический обзор можно найти, например, в работах [15, 23, 48].
Существуют различные инженерные решения для управления движением шарового робота. Как правило, в литературе встречаются три основные схемы. Первая, наиболее распространенная схема, это управление за счет перемещения центра масс внутри шара, для этого перемещения могут быть использованы различные варианты, такие как система маятникового типа, слайдеры, полозья, по которым движется масса, различные тележки, катающиеся внутри шара [3, 14, 15, 19, 33, 37, 44, 49, 51]. Вторая схема — это управление при помощи нескольких роторов за счет создания переменного гиростатического момента, то есть для управления шаром используется гиростатический эффект [28, 29]. Третья схема управления, также получившая распространение в последнее время, реализуется за счет деформации формы шара [47].
В данной работе рассматривается динамически несимметричный шар, внутри которого расположены три уравновешенных ротора, так что центр масс всей конструкции совпадает с геометрическим центром шара. Такой выбор не случаен, он обусловлен тем, что при нулевой угловой скорости вращения роторов эта задача совпадает с интегрируемой задачей, поставленной и проинтегрированной С. А. Чаплыгиным (1903 г.) [11], кроме того
Чаплыгин указал некоторые геометрические свойства траекторий шара. С современными исследованиями, посвященными шару Чаплыгина можно ознакомиться по работе [31], где проведен бифуркационный и компьютерный анализ системы и построены некоторые траектории точки контакта. Когда вращение роторов происходит уже с ненулевыми скоростями, то эта задача в простейшем случае, когда тело является осесимметричным, а гиростатиче-ский момент роторов направлен вдоль оси динамической симметрии, достаточно подробно также была исследована Бобылевым [1] и Жуковским [6].
Интегрируемость задачи о качении динамического несимметричного шара с произвольным трехмерным вектором постоянного гиростатического момента была показана А. П. Мар-кеевым в 1986 году [7]. Компьютерный анализ движения точки контакта был частично проведен в [31], топологический анализ устойчивости различных частных движений шара выполнен в [9], где использована развитая в [2] теория анализа интегрируемых систем, основанная на введенном авторами понятии бифуркационного комплекса. При том, что результат [7], к сожалению, не особенно известен в среде специалистов по робототехнике, следует отметить, что интегрируемость общей задачи о движении шара Чаплыгина с гиростатом и связанное с этим существование трехмерного вектора обобщенного кинетического момента, постоянного в неподвижной системе координат, с теоретической точки зрения дает дополнительные преимущества при использовании роторов в целях управления. В частности, с помощью редукции на общую поверхность уровня данных интегралов обобщенного кинетического момента дифференциальные уравнения системы с управлением сводятся к уравнениям первого порядка, что позволяет явно построить алгоритм управления. Более того управление выражается алгебраически через заданную траекторию точки контакта и это с точки зрения теоретической простоты позволяет надеяться, что по крайне мере для данной системы многие проблемы управления могут быть разрешены полностью. В данной работе мы достаточно подробно изучаем одну из возможных задач, связанную с управлением шаром «на нулевом моменте», так что при этом в системе с управлением отсутствует дрейф, а движение шара начинается из состояния покоя, для этого случая мы также приводим явно закон управления для ряда характерных траекторий шара. Достаточно очевидные обобщения этой задачи, требующие изучения, связаны с анализом управления системой при ненулевом начальном толчке, исследованием движения по более сложным поверхностям, например, по наклонной плоскости. Кроме того, имеется множество других проблем, которые также систематически рассматриваются в теории управления — планирование траектории, оптимальное управление, стабилизация движения, исследование обратной связи. Мы предполагаем заняться ими в следующих публикациях.
В заключение мы упомянем некоторые публикации, посвященные различным направлениям исследования данной проблемы. Прежде всего укажем на основные работы [13, 36, 38, 41], в которых рассматриваются различные вопросы управления неголономными системами (то есть, полагается соответствующая неголономная связь). Имеется также значительное количество теоретических работ, рассматривающих достаточно абстрактные задачи теории управления (с применением современной геометрической динамики, редукции и субримано-вой геометрии, см., например, [30, 45, 46]); такие исследования, как правило, малоинтересны с точки зрения приложений и непонятны инженерам-механикам. С другой стороны, можно отметить чисто инженерные работы [28, 29], в которых используются не только неудобные, но и некорректные уравнения движения (если таковые вообще рассматриваются) [28, 29]. Интересны работы [39, 40], в которых обозначаются различные стратегии управления и планирования траекторий движения шара. В этой работе мы старались держаться «золотой середины». С одной стороны, она представляет интерес с точки зрения классической ме-
ханики и теории управления (то есть, когда рассматривается конкретная система с явным решением задачи управления). С другой стороны, по своему изложению и используемой форме уравнений движения данная работа может быть использована инженерами в качестве некой теоретической базы при дальнейших исследованиях, которые и превращают модель катящегося шара в сложную робототехническую систему с различной спецификой (вопросы стабилизации, обратные связи, использование различных датчиков и другие проблемы, вплоть до искусственного интеллекта).
Заметим, что рассматриваемая в упомянутых выше работах (и в данной статье) «классическая» модель качения не является вполне корректной, поскольку в реальной системе в области контакта действуют силы трения, которыми мы в первом приближении пренебрегаем. Это приводит к тому, что система с течением времени отклоняется от «базовой» траектории, проложенной в рамках «классической» неголономной модели. Для обнаружения этого эффекта и корректировки движения, как правило, используются установленные на шаре различные датчики, реализующие обратную связь. Отметим, что преимущество неголономной модели качения по сравнению с более сложными моделями, учитывающими трение, заключается в том, что она позволяет получить закон управления в явном виде.
Помимо «классической» модели в теории управления достаточно широкое применение получила другая неголономная модель качения, в которой предполагается, что в точке контакта отсутствует не только проскальзывание, но и верчение/прокручивание (то есть проекция угловой скорости тела на нормаль к опоре равна нулю) [12, 23, 27, 38]. Любопытно, что в теории управления и робототехнике эта модель качения используется достаточно давно, в то время как среди специалистов по динамике неголономных систем она стала применяться лишь недавно [4, 32]. В работе [32] предложены краткие образные названия для этих моделей качения: marble-rolling — для «классической» и rubber-rolling — для качения без верчения. Отметим, что в отличие от классической модели [4] в случае качения без верчения динамика системы изучена очень слабо и требует дальнейших исследований. Кроме того, в будущем интересно изучить не только неголономные модели, но и модели с трением, как с теоретической, так и с экспериментальной точки зрения.
Авторы статьи благодарят А. В. Болсинова за внимание к работе и ценные обсуждения.
Статья посвящается профессору А. П. Маркееву по случаю его семидесятилетия.
2. Уравнения движения и первые интегралы
Рассмотрим систему, состоящую из шара, катящегося по плоскости без проскальзывания, и установленных в нем трех роторов (см. рис. 1). При этом будем полагать, что конструкция системы удовлетворяет ряду ограничений:
- центр масс всей системы шар + роторы находится в геометрическом центре шара;
- все роторы одинаковы, осесимметричны и оси вращения совпадают с их осями симметрии, то есть их вращение не меняет распределение масс системы;
- оси вращения роторов некомпланарны, а их угловые скорости являются заданными функциями времени Uk(t), к = 1, 2, 3.
Выберем подвижную систему координат Ов\ в2 ез, жестко связанную с главными осями инерции системы шар + роторы (см. рис. 1). Обозначим через V и П скорость центра шара и его угловую скорость, где здесь и далее (если не оговорено обратное) все векторы проецируются на подвижные оси, тогда уравнение связи, задающее условие непроскальзывания,
можно записать в виде
f = V + П х г = 0, (2.1)
где г = —К7 — радиус-вектор из центра шара в точку контакта, К — радиус шара, а 7 — единичный вектор нормали к плоскости (см. рис. 1).
Определим дополнительно неподвижную систему координат О'хуг, так что ось О'г перпендикулярна опорной плоскости, и обозначим гц = (х,у) — координаты точки контакта С в этих осях. Обозначим также через а, в, 7 орты неподвижных осей О'хуг, спроецированные на подвижные оси в\, Є2, Є3, тогда ортогональная матрица
(«і ві 7і\
д
Є БО(3) (2.2)
а2 Р2 72 \ аз вз 7э)
характеризует ориентацию тела, а пара (гц, Я) однозначно определяет конфигурацию системы. Таким образом, конфигурационное пространство системы пятимерно и представляет собой произведение М2 х БО(3), и уравнение (2.1) задает в нем трехмерное неголо-номное распределение.
Уравнения движения рассматриваемой системы со связями (2.1) можно записать в виде уравнений Феррерса в квазискоростях (уравнения Пуанкаре — Суслова — Козлова — Фёдорова) с неопределенными множителями
9Т\ + 0* дТ - V А 91к (9Т^ + П«дТ-^Х 91к (2Ъ
ду)+Пх дУ -^ХкдУ' \дп)+ ( 3)
7 к=1 4 7 к=1
где Хк — неопределенные множители, а Т — кинетическая энергия системы шар + роторы.
Обозначим через т, I = diag(/l, /2,1з) массу и тензор инерции системы шар + роторы, г — моменты инерции роторов относительно осей вращения, щ, к = 1, 2, 3, — единичные векторы, задающие направление осей вращения роторов. В подвижной системе координат, связанной с шаром, векторы щ являются постоянными. Кинетическая энергия системы складывается из кинетической энергии оболочки
т0 = -то V2 + —(гг, і0гг)
22
и кинетической энергии роторов
Тк = ^т,к V2 + ^ (Гі + сокпк, 1к(П + сокпк)), к = 1,2,3,
где mo, mk, Io, Ik — масса и тензоры инерции относительно осей Oe\e2оболочки и роторов соответственно. Пользуясь тем, что оси роторов задаются собственными векторами их тензоров инерции, то есть Ik nk = ink, после приведения подобных получим:
T = T0 + J2Tk = \т V2 + -2(П, Ш) + (П, K(t)) + ± £ iutit), (2.4)
k k
где K (t) = ^ iuk (t)nk — вектор гиростатического момента. k
Из уравнения связей (2.1) и уравнений движения (2.3) находим неопределенные множители в виде
А = mr х Й, (2.5)
где А = (Ai, A2, A3). Подставив их в уравнения (2.3), получим
(1Й + K)' + mr х (Й х r) = (1Й х K) х Й. (2.6)
Эволюция переменных (Г||, Q) описывается уравнениями Пуассона и кинематическими соотношениями (вытекающими из условия непроскальзывания) следующего вида:
а = ах Й, в = в х Й, 7 = Y х й,
(2.7)
x = Е(в, й), y = -R(a, Й).
Уравнения (2.6) и (2.7) образуют полную систему уравнений, описывающую движение шара с роторами по плоскости.
Вследствие условия ортогональности, уравнения движения допускают геометрические интегралы движения:
а2 = в2 = 72 = 1, (а, в) = (a, 7) = (в, 1) = 0. (2.8)
Определим вектор момента системы относительно точки контакта
M = 1Й + Dy х (Й х 7) + K(t). (2.9)
Можно показать, что его эволюция описывается уравнением
M = M х Й,
следовательно, M — постоянный вектор в неподвижных осях, а его проекции на оси O'xyz являются интегралами движения:
Ma = (M, а) = const, Me = (M, f3) = const, MY = (M, 7) = const. (2.10)
Замечание. Если скорости роторов постоянны, то сохраняется также энергия системы
Е=±(М,П),
и система является интегрируемой [7]. В общем случае (когда ш зависит от t) этот интеграл пропадает.
3. Полная управляемость на нулевом моменте
Рассмотрим вопрос об управлении движением шара по плоскости при помощи изменения вектора гиростатического момента К (і). Для этого ограничим систему на уровень первых интегралов (2.10) и представим уравнения движения в форме, стандартной в теории управления. Обращая уравнение (2.9) относительно П, получим
Таким образом, наличие интегралов момента (2.10) позволяет перейти от уравнений на фазовом пространстве к системе уравнений на конфигурационном пространстве, что существенно облегчает решение задач управления.
Замечание. Более строго необходимо рассматривать управление при помощи задания электрических напряжений и^(Ь), к =1, 2, 3, на каждом из электродвигателей, приводящих в движение роторы. В то же время, на практике, как правило, достаточно использовать линейную аппроксимацию для момента, развиваемого электродвигателем [8], что приводит к уравнениям
где су Шк — момент противоэлектродвижущей силы, а коэффициенты си, су могут быть выражены через характеристики двигателя [8]. Кроме того, угловые скорости Шк(і) связаны с вектором гиростатического момента соотношением (2.9), следовательно, напряжения по заданному закону управления К(і) могут быть найдены посредством соотношения
где N = \\nki У — матрица, составленная из компонент векторов п^. Здесь мы предполагаем, что все электродвигатели одинаковые.
При Пс = 0 (то есть при П = По) получим задачу о движении свободного шара Чаплыгина, подробно изученную во многих работах, см. работу [31], в которой приведена достаточно подробная библиография. В теории управления эти слагаемые, содержащие только По, называются дрейфом. Всюду далее в этой работе мы ограничимся случаем, когда дрейф отсутствует, то есть По = 0; это эвивалентно тому, что значения всех интегралов (2.10) выбираются нулевыми
Кроме того, мы ограничим наше рассмотрение лишь следующей проблемой.
Пусть в начальный момент времени шар покоится, и угловые скорости роторов равны нулю. Требуется подобрать такое управление роторами К(Ь), (3 2)
Ь € [0,Т], Т < ж, чтобы шар в момент времени Т остановился в заданной точке с некоторой заданной ориентацией.
В этом разделе мы ограничимся доказательством принципиальной возможности управления данной системой, опираясь на теорему Рашевского - Чжоу, которую мы приведем здесь в формулировке Рашевского [10]:
а = а х (П0 + Пс), в = в х (П0 + Пс), -у = 7 х (П0 + Пс),
X = К(в, П0 + Пс), у = —К(а, П0 + Пс), П0 = Б(Ма а + Ырв + М17), Пс = —БК (і),
Б = А + (Б-1 — (7, А7))-1(А7) ® (А7), А = (I + БЕ)-1.
(3.1)
и (і) = 1 (к(і) + , и (і) = («і(#),«2(#),«з(#)),
Ма = Мв = М1 = 0.
Теорема 4. Если среди векторных полей Xi,..., Xm и среди составленных из них последовательными применениями скобки Ли полей можно указать n векторных полей Yi,..., Yn, линейно независимых в любой точке области G, где dimG = n, то из любой точки области G можно прийти в любую другую, смещаясь конечное число раз по траекториям полей Xi,..., Xm.
Заметим, что если перейти к новым векторным полям при помощи линейного преобразования
m
Xk ^ ' Skk'(z) Xk', k 1 ,...,Ш,
k'=i
где S — m x m-матрица, невырожденная в каждой точке z £ G, то теорема о полной управляемости останется справедливой и для полей Xi,..., Xm.
Действительно, вычисляя парные коммутаторы, находим
[X Xfc] = £ 5V skk, [%, xm, ] + (Sw X,; (Skw) - Skv X (Sk)) ) Xh,.
c',k' k' V l' J
Из этого соотношения следует, что линейные оболочки полей и их парных коммутаторов совпадают для обеих систем векторных полей. Здесь мы использовали невырожденность тензорного произведения S <g) S: для квадратных n x n-матриц A, B известна формула det(A ® B) = (det A)"(det B)". Это рассуждение естественным образом обобщается и на коммутаторы более высоких порядков.
Хотя уравнения (3.1) имеют наиболее простую алгебраическую форму, при использовании данной теоремы удобнее перейти к локальным переменным на конфигурационном пространстве M = R2 x SO(3). Для параметризации ортогональной матрицы (2.2) выберем углы Эйлера так, что
Q
cos ф cos ф — cos в sin ф sin ф cos ф sin ф + cos в cos ф sin ф sin ф sin в
— sin ф cos ф — cos в sin ф cos ф — sin ф sin ф + cos в cos ф cos ф cos ф sin в sin в sin ф — sin в cos ф cos в
(3.3)
Обозначим точку конфигурационного пространства М через £ = (9, ф, ф, х, у) и запишем уравнения (3.1) в локальных переменных
3
Ll(z) =
1=1 k=l
Qr = - SK.
z = ]T Ki (t)Xi(z) = — ^ QrkXk (z)
Следовательно, для полей получим представление через компоненты матрицы Б(7) = \\SikW следующего вида:
3
Хг = £ SlкXк, к=1
где
sin ф
cos ю — ctg в sin ю ---
sin в
R(cos ф cos ф + cos в sin ф cos ф), —R(cos ф cos ф — cos в sin ф sin ф) cos ф
— sin ш, — ctg в cos ш,----,
sin в
— R(sin ф cos ф — cos в cos ф cos ф), R(sin ф cos ф + cos в cos ф sin ф)
X3 = (0,1,0, —R sin в cos ф, —R sin в sin ф).
Как мы видим, поля Xk(z) имеют существенно более простую форму, и для них применить теорему Рашевского - Чжоу не составляет труда. Действительно, вычисляя коммутаторы, находим
Yi = [Xi, X3] + X2 =
= (0,0,0, R(sin ф sin ф — cos в cos ф cos ф), — R(sin ф cos ф + cos в cos ф sin ф)),
Y2 = (X2, X3] — Xi =
= (0,0,0, R(cos ф sin ф + cos в sin ф cos ф), — R(cos ф cos ф — cos в sin ф sin ф)).
Можно показать, что все векторные поля Xi, X2, X3, Yi, Y2 независимы, следовательно. справедливо
Предложение 1. Шар Чаплыгина с тремя независимыми роторами, оси вращения которых некомпланарны, при нулевом моменте относительно точки контакта является вполне управляемой системой относительно переменных z.
Согласно теореме Рашевского - Чжоу, путь из начальной точки zo в конечную zi может быть реализован из отрезков траекторий векторных полей Xi, X2, X3. В современной литературе такое управление часто называют управлением при помощи гейтов [35, 42].
Замечание. При наличии трех управляющих роторов линейная оболочка векторных полей Xi, X2, X3 (соответствующих управлениям) в каждой точке M совпадает со всем неголономным распределением, заданным связью (2.1).
В случае когда имеется не три, а лишь два управляющих ротора, вектор гиростатиче-ского момента задается соотношением
K = wini + iu2n2,
где ni и П2 не параллельны.
Из этого следует, что не все компоненты вектора K являются независимыми, а уравнения на группе (3.1) могут быть представлены в форме
z ''У ] KiXi = UiX[ + U2X2,
Xi = niiXi + ni2X2 + ni3X3, X^ = n2i Xi + n22X2 + n23 X3,
где nki — компоненты векторов nk, к = 1, 2. Тем не менее, непосредственным вычислением можно показать, что линейная оболочка полей X{, X2, [X{, X^] совпадает с линейной оболочкой полей Xi, X2, X3, и, следовательно, теорема Рашевского - Чжоу остается справедливой и для этого случая.
Предложение 2. Шар Чаплыгина с двумя независимыми роторами, оси которых не параллельны на нулевом уровне момента относительно точки контакта, является вполне управляемой системой.
Если момент (2.10) не равен нулю, то в уравнениях (3.1) появляется ненулевой дрейф (По = 0), причем в этом случае при Пс = 0 (то есть в случае чистого дрейфа) система (3.1) описывает интегрируемую задачу о качении свободного шара Чаплыгина. Для систем с дрейфом в работе [16] (см. также [24]) доказывается теорема об управлении, в которой помимо полноты линейной оболочки векторных полей и их коммутаторов требуется, чтобы для чистого дрейфа в фазовом пространстве системы существовало всюду плотное множество точек, устойчивых по Пуассону (для краткости говорят об устойчивости дрейфа по Пуассону). С другой стороны, существующие исследования динамики шара Чаплыгина [11, 25, 31] позволяют высказать гипотезу, что почти все траектории точки контакта в этой системе некомпактны. Очевидно, этот вопрос требует дополнительного изучения.
Замечание. Напомним, что точка го системы і = V(г) называется устойчивой по Пуассону, если для траектории 2(і), выходящей из го (то есть 2(0) = го), найдутся последовательности і+ ^ ^ +ю, Ь- ^ —ю, такие, что
Ііт г(і+) = Ііт г(і-) = го.
к—к—
Замечание. Для полноты приведем также теорему об управляемости в формулировке Чжоу
[21] в современных обозначениях.
Теорема 5. Пусть на многообразии М (Шт М = п) задана система векторных полей Вг = [Х\,..., Хг}, и ее полное расширение В3 состоит из Хк и полей, составленных последовательным применением к ним скобки Ли, тогда в каждой регулярной точке а для полного расширения В3, существует система п — в интегралов ^>і(х),..., ^п-3(х). Каждую точку интегрального многообразия (х) = ^>і(а),..., ^п-3(х) = ^п-3(а), проходяще-
го через а, можно соединить с точкой а с помощью пути, состоящего из траекторий системы Вг.
Отметим, что Чжоу не использовал скобку Ли явно, а определил полное расширение при помощи эквивалентного метода инфинитезимальных преобразований к фазовым потокам системы Вг.
4. Явное управление вдоль траектории
4.1. Геометрические и динамические свойства качения на нулевом моменте
В предыдущем разделе была доказана полная управляемость шара Чаплыгина с роторами, то есть принципиальная возможность перекатить шар по плоскости без проскальзывания из начального положения, характеризующегося локальными координатами г0 = = (9о,^о,Фо,%о,Уо), в конечное гf = (9f,у$,'фf,xf,у/). Теперь мы перейдем к построению явного алгоритма управления шаром вдоль заданной траектории на плоскости, для этого приведем ряд достаточно простых геометрических фактов, описывающих качение без проскальзывания сферы по плоскости. Всюду в этом разделе будем полагать момент относительно точки контакта равным нулю:
М = ІП + Б^ х (П х 7) + К (і) = 0. (4.1)
Замечание. Очевидно, что для существования решения данной задачи управления необходимо, чтобы длина кривой Г| |(в) на плоскости была не меньше, чем расстояние (вдоль геодезической) на шаре между точками г (во) и г (sf).
Прежде всего остановимся на геометрическом смысле углов Эйлера для данного случая, которые задаются соотношениями (3.3); полный поворот Р представляет собой композицию трех поворотов (см. рис. 2):
Ці(и) =
Р = Рз(ф)Рі (її)Яз(Ф)
Л \
, Яз(и) =
1 0 0
0 008 и 8ІП и 0 — 8ІП и 008 и
)
( \
008 и 8ІП и 0
— 8ІП и 008 и 0
0 0 1у
при этом 7 = (8ІП в 008 ф', 8ІП в 8ІП ф, 008 в), ф = П/2 — ф.
Напомним, что радиус-вектор из центра шара О в точку контакта с плоскостью С задается соотношением г = —К7 (см. (2.1)), следовательно, величины (в, ф) можно считать сферическими координатами точки контакта в системе главных осей шара ОЄ1Є2Є3. Таким образом, положение и ориентация шара на плоскости могут быть заданы следующим образом:
отметим точку на плоскости с координатами (х, у) и точку на шаре со сферическими координатами, определенными выше, (в,ф), совместим эти точки и повернем шар вокруг вертикали так, чтобы угол между линией узлов ОМ и осью Ох был равен ф,
(4.2)
где линия узлов ОН является линией пересечения плоскости Ов\в2 и горизонтальной плоскости Oa.fi.
Укажем еще одно простое геометрическое свойство, характеризующее кинематику качения без проскальзывания.
Предложение 3. Пусть при качении шара точка контакта C описывает гладкую кривую на плоскости r,,(t) = (x(t),y(t)) и на поверхности шара r(t) = — RY(t), где t -время, тогда скорости движения по этим кривым совпадают, то есть в подвижных осях выполнено соотношение
X а + yfi = —Rj, (4.3)
ориентация шара Q в каждый момент времени определена однозначно, при этом угол нутации ф находится из соотношений
Xв — Уф sin в , Ув + Xф sin в
sin ip =---:------------, cos ip =--------------------. 4.4
R(92 + sin 9ф'2) R(92 + sin вф'2)
Доказательство. Действительно, заметим, что скорости точки контакта C и центра шара
O совпадают и в подвижных осях определяются соотношением V = X а + у в; согласно уравнениям (2.7), П х r = —RQ х y = RY• Подставляя эти соотношения в уравнение связи (2.1), получим требуемое соотношение (4.3). Домножая равенство (4.3) слева и справа на матрицу Q, заданную равенством (3.3), получим
^X\ /cosф — sinф\ f—Rsinвф\
ку) V sin ф cos ф/ у —R0 )'
Разрешая эту систему относительно cosф и sinф, получим (4.4).
Как следствие получим, что длины кривых, описываемых точкой контакта на плоскости и сфере, совпадают. В дальнейшем мы будем параметризовать обе кривые натуральным параметром — длиной s.
Замечание. Соотношение (4.5) означает, что касательный вектор вдоль кривой на плоскости dr, |(s)
ds
dr (s)
вычисленный в неподвижных осях, и касательный вектор к кривой на сфере ть =
^ , вычисленный в осях, связанных с шаром, в точке контакта С совмещаются друг с другом
поворотом вокруг вертикали на угол + ф.
Опираясь на эти свойства, докажем два естественных утверждения, позволяющих строить различные законы управления.
Предложение 4. Пусть М = 0, для всякой заданной точки контакта на поверхности шара го = —К70 существует такая вектор-функция гиростатического момента
К (і) = M^)І7о, (46)
что шар совершает вращение вокруг вертикали, не передвигаясь по плоскости, где /л(Ь) -произвольная функция.
Доказательство. Согласно уравнениям (2.7), для данного движения выполняются соотношения
П х 70 = 0, (П, а) = (П, в) = 0.
Эти уравнения совместны и имеют ненулевое решение вида
П = И7о,,
где ц — произвольная функция. Подставляя П в (4.1), находим:
К (і) = М(і)І7 о-
Предложение 5. Пусть М = 0 и заданы две гладкие кривые одинаковой длины: одна — на плоскости Гц(в) = (х(в),у(в)), другая — на сфере г (в) = —К^(в) (в сферических координатах, соответственно, $(в), <^(в)), тогда существует единственная гладкая вектор-функция для гиростатического момента
К (і) = -8(1) ( (I + £>Е) ( х 7 ) + (кр - № ),
' / (4 7)
йх й2у йу й2х 2 ( ^ й2^'
кр = ~ ~77>. ~ ~17>.> кь = Я ( 7, — х
йв йв2 йв йв2 \ ’ йв йв2
такая, что при качении шара точка контакта С движется вдоль указанных кривых, здесь в (і) — определяет закон движения по траектории.
Доказательство. Для нахождения вектора гиростатического момента перепишем уравнение (4. 1) в виде
—К (і) = (I + БЕ)П — ,
где П7 = (П, 7) — проекция угловой скорости на нормаль к плоскости. Умножая векторно слева и справа на 7 уравнение Пуассона 7 = 7 х П, находим
П = 7 х 7 + П77.
Пользуясь этими двумя соотношениями, представим искомый вектор гиростатического момента в форме
К (і) = —(I + £Е)(7 х 7) — П717. (4.8)
Поскольку для заданной траектории 'у(в) находим 7 = в(і) —первое слагаемое легко вычисляется. Для нахождения функции П7 воспользуемся следующим геометрическим фактом [34].
Лемма 1. При качении без проскальзывания шара по плоскости выполнено соотношение
кр = кь + -(4.9)
где кр — кривизна траектории точки контакта на плоскости, а кь — геодезическая кривизна траектории на шаре, равная кривизне проекции этой кривой на касательную плоскость в точке контакта.
Вычисляя эти кривизны по известным формулам, получим
йх й2у йу й2х ^2 ( й2^\
Подставляя полученные выражения в (4.9) и (4.8), получим требуемое соотношение.
4.2. Качение шара вдоль заданной траектории
Теперь, опираясь на доказанные выше утверждения, можно указать явные алгоритмы решения задачи (3.2) об управлении шаром Чаплыгина. Приведем возможный алгоритм при дополнительном условии, что на плоскости задана траектория точки контакта Г||(з) = = (х(в),у(в)^, соединяющая начальное (хо,уо) и конечное (xf ,yf) положения шара.
Как и выше, обозначим го = (0о,фо,фо,хо,уо) — начальное состояние шара, Zf = = (вf, фf ,фf ,Xf, yf) — конечное.
1. На первом шаге проведем на шаре кривую г (в) той же длины, что и на плоскости, соединяющую точки с координатами (во,Юо) и (вf ).
2. Повернем шар на месте вокруг вертикали согласно (4.6) так, чтобы касательные кривых на шаре и плоскости совпали. Для этого вычислим требуемый угол 01 согласно соотношениям (4.4):
01 = аг^
/Чіп Й^- ^ ^
(Ь (Ь (Ь (Ь
8-тв^^ + ^ (Ш-
_ йх йю йу йв sgn ( 81П й — — + — — йв йв йв йв
п,
г=г0
г=го
а затем подберем функцию ц(Ь') в соотношении (4.6) так, чтобы
*1
01 — 00 = J Ц^) М, ц(Ь1) = ц(0) = 0.
о
Равенство нулю на концах интервала гарантирует остановку роторов в начале и в конце движения.
3. Зададим закон движения по траектории в(Ь), удовлетворяющий условию
^1) = ^2) = 0, (4.10)
и зададим управление гиростатическим моментом согласно (4.7), что позволяет за время £2 — ^1 прокатить шар по заданной траектории с остановкой в конце движения.
4. Вычислим угол 02 в конечной точке
02 = аг^
. . .йх йю йу йв
- Sgn 81П Й — — + — —
йв йв йв йв
п.
Вновь поворачиваем шар вокруг вертикали в соответствии с (4.6), при этом
т
0f - 02 = J ^(і) йі, ^(£2) = м(т) = 0.
І2
Таким образом за промежутки времени [0,Т] шар перекатывается без проскальзывания из начального состояния в конечное.
Замечание. При построении управления можно избежать доворотов шара вокруг вертикали. Для этого кривую г (в) на шаре надо провести так, чтобы касательные кривых на шаре и плоскости в начальный и конечный моменты совпадали.
5. Примеры
В качестве примера вычислим управляющий гиростатический момент К (і) для качения вдоль двух заданных траекторий на плоскости: дуги окружности и синусоиды. Кроме того, в качестве траектории точки контакта на шаре выберем главную окружность, перпендикулярную главной оси инерции шара ез, то есть
7(в) = (зт-|,со8-|,о), (5.1)
где длина пути в меняется в промежутке от нуля до своего максимального значения, определяемого траекторией точки контакта на плоскости.
5.1. Качение по дуге окружности
Рассмотрим качение шара вдоль окружности радиуса р:
Г"| | («) = ( —/9 8111 —, /9 СОЭ — ), 5 = 0... 5Г
р р /
(5.2)
в качестве траектории точки контакта на шаре выберем главную окружность, перпендикулярную главной оси инерции шара ез, то есть
7 (в) = ^8ІП-|,С08-|,о), Зависимость в(і), удовлетворяющую условиям (4.10), выберем в виде
П
«(і) = «тах 8ІІ12 І Є [0, 1].
Тогда управляющий момент К (і) примет вид
ь^.ч втахП . , ,Л (І\ . в(і) І2 в(і) Із + Б
К (і) = 8т(,гі) 8т —, - «* —, -д-
(5.3)
(5.4)
(5.5)
где зависимость s(^) задана соотношением (5.4). Пример зависимости К(Ь) для случая качения шара радиуса К =1 по полной окружности радиуса р = 1/2 приведен на рисунке 3.
Рис. 3. Зависимость управляющего гиростатического момента К от времени, реализующая качение шара радиуса К =1 по окружности радиуса р = /2 при I = diag(2, 3, 4), Б = 10, втах = п.
5.2. Качение по синусоиде (слалом)
Пусть траектория шара на плоскости представляет собой N периодов синусоиды, которую представим в параметрической форме:
Г||(т) = (—Р sin t,vt ), т = 0 ...2nN, (5.6)
где р — амплитуда, v — частота синусоиды. Длина пути в данном случае имеет вид
*(т)=^А-,?Е\т,^ф==^ (5.7)
где Е(ф,к) — эллиптический интеграл второго рода:
Е((р,к) = У л/1 — к'2 эш2 в (19. (5.8)
о
Как видно из (5.6) и (5.7), нормальное представление траектории на плоскости выражается через обратные эллиптические интегралы. Поэтому удобнее параметризовать кривые на сфере и плоскости не длиной траектории в, а параметром т.
В общем случае при произвольной параметризации кривых на плоскости Т\ | (т) и сфере 7(т) формула (4.7) принимает вид
' с?7 (1т
K(t) = -т ( (I + DB) ( х 7 ) + (кр — кь) 17 ),
^=(т7^-ттп)/Ст)2’ ^ = 2 <59)
\ат ат2 ат ат2/ / \ат J \ ат ат2 / / \ат
Подставив (5.3) и (5.6) в (5.9), получим
.( г/psinr . s(t) г/psinr s(r) г^-—^/3 + D
K(t) =т 5I\ sm ——, —z------5l2 cos ——,- \/и2 + р2 cos г —-—
w \v2 + р2 cos2 т 1 R v2 + р2 cos2 т R R
(5.10)
Рис. 4. Зависимость компонент вектора управляющего гиростатического момента К от времени, реализующая качение шара радиуса К =1 по синусоиде х = 2 вту, у € [0 ...4п], при I = diag(2, 3, 4), Б = 10.
где s(t) задано соотношением (5.7), а зависимость т(t) аналогично (5.4) можно задать в виде
r(t) = 2irN sin2 (J^tj, tG[0,1]. (5.11)
Пример зависимости K(t) для N = 2 приведен на рисунке 4.
Авторы выражают искреннюю признательность за дискуссии и обсуждения результатов А. В. Болсинову, Д. В. Трещеву.
Список литературы
[1] Бобылев Д. К. О шаре с гироскопом внутри, катящемся по горизонтальной плоскости без скольжения // Матем. сб., 1982, т. 16, вып. 3, с. 544-581.
[2] Болсинов А. В., Борисов А. В., Мамаев И. С. Топология и устойчивость интегрируемых систем // УМН, 2010, т. 65, вып. 2(392), с.71-132.
[3] Борисов А. В., Мамаев И. С. Динамика твердого тела. М.-Ижевск: НИЦ «Регулярная и хаотическая динамика», 2001. 384 с.
[4] Борисов А. В., Мамаев И. С. Качение неоднородного шара по сфере без скольжения и верчения // Нелинейная динамика, 2006, т. 2, №4, с. 445-452.
[5] Борисов А. В., Мамаев И. С. Законы сохранения, иерархия динамики и явное интегрирование неголономных систем // Нелинейная динамика, 2008, т. 4, №3, с. 223-280.
[6] Жуковский Н. Е. О гироскопическом шаре Д. К. Бобылева // Собр. соч.: т. 1 / Н. Е. Жуковский. М.-Л.: Гостехиздат, 1948. С. 275-289.
[7] Маркеев А. П. Об интегрируемости задачи о качении шара с многосвязной полостью, заполненной идеальной жидкостью // МТТ, 1986, т. 21, № 1, с. 64-65.
[8] Мартыненко Ю. Г. Управление движением мобильных колесных роботов // Фундамент. и при-кл. матем., 2005, т. 11, вып. 8, с. 29-80.
[9] Москвин А. Ю. Шар Чаплыгина с гиростатом: Особые решения // Нелинейная динамика, 2009, т. 5, №3, с. 345-356.
[10] Рашевский П. К. О соединимости любых двух точек вполне неголономного пространства допустимой линией // Учен. зап. пед. ин-та им. Либкнехта. Сер. физ.-матем., 1938, т. 3, вып. 2, с. 83-94.
[11] Чаплыгин С. А. О катании шара по горизонтальной плоскости // Матем. сб., 1903, т. 24, с. 76101.
[12] Agrachev A. A., Sachkov Yu. L. An intrinsic approach to the control of rolling bodies // Proc. of the 38th IEEE Conf. on Decision and Control (Phoenix, AZ, Dec 1999): Vol. 1, pp. 431-435.
[13] Alouges F., Chitour Y., Long R. A motion planning algorithm for the rolling-body problem // IEEE Transactions on Robotics, 2010. 12 p.
[14] Alves J., Dias J. Design and control of a spherical mobile robot // Journal of Systems and Control Engineering, 2003, vol. 217, pp. 457-467.
[15] Armour R.H., Vincent J.F.V. Rolling in nature and robotics: A review // Journal of Bionic Engineering, 2006, vol. 3, no. 4, pp. 195-208.
[16] Bonnard B. Controlabilite des systemes nonlineaires // C. R. Acad. Sci. Paris, Ser. 1, 1981, vol. 292, pp. 535-537.
[17] Borisov A. V., Mamaev I. S. The rolling of rigid body on a plane and sphere: Hierarchy of dynamics // Regul. Chaotic Dyn., 2002, vol. 7, no. 1, pp. 177-200.
[18] Borisov A. V., Mamaev I. S., Kilin A. A. Rolling of a ball on a surface: New integrals and hierarchy of dynamics // Regul. Chaotic Dyn., 2002, vol. 7, no. 2, pp. 201-220.
[19] Camicia C., Conticelli F., Bicchi A. Nonholonimic kinematics and dynamics of the Sphericle // Proc. of the 2000 IEEE/RSJ Internat. Conf. on Intelligent Robots and Systems, 2000, pp. 805-810.
[20] Campion G., Chung W. Wheeled robots // Handbook of Robotics / B. Siciliano, O. Khatib. Berlin: Springer, 2008. P. 391-410.
[21] Chow W. L. Uber Systeme von linearen partiellen Differentialgleichungen erster Ordnung // Math. Ann., 1939, vol. 117, pp. 98-105.
[22] Chung W. Nonholonomic manipulators. (Springer Tracts in Advanced Robotics, vol. 13.) Berlin: Springer, 2004. 114 pp.
[23] Crossley V. A. A literature review on the design of spherical rolling robots. Pittsburgh, PA, 2006. 6 pp.
[24] Crouch P. E. Spacecraft attitude control and stabilization: Applications of geometric control theory to rigid body models // IEEE Trans. Autom. Contr., 1984, vol. AC-29, no. 4, pp. 321-331.
[25] Duistermaat J. J. Chaplygin’s sphere. arXiv:math/0409019v1 [math.DS] 1 Sep 2004.
[26] Goncharenko I., Svinin M., Hosoe S. Dynamic model, haptic solution, and human-inspired motion planning for rolling-based manipulation // Journal of Computing and Information Science in Engineering, 2009, vol. 9, no. 1, 011004, 10 pp.
[27] Johnson B. D. The nonholonomy of the rolling sphere // Amer. Math. Monthly, 2007, vol. 114, no. 6, pp. 500-508.
[28] Joshi V. A., Banavar R. N. Motion analysis of a spherical mobile robot // Robotica, 2009, vol. 27, no. 3, pp. 343-353.
[29] Joshi V.A., Banavar R. N., Hippalgaonkar R. Design and analysis of a spherical mobile robot // Mech. Mach. Theory, 2010, vol. 45, pp. 130-136.
[30] Karimpour H., Keshmiri M., Mahzoon M. Stabilization of an autonomous rolling sphere navigating in a labyrinth arena: A geometric mechanics perspective // Systems Control Lett., 2012, vol. 61, pp. 495-505.
[31] Kilin A. A. The dynamics of Chaplygin ball: The qualitative and computer analysis // Regul. Chaotic Dyn., 2001, vol. 6, no.3, pp. 291-306.
[32] Koiller J., Ehlers K. M. Rubber rolling over a sphere // Regul. Chaotic Dyn., 2007, vol. 12, no. 2, pp.127-152.
[33] Koshiyama A., Yamafuji K. Design and control of an all-direction steering type mobile robot // Int. J. Robot. Res., 1993, vol. 12, no. 5, pp. 411-419.
[34] Levi M. Geometric phases in the motion of rigid bodies // Arch. Ration. Mech. Anal., 1993, vol. 122, pp.213-229.
[35] Lewis A. D., Ostrowski J. P., Burdickz J. W., Murray R. M. Nonholonomic mechanics and locomotion: the Snakeboard example // Proceedings of the 1994 IEEE International Conference on Robotics and Automation, 1994, 16 p.
[36] Li Z., Canny J. Motion of two rigid bodies with rolling constraint // Robotics and Automation, 1990, vol. 6, no. 1, pp. 62-72.
[37] Michaud F., Caron S. Roball, the rolling robot // Autonomous Robots, 2002, vol. 12, pp. 211-222.
[38] Marigo A., Bicchi A. Rolling bodies with regular surface: Controllability theory and applications // IEEE Trans. on Automatic Control, 2000, vol. 45, no. 9, pp. 1586-1599.
[39] Mukherjee R., Minor M.A., Pukrushpan J.T. Simple motion planning strategies for Spherobot: A spherical mobile robot // Proc. of the 38th IEEE Conf. on Decision and Control (Phoenix, AZ, Dec 1999): Vol. 3, pp. 2132-2137.
[40] Mukherjee R., Minor M.A., Pukrushpan J.T. Motion planning for a spherical mobile robot: Revisiting the classical ball-plate problem // J. Dyn. Systems, Measurement, and Control, 2002, vol. 124, pp. 502-511.
[41] Nakashima A., Nagase K., Hayakawa Y. Control of a sphere rolling on a plane with constrained rolling motion // Proc. of the 44th IEEE Conf. on Decision and Control, and the European Control Conference (2005), pp. 1445-1452.
[42] Ostrowski J. P., Desai J. P., Kumar V. Optimal gait selection for nonholonomic locomotion systems // The International Journal of Robotics Research, 2000, vol. 19, no. 3, pp. 225-237.
[43] Reza Moghadasi S. Rolling of a body on a plane or a sphere: A geometric point of view // Bull. Austral. Math. Soc., 2004, vol. 70, pp. 245-256.
[44] Sang S., Zhao J., Wu H., Chen S., An Q. Modeling and simulation of a spherical mobile robot // Computer Science and Information Systems, 2010, vol. 7, no. 1, pp. 51-62.
[45] Shen J., Schneider D.A., Bloch A.M. Controllability and motion planning of multibody systems with nonholonomic constraints // Proc. of the 42nd IEEE Conf. on Decision and Control (Maui, Hawaii USA, Dec 2003): Vol. 53, pp. 4369-4374.
[46] Shen J., Schneider D. A., Bloch A. M. Controllability and motion planning of a multibody Chaplygin’s sphere and Chaplygin’s top // Internat. J. Robust Nonlinear Control, 2008, vol. 18, no. 9, pp. 905-945.
[47] Sugiyama Y., Hirai S. Crawling and jumping by a deformable robot // Int. J. Robot. Res., 2006, vol. 25, pp. 603-620.
[48] Suomela J., Ylikorpi T. Ball-shaped robots: An historical overview and recent developments at TKK // Field and Service Robotics, 2006, vol. 25, pp. 343-354.
[49] Tomik F., Nudehi S., Flynn L.L., Mukherjee R. Design, fabrication and control of spherobot: A spherical mobile robot // J. Intell. Robot. Syst., 2012 (DOI: 10.1007/s10846-012-9652-2).
[50] Wilson J. L., Mazzoleni A. P., DeJarnette F. R., Antol J., Hajos G. A., Strickland C. V. Design, analysis, and testing of Mars tumbleweed rover concepts // Journal of spacecraft and rockets, 2008, vol. 45, no. 2, pp. 370-382.
[51] Yoon J.-C., Ahn S.-S., Lee Y.-J. Spherical robot with new type of two-pendulum driving mechanism // Proc. of the 15th IEEE Internat. Conf. on Intelligent Engineering Systems (2011), pp. 275-279.
[52] Zhan Q., Cai Y., Yan C. Design, analysis and experiments of an omni-directional spherical robot // IEEE Internat. Conf. on Robotics and Automation (Shanghai, China, May 2011), pp. 4921-4926.
How to control the Chaplygin sphere using rotors
Alexey V. Borisov1, Alexander A. Kilin2, Ivan S. Mamaev3
1,2,3Institute of Computer Science Udmurt State University Universitetskaya 1, Izhevsk, 426034 Russia
[email protected], [email protected], [email protected]
In the paper we study control of a balanced dynamically nonsymmetric sphere with rotors. The no-slip condition at the point of contact is assumed. The algebraic contrability is shown and the control inputs providing motion of the ball along a given trajectory on the plane are found. For some simple trajectories explicit tracking algorithms are proposed.
MSC 2010: 37J60 37J35 70E18 70F25 70H45
Keywords: non-holonomic constraint, non-holonomic distribution, control, Chow-Rashevsky theorem, drift
Received March 10, 2012, accepted June 2, 2012
Citation: Rus. J. Nonlin. Dyn., 2012, vol. 8, no. 2, pp. 289-307 (Russian)
