Научная статья на тему 'Динамика и управление сферическим роботом с осесимметричным маятниковым приводом'

Динамика и управление сферическим роботом с осесимметричным маятниковым приводом Текст научной статьи по специальности «Физика»

CC BY
50
12
i Надоели баннеры? Вы всегда можете отключить рекламу.
Журнал
Russian Journal of Nonlinear Dynamics
Scopus
ВАК
RSCI
MathSciNet
zbMATH
Область наук
Ключевые слова
НЕГОЛОНОМНАЯ СВЯЗЬ / УПРАВЛЕНИЕ / СФЕРИЧЕСКАЯ ОБОЛОЧКА / ИНТЕГРАЛ ДВИЖЕНИЯ / NON-HOLONOMIC CONSTRAINT / CONTROL / SPHERICAL SHELL / INTEGRAL OF MOTION

Аннотация научной статьи по физике, автор научной работы — Иванова Татьяна Борисовна, Пивоварова Елена Николаевна

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

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

Похожие темы научных работ по физике , автор научной работы — Иванова Татьяна Борисовна, Пивоварова Елена Николаевна

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

Dynamics and control of a spherical robot with an axisymmetric pendulum actuator

This paper investigates the possibility of the motion control of a ball with a pendulum mechanism with non-holonomic constraints using gaits —- the simplest motions such as acceleration and deceleration during the motion in a straight line, rotation through a given angle and their combination. Also, the controlled motion of the system along a straight line with a constant acceleration is considered. For this problem the algorithm for calculating the control torques is given and it is shown that the resulting reduced system has the first integral of motion.

Текст научной работы на тему «Динамика и управление сферическим роботом с осесимметричным маятниковым приводом»

Нелинейная динамика. 2013. Т. 9. № 3. С. 507-520. Полнотекстовая версия в свободном доступе http://nd.ics.org.ru

УДК: 531.31

М8С 2010: 37^0, 70Е18

Динамика и управление сферическим роботом с осесимметричным маятниковым приводом

Т. Б. Иванова, Е. Н. Пивоварова

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

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

Получено 5 августа 2013 года После доработки 21 октября 2013 года

Работа выполнена при поддержке АВЦП «Развитие научного потенциала высшей школы» на 2012-2014 годы, №1.1248.2011 «Неголономные динамические системы и проблемы управления», №1.7734.2013 «Разработка неголономных мобильных систем», ФЦП «Научные и научнопедагогиче-ские кадры инновационной России», соглашение № 14.В37.21.1935 «Топологические методы в механике и гидродинамике». Работа поддержана грантом Президента РФ поддержки ведущих научных школ НШ-2519.2012.1, грантом Президента РФ поддержки молодых докторов наук МД-2324.2013.1.

Иванова Татьяна Борисовна tbesp@rcd.ru

Пивоварова Елена Николаевна 1.п.р1уоуагоуа@^а11. сот

Удмуртский государственный университет 426034, Россия, г. Ижевск, ул. Университетская, д. 1

Содержание

Введение ............................

1. Уравнения движения ..................

2. Управление при помощи гейтов и их сопряжения

508

509

511

512 514

2.1. Разгон по прямой

2.2. Движение с изменением направления.....

3. Движение при фиксированных параметрах

517

Введение

Исследованию динамики и управления таких средств передвижения, как робот-колесо, робот-шар, передвигающихся за счет изменения положения центра масс, посвящено значительное количество работ последнего десятилетия (см., например, [1, 6, 7, 10-14]). Также активно изучается возможность управления данными системами и при помощи других внутренних механизмов, например роторов [3, 4]. Интерес к таким системам обусловлен наличием некоторых преимуществ в маневренности по сравнению с колесными экипажами. Подробный обзор литературы по сферическим роботам с различными механизмами передвижения, а также их описание и области применения приведены в [9, 13, 14].

Движение сферических роботов, передвигающихся за счет колебаний маятника, изучается в работах [1, 5, 7, 8, 11-14]. В частности, в работе [13] рассмотрено управление при движении маятникового сфероробота по наклонной плоскости и найден максимальный угол наклона плоскости, на который может подняться аппарат (то же самое для одноколесного робота рассматривается в [7]). В [14] рассмотрен вопрос преодоления препятствия и найдена максимальная высота, которую может преодолеть такой робот. В [11] рассматривается управление шаром при движении по прямой и по окружности для разных типов управляющих устройств (регуляторов).

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

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

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

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

1. Уравнения движения

Рассмотрим сферическую оболочку (рис. 1) относительно неподвижной системы координат (ось Ог направлена вертикально вниз). Обозначим через С3 центр масс оболочки, а через Ог — центр масс волчка, расстояние между ними К = О^|. Вектор п направлен вдоль оси симметрии волчка (здесь и далее векторы будем обозначать полужирным курсивом).

Предполагая, что в системе главных осей волчка его тензор инерции имеет вид 1 = diag(i,i,i + ]), запишем кинетическую энергию системы в форме [5, 8]

Т = ^(МУ2 + Ш2) + + ш2 + Цш, гг.)2),

Рис. 1. Сферическая оболочка с закрепленным в ее центре осесиммет-ричным маятником.

где V, П — скорость центра и угловая скорость оболочки, М, I — ее масса и момент инерции, V, ш — скорость центра масс и угловая скорость волчка, т^] — его масса и компоненты тензора инерции.

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

Тогда изменение углового момента относительно точки О8 и импульса оболочки можно записать в виде

М V = N0 + Nt + Мдк,

(1.1)

где N0, NI — силы реакции, действующие на оболочку в точке контакта Q0 и точке крепления волчка О3. Для волчка относительно его центра масс имеем:

шШ = ™ + п)Л = К*п х + Ш1? = тЬ = тдк ~ ^ (1-2)

Скорость центра масс волчка определяется соотношением

V = V + Кш х п = Е0к х П + Кш х п;

скорость центра оболочки V связана с угловой скоростью оболочки П условием отсутствия проскальзывания в точке контакта Q0:

V = г3 = К0к х П,

(1.3)

где т3 — радиус-вектор точки контакта.

Эволюцию вектора п можно найти из уравнения

п = Ш X п.

Исключая силы реакции N0, N1 из уравнений (1.1), (1.2), получаем уравнения управляемого движения сферической оболочки с осесимметричным волчком, закрепленным в геометрическом центре оболочки:

)2

172 + шЕдк х ($7 х к) — тК0Кгк х (Ш х п) = тК0Кгк х (ш х п) — Q,

гШ + тЩп х (Ш х п) — тК0Кгп х ($7 х к)

(1.4)

= —](ш, п)п — тК0п х (ш х Л) + тдКгп х к + Q, п = ш х п,

где 3 = ^(1 + МК0,, I + ЫЕ20,1), к = (0, 0,1)т.

Дифференцируя уравнение (1.3) по времени, получим выражение для 71:

Г2 = -^-У хк = -¡-а х к, (1.5)

Ко Ко

где а — ускорение точки контакта.

Нашей задачей является определение такого управляющего момента Q, чтобы точка контакта (соответствующая проекции центра шара) двигалась по заданному закону т3(Ь) = = (ж(£),у(£), 0)т. При этом заданными функциями являются также скорость центра масс V(г) = (х(г),у(г), 0)т и его ускорение а(г) = (£(*),#(*), 0)т.

Задавая закон движения точки контакта по плоскости т3(Ь) из системы уравнений (1.4), (1.5), получим систему девяти уравнений для проекций векторов п, ш, Q, которую можно представить в виде

¥у = А, (1.6)

где у = (Со, п, Q)т, Е — матрица, элементы которой зависят от ш, п, а А — вектор-функция, зависящая от ш, п, 71.

Для того чтобы система (1.6) имела решение (чтобы было возможно управляемое движение), необходимо существование обратной матрицы Е-1, то есть выполнение условия ёе! Е = 0, из которого следует (см. также [1]) необходимость выполнения условия

г + тК0 > тК0Кг. (1.7)

Условие (1.7) можно удовлетворить, выбирая соответствующим образом геометрические характеристики системы. Для определенности выберем в качестве маятника тонкий диск, подвешенный на невесомом стержне, параметры которого удовлетворяют условию (1.7): радиус диска К4 = 0.92К0, длина стержня Кг = 0.25К0. Отметим, что данная система аналогична тележке, катящейся без трения по внутренней поверхности сферической оболочки.

Таким образом, для определения управляющего момента Q(t) необходимо решить систему (1.6) дифференциальных уравнений с соответствующими начальными условиями. Однако система не сможет начать новый маневр (например, для смены направления движения при объезде препятствия), если задан только закон движения т3(г). Кроме того, необходимо, чтобы шар остановился в конечной точке траектории, то есть необходимо, чтобы в конечный момент времени маятник оказался в нижнем положении, а скорость и ускорение были равны нулю. Как правило, заранее таким условиям сложно удовлетворить, так как это существенно усложняет определение функции т3(г) для всей траектории движения.

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

В данной работе мы рассмотрим оба подхода — управление при помощи гейтов (раздел 2) и управление при движении с фиксированными параметрами (такими, как ускорение, раздел 3).

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

ну to =

1 i + j mgRt

за единицу измерения длины — величину xo = gt2, где g — ускорение

свободного падения, то есть в уравнениях сделаем замены:

t

x,

M

m

— M, П to — П, ut0 — и,

Q t

¿о Хо

Также для сокращения записи формул введем обозначения:

¿о = г + Е0, 1о = I + (1 + М )В°0.

mx

Q.

x

—>

2. Управление при помощи гейтов и их сопряжения

Вектор n, направленный вдоль оси симметрии маятника, представим в виде

n = (sin в cos р, sin в sin р, cos 6)T,

где в — угол отклонения маятника от вертикали, р — угол между осью Ox и направлением колебания маятника (рис. 2).

При определении Q(t) будем задавать угол в отклонения маятника от вертикали таким образом, чтобы в начале и в конце маневра маятник находился в нижнем положении:

nt

Рис. 2. Определение углов в и р.

d(t, а,Т) = a sin2 ( — ), в(а, T)\t=Q = в(а, Т)\t=T = О,

(2.1)

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

Для определения параметра а, соответствующего заданному изменению скорости, необходимо из системы (1.4) с учетом (1.5) и (2.1) выразить ускорение а(Ь,а,Т), на которое накладывается дополнительное условие:

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

T

AY (a, T) = J a(t, a, T) dt.

(2.2)

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

Далее, зная а, можно в явном виде определить ускорение a(t, а, T) и из уравнений (1.4) выразить управляющие моменты.

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

2.1. Разгон по прямой

Направим ось Ox вдоль направления движения. Очевидно, что при движении по прямой маятник будет совершать колебания в одной плоскости (в данном случае в плоскости Oxz), следовательно, вектор n, направленный вдоль оси симметрии маятника, можно записать в виде

n = (sin в, 0, cos в)т,

где в — угол отклонения маятника от вертикального положения, задаваемый выражением (2.1).

Из девяти уравнений движения (1.4) нетривиальных останется только три: /0Q2 — RoRt(ü2 cos в — sin в)+ Q2 = 0,

i0üj2 — RoRtQ2 cos в + Rt sin в — Q2 = 0, (2.3)

в = Ü2.

Значение Q2 определяется из (1.5):

й2 = -ф-, Q1 = Q3 = 0. (2.4)

Ro

При подстановке (2.4) в (2.3) получим выражение для ускорения шара в виде

D 0(RoRt cos в — io)+RoRtв2 sin в — Rt sin в

a{t^T) = Ro-I0-RoRt cose-' (2"5)

где в, в, в являются явными функциями от времени и параметров а и T, определяемыми из (2.1).

Численно интегрируя (2.2), с учетом (2.5) получим поверхность, изображенную на рисунке 3a. Данная поверхность A V(a, T) антисимметрична относительно плоскости а = 0, так как функция a(t, a, T) антисимметрична относительно замены а — —а (это легко показать, подставив в (2.5) функцию в^^ах^) в явном виде (2.1)).

Кроме того, при T — 0 имеем AVmax —^ ^о, то есть чем быстрее происходит колебание маятника, тем больше увеличивается скорость.

На рисунке 3b представлены сечения данной поверхности при различных значениях T. Из графиков видно, что заданным AV и T соответствует как минимум два значения а: при а = а1 маятник совершает колебание на меньший угол, чем при а = а2 (из-за этого при а = а2 скорость меняется немонотонно).

Выбрав конкретное значение а, например ах, подставляя (2.5) в уравнения движения (2.3) и численно интегрируя их, получим управляющие моменты:

Qi = Q3 = 0,

q2 = a{t^t)i0 + rorti cos её - sin ее2).

Ro

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

(а) (Ь)

Рис. 3. (a) Поверхность ДУ(а, Т). (Ь) Сечение поверхности ДУ(а, Т) плоскостями Т = 5 (сплошная линия) и Т = 1 (пунктирная линия).

Пример 1. Рассмотрим разгон шара из состояния покоя до скорости У\ = 0.5 за время Т = 5. Такому движению соответствует значение параметра а = 0.83 (см. рис. 3Ь). Так как шар двигается из состояния покоя и маятник находится в нижнем положении, начальные условия имеют вид

п = (0, 0,1)Т, ш = (0, 0, 0)Т, г = (0, 0, 0)Т, V = (0, 0, 0)Т.

Подставив найденное значение а в уравнения движения (2.3) и численно интегрируя их (с указанными начальными условиями), получим соответствующее управление Q = = (0,^0, 0)Т для такого разгона (рис. 4).

Ниже представлены графики зависимости ненулевых компонент вектора п, скорости V, ускорения шара а(Ь) и угловой скорости маятника ш от времени (рис. 4). Из них видно, что за Т = 5 шар набрал скорость ДУ = 0.5, двигаясь далее с постоянной скоростью. Маятник при этом совершил одно полное колебание и вернулся в начальное положение.

Чтобы шар остановился, необходимо совершить колебание маятника в обратном направлении с той же амплитудой и за тот же промежуток времени (то есть а = —0.83, Т = 5). В конце маневра маятник так же, как и при разгоне, окажется в нижнем вертикальном положении.

Рис. 4. Зависимость векторов п, ш, Q, а также скорости и ускорения шара от времени при разгоне за одно колебание маятника.

2.2. Движение с изменением направления

Рис. 5. У — начальная скорость движения, Д V — изменение скорости, У^ — скорость движения шара после завершения маневра.

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

n = (sin в cos p, sin в sin p, cos в)

T

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

Уравнения движения (1.4) в проекциях на оси неподвижной системы координат запишем следующим образом:

Q1I0 — RoRt(io1 cos в — ü1 sin вв) + Q1 =0, Q2I0 — RoRt(ü2 cos в — ü2 sin вв) + Q2 = 0, i0üj 1 — RoRtQ 1 cos в — Rt sin в sin p — Q1 = 0, i0üj2 — RoRtQ2 cos в + Rt sin в cos p — Q2 = 0, в = ü2 cos p — ü1 sin p.

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

ft Ü = ft, = = _2!ÍÍ>, Й, = о, 1 p p ) 2 p fí Ro Ro Ro Ro

где V1 и V2 — это проекции скорости на оси Ox и Oy соответственно. Ускорения й1 (t) и a2(t) можно представить в виде

a1(t) = a(t, a, T) cos p, a2(t) = a(t, a, T) sin p,

(2.6)

(2.7)

где а(Ь,а,Т) определяется выражением (2.5), а 9 по-прежнему является функцией времени и параметров а,Т и определяется выражением (2.1).

Дифференцируя уравнение (1.3) по времени, с учетом (2.6) и (2.7) получим:

r = Rok х П = Ro — Q2, Q1, 0 = a(t)s

T

А V

AV

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

где s = (cos p, sin p, 0)T =

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

Предложение 1. Скорость шара изменяется в направлении колебания маятника.

Если угол р = 0, мы получим разгон шара по прямой, рассмотренный в разделе 2.1.

Рассмотрим другой частный случай — колебание под углом íp = ^ к первоначальному направлению движения. В этом случае вектор, направленный вдоль оси симметрии маятника, можно записать в виде

n = (0, sin в, cos в)т.

Уравнения движения (1.4) перепишем в виде

/0Пi — RoRt(W1 cos в + wf sin в)+ Q1 = 0, ¿ow 1 — RoRtil 1 cos в — Rt sin в — Q1 = 0, в = —w1.

У

AV

Рис. 6. Изменение скорости движения шара.

(2.8)

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

Ro Ro

(2.9)

Выражение для ускорения шара а(Ь, а, Т) будет иметь такой же вид, как при разгоне шара по прямой (2.5), а управления запишутся в форме

Qi = -a(¿'"'T)J0 - R0Rt(cos 0(9 - sin^2),

Ro

(2.10)

Qf = Q3 = 0.

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

Далее, дифференцируя уравнение (1.3) по времени, с учетом (2.5) и (2.9) получим:

г = Rok х П = Ro ( —П2, П 1, 0) = (0, a(t, a, T), 0)T,

(2.11)

то есть скорость меняется только в направлении оси Оу — в направлении колебания маятника.

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

У2

ф = агс^ —.

VI

Изменяя параметры а и Т, получим зависимость ф(а, Т), изображенную на рисунке 7а. Функция ф(а, Т) также является антисимметричной относительно плоскости а = 0, и при

Т 0 имеем 0тах -т;-

T

(а)

(b)

Рис. 7. (а) Поверхность ф(а,Т). (Ь) Сечение поверхности ф(а,Т) плоскостями Т = 5 (сплошная линия) и Т = 1 (пунктирная линия).

На рисунке 7Ь представлены сечения данной поверхности при различных значениях Т. Из графиков видно, что, как и в предыдущем случае, заданным ф и Т соответствует как минимум два значения а.

Подставляя выбранное значение параметра а, например а\, в уравнения движения (2.8) и численно интегрируя их с учетом (2.5), получим управления (2.10).

Пример 2. Рассмотрим поворот шара на угол ф = 40° за время Т = 5 с начальными условиями следующего вида:

где Vs — начальная скорость.

Выберем начальную скорость таким образом, чтобы изменение скорости AV и параметр а были такими же, как в предыдущем примере, то есть Vs = AV ctg ф = 0.6.

Траектория такого движения представлена на рисунке 8.

Так как все параметры аналогичны предыдущему примеру, с точностью до замены Ш — П2, W2 — — Wi, Vx — Vy, Q2 — —Qi, в данном случае все функции будут иметь вид, представленный на рисунке 4.

n = (0, 0,1)T, ш = (0, 0, 0)T, r = (0, 0, 0)T, V = (Vs, 0, 0)T,

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

У

AV

0.4-

0.8-

1.2-

0

0

1

2

3 x

Рис. 8. Траектория движения шара при повороте на угол ф = 40°, У = 0.6.

3. Движение при фиксированных параметрах

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

Продемонстрируем на конкретном примере алгоритм определения такого управления. Для этого рассмотрим равноускоренное движение шара по прямой вдоль оси Ох по закону

x(t) =

aot2

где ao = const — заданное ускорение шара.

Предположим, что шар катится без верчения, то есть Q3 = 0. Аналогично (2.4), с учетом (1.3) получим

йф) = о, Зд) =

Ro

то есть при разгоне вдоль оси Ox маятник совершает колебания только в плоскости Oxz, а следовательно, вектор n имеет вид

n = (sinв, 0, cosв)т,

где в — угол отклонения маятника от вертикали, неизвестная функция от времени. Угловая скорость маятника имеет вид Wf = в.

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

Q1 = Q3 = 0,

Q-2 = £/„ + RoRtiCOS вв - Sin вв2),

Ro

и уравнение для определения зависимости угла в:

•А _ a-pip - apRpRt cos в - R0Rt(R0 sin вв'2 + sin в)

Ro(i0 - R0Rt cos в) ' '

Данная система, помимо геометрического интеграла (n2 = 1), имеет еще один интеграл движения, квадратичный по угловой скорости:

С = -Щ- (¿о - RoRt cos в)2 в2 + R0Rt ^¿о - ^ф1 cos 9) (cos 9 ~ а° sin 9) +

/ r2r2 \

+ а0в Iqíq Н--- aoR0RtIo sin в,

который является аналогом интеграла обобщенной энергии в равноускоренной системе отсчета.

На рисунке 9 представлен фазовый портрет системы (3.1) на плоскости (в, в) при равноускоренном движении шара по прямой с ускорением ao = 0.1. При выбранных параметрах

системы на фазовой плоскости имеется две неподвижные точки, одна из которых соответствует устойчивому положению равновесия типа центр (при 9 = 0.38, 0 = 0), другая — неустойчивая точка типа седло (при 9 = 2.56, 9 = 0).

Из рисунка 9 видно, что существует единственная траектория, соответствующая состоянию покоя в начальный момент времени (проходит через точку (0, 0), жирная кривая). Периодическое движение по этой траектории обеспечивается периодическим управляющим моментом. На рисунке 10 показана зависимость векторов п, ш, Q от времени для начальных условий 9(0) = 9(0) = 0. Из графиков видно, что маятник совершает колебания в плоскости Охг, а вектор управляющего момента меняется периодически и направлен вдоль оси Оу.

Рис. 10. Зависимость ненулевых компонент векторов п, ш, Q от времени при движении шара по прямой с постоянным ускорением ао = 0.1 для начальных условий 9 = 0 = 0.

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

ческое управление, что неудобно для пользователя (то есть движение с постоянным ускорением сложно поддерживать в ручном режиме).

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

Авторы выражают благодарность А.В.Борисову, И. С. Мамаеву, А.А.Килину за обсуждения и полезные замечания.

Список литературы

[1] Баландин Д. В., Комаров М. А., Осипов Г. В. Управление движением сферического робота с маятниковым приводом // Изв. РАН. Теория и системы управления, 2013, №4, с. 150-163.

[2] Болотин С. В., Попова Т. В. Об уравнениях движения системы внутри катящегося шара // Нелинейная динамика, 2013, т. 9, №1, с. 51-58 [Bolotin S.V., Popova T.V. On the motion of a mechanical system inside a rolling ball // Regul. Chaotic Dyn., 2013, vol. 18, nos. 1-2, pp. 159165].

[3] Борисов А. В., Килин А. А., Мамаев И. С. Как управлять шаром Чаплыгина при помощи роторов // Нелинейная динамика, 2012, т. 8, №2, с. 289-307 [Borisov A.V., Kilin A. A., Mamaev I. S. How to control Chaplygin's sphere using rotors // Regul. Chaotic Dyn., 2012, vol. 17, nos. 3-4, pp. 258-272].

[4] Борисов А. В., Килин А. А., Мамаев И. С. Как управлять шаром Чаплыгина при помощи роторов: 2 // Нелинейная динамика, 2013, т. 9, № 1, с. 59-76 [Borisov A. V., Kilin A. A., Mamaev I. S. How to control the Chaplygin ball using rotors: 2 // Regul. Chaotic Dyn., 2013, vol.18, nos. 1-2, pp. 144-158].

[5] Борисов А. В., Мамаев И. С. Две неголономные интегрируемые связки твердых тел // Нелинейная динамика, 2011, т. 7, № 3, с. 559-568 [Borisov A. V., Mamaev I. S. Two non-holonomic integrable problems tracing back to Chaplygin // Regul. Chaotic Dyn., 2012, vol. 17, no. 2, pp. 191-198].

[6] Мартыненко Ю. Г., Формальский А. М. К теории управления моноциклом // ПММ, 2005, т. 69, №4, с. 569-583.

[7] Мартыненко Ю. Г., Формальский А. М. Управление продольным движением одноколесного аппарата по неровной поверхности // Изв. РАН. Теория и системы управления, 2005, №4, с. 165-173.

[8] Пивоварова Е. Н., Иванова Т. Б. Исследование устойчивости периодических решений в задаче о качении шара с маятником // Вестн. УдГУ. Матем. Механ. Компьют. науки, 2012, №4, с. 146-155.

[9] Chase R., Pandya A. A review of active mechanical driving principles of spherical robots // Robotics, 2012, vol. 1, no. 1, pp. 3-23.

[10] Das T., Murkherjee R. Dynamic analysis of rectilinear motion of a self-propelling disk with unbalance masses // Trans. ASME. J. Appl. Mech., 2001, vol.68, pp. 58-66.

[11] Kayacan E., Bayraktaroglu Z.Y., Saeys W. Modeling and control of a spherical rolling robot: A decoupled dynamics approach // Robotica, 2012, vol. 30, no. 12, pp. 671-680.

[12] Michaud F., Caron S. Roball, the rolling robot // Auton. Robots, 2002, vol. 12, pp. 211-222.

[13] Nagai M. Control system of a spherical robot: Master Thesis. Lulea University of Technology, 2008.

[14] Schroll G. C. Dynamic model of a spherical robot from first principles: Master Thesis. Colorado State University, 2010.

Dynamics and control of a spherical robot with an axisymmetric pendulum actuator

Tatyana B.Ivanova1, Elena N.Pivovarova2

1,2Udmurt State University Universitetskaya 1, Izhevsk, 426034 Russia

1tbesp@rcd.ru, 2l.n.pivovarova@gmail.com

This paper investigates the possibility of the motion control of a ball with a pendulum mechanism with non-holonomic constraints using gaits — the simplest motions such as acceleration and deceleration during the motion in a straight line, rotation through a given angle and their combination. Also, the controlled motion of the system along a straight line with a constant acceleration is considered. For this problem the algorithm for calculating the control torques is given and it is shown that the resulting reduced system has the first integral of motion.

MSC 2010: 37J60, 70E18

Keywords: non-holonomic constraint, control, spherical shell, integral of motion

Received August 5, 2013, accepted October 21, 2013

Citation: Rus. J. Nonlin. Dyn., 2013, vol. 9, no. 3, pp. 507-520 (Russian)

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