CC BY
224
УДК 531.31:62-56
БГО: 10.22363/2312-9735-2017-25-2-170-181
Управление процессом безударного захвата непредсказуемо движущегося объекта мобильным манипуляционным роботом И. А. Мухаметзянов, О. И. Чекмарёва
Кафедра теоретической физики и механики Российский университет дружбы народов улица Миклухо-Маклая, д. 6, Москва, Россия, 117198
Строится алгоритм управления безударным захватом непредсказуемо движущейся цели схватом мобильного манипуляционного робота. Захват осуществляется за конечное время. Решение получено без использования информации о неуправляющих силах, в том числе возмущающих силах и силах инерции.
Задача решается в четыре этапа. Во-первых, строится главный вектор сил, обеспечивающий движение центра масс корпуса робота по принципу пропорциональной навигации при погоне за объектом. Во-вторых, строится главный момент управляющих сил относительно центра масс робота для приведения одной из главных центральных осей инерции подвижной системы координат, связанной с корпусом робота, в положение, совпадающее с линией визирования. В-третьих, определяется дополнительная управляющая сила для безударного приведения точки крепления первого звена манипулятора с корпусом робота на расстояние «вытянутой руки манипулятора» от цели по линии визирования, чтобы обеспечить захват. В-четвёртых, строятся выражения сил и моментов управления для поступательно и вращательно движущихся относительно друг друга звеньев манипулятора, позволяющие безударно захватить преследуемый объект.
Для автоматического выбора оптимального значения управления предлагается самонастраиваемый способ, осуществляемый по «принципу обратной связи по квазиускорениям» в дискретные моменты времени. Этот принцип был предложен И.А. Мухаметзяновым в статье, опубликованной в Вестнике РУДН серии «Математика. Информатика. Физика» №3 за 2013 год.
Ключевые слова: манипулятор, самонастраиваемое управление, безударный, конечное время
1. Постановка задачи
Рассмотрим упакованный в корпус робота манипулятор и сам робот в целом как одну механическую систему. С главными центральными осями инерции корпуса робота жёстко свяжем систему координат Схух. Задача заключается в построении главного вектора сил, обеспечивающего движение центра масс С корпуса робота по принципу пропорциональной навигации [1] при погоне за непредсказуемо движущимся объектом. Одновременно с этим необходимо построить аналитическое выражение главного момента управляющих сил относительно точки С для приведения одной из главных центральных осей инерции системы Схух, связанной с роботом, в положение, совпадающее с линией визирования ССо , где Со — центр масс преследуемого объекта. Далее необходимо построить аналитическое выражение дополнительной управляющей силы для безударного приведения точки Оо крепления первого звена манипулятора с корпусом робота в положение точки О на линии визирования, находящейся на расстоянии «вытянутой руки манипулятора» от точки Со объекта преследования. Это позволяет осуществить захват цели схватом манипулятора, центр которого помещён в точку Ое конца последнего звена манипулятора. Необходимо построить также аналитическое выражение сил и моментов управления поступательно и вращательно движущимися относительно друг друга звеньями многозвенного манипулятора, которые позволяют безударно захватить преследуемый объект.
Статья поступила в редакцию 23 декабря 2016 г.
Работа выполнена при финансовой поддержке РФФИ, проект 16-08-00558-а.
2. Управление процессом приведения робота в область досягаемости цели манипулятором
2.1. Построение главного вектора управляющих сил
Определим выражение главного вектора управляющих сил Рп в правой части дифференциального уравнения движения центра масс С корпуса робота
■т^ъ = К (1)
так, чтобы движение точки С происходило по принципу пропорциональной навигации
= Ьше, (2)
где т — общая масса робота, й)у — вектор угловой скорости вращения абсолютной скорости Т4 точки С, ше — вектор угловой скорости линии визирования С С о, Ь — заданный положительный коэффициент пропорциональности.
Заметим, что вращение вектора скорости Уа осуществляется благодаря действию силы Рп, направленной по главной нормали траектории абсолютного движения центра масс С. Определим эту силу Рп, исходя из условия (2) и условия ортогональности Уа векторам Рп и . Вектор имеет величину = Уа/р и направлен по орту
т = 04 х Рп)
где Рп = тУЪ /р, р — радиус кривизны траектории абсолютного движения точки С. Следовательно, имеет место
_ = (К х Рп) " тУ2
Скалярно умножая (2) на ше, получим
(К х Рп)
тУ2
Отсюда
■ Ше = Ьшо .
К ■ (ше х К) = тУ2Ьи2е. (3)
Ищем решение уравнения (3) в виде = \(ше х Уа), обеспечивающем коллинеарность векторов Рп и (ше х Уа), и тем самым минимальность |.РП|. Подставляя Рп = Х(ше х Уа) в (3), определим
тУ^Ъш2
л =
(Ше х Уа)2
Учитывая ше ± Т4, получим Л = тЬ. Следовательно, имеем
Ёп = тЬ(сде х 14). (4)
Теперь необходимо ответить на вопрос о том, каково влияние возмущающих сил, если таковые имеют место, на процесс преследующего движения в погоне за целью при движении по принципу пропорциональной навигации. На этот вопрос можно ответить следующим образом. Составляющие возмущающих сил, направленных по главной нормали траектории точки С, влияют на силу Рп, тем самым влияя
на величину коэффициента пропорциональности Ь. Следовательно, при достаточно больших значениях коэффициента Ь эти возмущения не оказывают существенного воздействия на процесс преследующего движения по данному принципу навигации. Что касается составляющих возмущающих сил, направленных по касательной к траектории точки С, то они приводят лишь к изменению величины скорости Уа точки С, что не оказывает влияния на угловую скорость , то есть не нарушает основного условия (2) преследования по принципу пропорциональной навигации. Таким образом, эти возмущения могут оказывать некоторое влияние лишь на время встречи точек С и С0.
2.2. Построение главного момента управляющих сил
Известно, что вращательное движение тела вокруг центра масс в осях подвижной системы координат Cxyz описывается дифференциальным уравнением
/¿о = (Л0 х wo) + М0 + U, (5)
где J — тензор инерции тела в точке C, ¿о(р,Ч, f) — мгновенная угловая скорость тела, p,q,r — проекции вектора ¿о на оси Cx, Cy, Cz, Мо — главный момент действующих на тело неуправляющих сил относительно точки C, U (Up, Uq, Ur) — главный момент управляющих сил относительно точки C.
Вектор U определим, используя требуемое условие коллинеарности вектора 1о — орта линии визирования CCо и вектора k3 — орта оси Cz системы координат Cxyz:
( кг ■10) = 0 (i = l, 2), (6)
где к — орты осей Cx и Cy системы Cxyz.
Отклонения от условий (6) зададим вектором w с элементами
¿1 = (ki ■ 10), ¿2 = (к2 ■ lo). (7)
Введём квазискорости
¿¿i = OJi + ^i(ki ■ lo), Уг = const > 0 (г = 1, 2), (8)
где ¿ji, согласно формулам Пуассона кi = ¿о х ki, lo = ¿e x lо, выражаются в виде
¿0i = шо ■ (ki X 1о) + ¿e ■ (lo X ki).
Из (8) следует
¿0 ■ (ki xl0) = Ui + Bi (i = l, 2), (9)
где Bi = -ki ■ (¿¿e x lo) - уi(ki ■ lo).
Систему (9) из двух уравнений относительно трёх элементов вектора ¿о(р,Ч, f) представим в виде
т0 = uj + b, (io)
где матрица П определяется из
p(ki х 10) ■ ki + q(ki х l0) ■ k2 + r(ki х l0) ■ki = иi + Bi, p(k2 x l0) ■ ki + q(k2 x l0) ■ k2 + r(k2 х l0) ■ki = Cb2 + B2
в виде
п= 0 -(1о ■к3) (То -к2)
(1о ■кз) 0 -(¡о ■кг) . ( )
При получении (11) были учтены следующие очевидные соотношения:
(к х 1о) ■к = 0, (кг х 1о) ■ к2 = -(1о ■ кз), (кг х 1о) ■ кз = (1о ■ к2) (к2 х 1о) ■ кг = (1о ■ кз), (к2 х 1о) ■ кз = -(1о ■ кг) (г = 1, 2).
Решение (10) относительно Шо ищем в виде
Шо = (12)
где Л — вектор Хт(Аг,\2).
Подставляя (12) в (10), получим (ППТ )Х = Сд + В .Отсюда Л = (ППТ) г(Сд + В). Подставляя Л в (12), получим
Шо = пт (ППТ )-г(ш + В). (13)
Дифференцируя по £ выражение (13) и подставляя ш в (5), получим
Пт (ППТ )-1Со = и + В, (14)
где U = J-1U, B = J-1 [(Juo хшо) + Мо] -M(¿о + В) - МВ, М = Пт(ППТ) 1. Умножая (14) на П, получим
ш = пи + пВ. (15)
Зависящий от вектора управления U первый член в правой части (15) зададим в виде
П U = -(signu)N, (16)
где (signw) — диагональная матрица (2 х 2) с элементами (signup), N — постоянный вектор с положительными элементами Nj, удовлетворяющими условию N > 1ПВ|j, где 1ПВli — абсолютные величины элементов вектора ПВ. Скалярно умножая (15) на ш, получим
д. 2
1dUf = -¿uT [(sign^)N + ПВ]. (17)
Известно [2], что в некоторый конечный момент времени ti наступает равенство ¿¿(t1) = 0. При этом левая часть (8) обращается в нуль. Тогда при t > t1 изображающая точка Ni(wi,wi) в фазовой плоскости (ui,Wi) будет двигаться в скользящем режиме вдоль линии разрыва
¿Л + = 0 (i = 1, 2), (18)
асимптотически приближаясь к точке й = ¿i = 0 по закону й = шi(Ut1)e-^i(t-tl), но не попадая в эту точку за конечный момент времени.
Для того чтобы приведение изображающей точки в начало координат Шг = ¿Ji = 0 (i = 1, 2) произошло за конечный промежуток времени, воспользуемся методом
безударного приведения состояния механических систем в заданное многообразие, предложенным в [3]. Суть этого метода заключается в замене многообразия (18), начиная с момента времени ¿1, другим многообразием
йг(т) ) + т = 0 (г = 1, 2), (19)
2^1 (г1)
где т = Ь — ¿1.
При этом в качестве квазискорости принимается выражение
й = йг(т) — иц(11) + ^^ г, (20)
1)
а за линию разрыва, вместо (18), принимается линия
"<(') = — ^(г)\. (21)
"2 У 0
Из (20) следует, что в момент времени
По = 2
¿i( h)
й ^1)
значение 0Ji(тi0) обращается в нуль, а из (21) следует, что значение ^(тю) тоже обращается в нуль в тот же момент времени т^о. Таким образом, приведение системы в положение й = й = 0 произойдёт без удара.
Теперь, используя (16), определим и. Для этого и ищем в виде
О = ПтЛ. (22)
Подставляя (22) в (16), получим (ППт)Л = — (signш) N.
Отсюда Л = —(ППт)-1(signш)N.
Теперь, учитывая О = 3-1О, из (22) определим
и = —3 пт (ППт )-1(signш)N, (23)
где П имеет вид (11), а элементы вектора й имеют вид (8) при 0 <1 ^ 11 и вид (20) при т = I — > 0.
2.3. Управление роботом в режиме торможения
Выше было доказано, что при управлении (23) в конечный момент времени t2 = ti + т0, где т0 = max по (i = 1, 2), ось Cz с ортом k3 системы координат Cxyz приводится в положение, совпадающее с линией визирования CCо. В этот момент времени t2 приложим в точку C, помимо силы Fn, ещё дополнительную силу FT, направленную по линии визирования CCo против кз. Сила FT, называемая силой торможения, призвана привести точку Оо крепления первого звена манипулятора к корпусу робота в точку О области досягаемости цели «рукой манипулятора». В качестве точки О примем точку линии CCо на расстоянии Ro = |CoO| от точки Co до точки О со стороны центра масс робота C. При этом величина Ro должна быть меньше максимально возможного расстояния max |OoOe|, где Oe — центр схвата,
прикреплённого к концу последнего звена манипулятора. Расстояние |ОоО| обозначим через 5, производную 5 по времени через V = 8, а их начальные значения соответственно через 8о и Уо. Для решения этой части задачи используем приём управления безударной стыковкой двух объектов, предложенный в работе [4].
Для этого запишем уравнение абсолютного движения центра масс С в проекции на линию визирования
т= -Я - и, (24)
где Уа — проекция вектора абсолютной скорости точки С, т — масса робота, Я' — проекция главного вектора неуправляющих сил, и — проекция силы РТ.
При движении робота по принципу пропорциональной навигации, навязываемом силой Рп, прямая С С о движется поступательно, то есть оставаясь параллельной самой себе. Принимая скорость движения точки Со за переносную, уравнение относительного движения точек С и Оо в проекции на линию визирования ССо запишем в виде, аналогичном (24):
¿V
= —Я - тае - и, (25)
где V — проекция относительной скорости точек С и Оо, ае — проекция переносного ускорения этих точек.
Искомое управление и представим в виде и = (иг + где иг — постоянная составляющая, а и2 — ступенчатая составляющая.
Силу иг зададим в виде
V 2
иг =т -о-, (26)
2 во
где 8о — начальное расстояние между точками Оо и О, Уо — начальное значение проекции относительной скорости V на ^Со|.
Заметим, что в случае Я' = 0 и ае = 0 уравнение (25) при управлении и = иг имеет вид
^ = - (27)
^ -во К '
Интегрируя (27) по , получим
V 2
V-Уо + ^ = 0. (28)
- оо
Заметим, что отсчёт времени £ ведётся, начиная с момента ¿2.
Из уравнения (28) определяется время 1г = 2Бо/Уо, при котором 5 и V одновременно обращаются в нуль. Таким образом, при управлении и движение изображающей точки N в фазовой плоскости (Б, V) происходит по кривой
5 = §М? -^2) (29)
от начальной точки ^(Бо,Уо) до начала координат Б = 0, V = 0. Заметим, что эта кривая (29) следует из теоремы об изменении кинетической энергии точки в конечной форме и является ветвью параболы.
Теперь обоснуем необходимость введения в управление кусочно-постоянной составляющей и2 и определим её выражение. При ае = 0, Я' = 0 в правой части уравнения (27) появляются слагаемые, при котором правая часть уравнения (28) не будет равняться нулю. Поэтому, с целью наделения решений уравнения (25) свойствами (28) и (29), предлагается следующая процедура.
Введём квазискорость
v = V -Vo + t, (30)
V 2 vo
2Бо
представляющую собой правую часть (28) при ае = 0 и К = 0. Выразим V через V:
V2
V = V + ^ — ^от*. (31)
2 во
Подставляя (31) и О = О1 + О2 в (25), в силу (26) получим
^ п &
т—— = —и2 — тае — К . т
Умножая это уравнение на V и внося V под знак дифференциала, получим
^ / ГГГ\ЛГ2
)
dt{ 2 ,= -V ( U2 + mae + R). (32)
Функцию mV2/2 , являющуюся знакоопределённой положительной, примем в качестве функции Ляпунова для стабилизации невозмущённого состояния (28).
Зададим U2 в виде
U2 = UosignV, (33)
где Uo — положительная величина, удовлетворяющая условию
Uo > lmae + R| + 5, 5 = const > 0. (34)
При этом правая часть (32) становится определённо отрицательной. В этом случае значение V обращается в нуль за конечный промежуток времени [2].
3. Управление манипулятором при захвате цели 3.1. Конструктивные особенности манипулятора
В момент времени Ь2 после приведения точки Оо в точку О начинается управление манипулятором для безударного захвата цели Со. Прежде чем приступить к решению этой задачи, кратко опишем основные конструктивные особенности манипулятора [5].
Пусть манипулятор состоит из цепочки п пар тел Т" и Т" (р = 1, 2,...,п), в которой Т" вращается относительно тела Т'и-1) предыдущей пары вокруг цилиндрического шарнира О¡/-1), а Т"" перемещается относительно Т" по заданной направляющей. Начало отсчёта перемещения в" тела Т" относительно Т" обозначим через Б". Введём также обозначения: I" = О("-1)Б , в" = Б"О", — углы поворотов звеньев друг относительно друга вокруг шарниров.
Будем считать, что вращения тел Т" вокруг шарниров О("-1), также как и перемещения Т" относительно Т", осуществляются электрическими двигателями, помещёнными со своими редукторами в точках О("-1) и Б". Следовательно, управление манипулятором осуществляется 2 п двигателями.
3.2. Программа движения схвата
В качестве программы движения схвата манипулятора примем закон движения центра схвата, помещённого в точку Oe на продолжении конца последнего звена манипулятора:
OOe = L(t). (35)
Вектор O0Oe выразим через lV и SV:
п
OOe = + Sv).
v=1
Тогда условие (35) можно представить в следующем виде:
п
lv + Sv) - L(t) = 0. (36)
V =1
3.3. Уравнения движения манипулятора
Принимая углы р„ и перемещения в качестве обобщённых координат в поступательно движущейся системе координат по закону движения точки С преследуемого объекта, движение манипулятора в целом можно представить системой 2 п уравнений Лагранжа второго рода:
* (И) - Ш=«•-+<и»«•
d (дТсЛ дТс Пп,( гпь , Ппттчлкп
я Us;)- dssc=q+(-cSv+a»uV )rV ,
(v = 1, 2,... ,n),
(37)
где Тс — кинетическая энергия манипулятора относительно подвижной системы координат Схуг с ортами к\, к2, к3, ,(^'1 — обобщённые неуправляющие силы, в том числе переносные силы инерции и силы тяжести элементов манипулятора, С", С" — коэффициенты сопротивления на валу двигателей, К", К" — передаточные числа редукторов, а", а" — коэффициенты пропорциональности между управляющими моментами двигателей и управляющими сигналами V", V".
Кинетическая энергия манипулятора имеет вид:
Т = \ФТА{<-Р)Ф,
где А(р) — симметричная определённо положительная матрица (2п х 2п), р мерный вектор обобщённых координат р„ (у = 1,2,... ,п). Систему уравнений (37) можно привести к виду:
Ар = /(р, Рр, 1) + Ви,
(38)
2n-
(39)
где В — матрица (2 п х к) распределения к-мерного вектора управления и между 2п уравнениями системы (37), к ^ 2п, / — вектор неуправляющих сил, в том числе возмущающих сил и сил инерции.
3.4. Построение выражения программного многообразия
Дифференцируя (36) по времени, получим
п
Ш = ^,(1 + 1). (40)
и=1
Представим векторы ,SV в виде = lviv, Sw = Sw (t)jv, где iv, — орты векторов lu, Su. Учитывая, что lu = |lu | = const, получим
If — If ъ v, Sy — Si/^v + Si/^v . (41)
Воспользуемся формулами Пуассона
xiu, jv = x jv. (42)
^=1 r\=1
Подставляя в (42) — фvk0, где к0 — орты векторов , получим
iv = ^(k0 x iи)фv, ju = kv x >. (43)
1 r\=1
Теперь подставим (43) в (41), а затем (41) в (40). Тогда (40) примет следующий вид:
п ( Г и 1 ^
фV + >%]„ \. (44)
i = it { Щ x (iv + sv) ф<п + sv~jv\.
v=1 ^ V=1 -I '
Г1=1
Потребуем, чтобы проекции вектора Ь на оси с ортами к\ и к2 были равны нулю:
Ь ■к1 = 0, Ь ■к2 = 0, (45)
а проекция на ось с ортом кз изменялась по закону
V 2
Уп
¿0 ~ 0 2 So
V = Vo — t,
где ¿о — расстояние между точками О и Со в начальный момент времени 12,Уо — начальное значение скорости сближения точки Ое с точкой Со.
Заметим, что отсчёт времени 1 ведётся, начиная с момента ¿2, то есть 1 ^ ¿2, где Ь2 — момент времени совпадения точек Оо и О. Следовательно, к условиям (45) присоединяется условие
^ У2
Ь ■кз = Уо - -о- г. (46)
2 оо
Условия (45) и (46) после замены Ь правой частью (44) представим в виде
Пф = С, (47)
где П — прямоугольная матрица-строка (3 х 2 п) с элементами
й1и =
кV х У ] (1ц + З-г/)
йз- =
к\ + (]„ • кх),
кV х У ] (1 -п + )
г\=1
к2 + (]" • к2),
кV ХУ у (^ + )
^=1
(48)
•кз + (]„ •кз), (и = 1, 2,..., 2п),
р — 2п-мерный вектор-столбец с элементами р„, С — трёхмерный вектор-столбец СТ (0,0,Сз),
V 2
Сз = Ъ - .
2 Зо
Таким образом, искомое программное многообразие выражается в виде (47).
(49)
3.5. Построение вектора управления манипулятором
Представим (47) в виде
0 = йр -С. (50)
Задача заключается в построении вектора управления манипулятором так, чтобы центр Ое схвата манипулятора, начиная движение с начальной скоростью V) от точки О, пришёл в точку С с нулевой скоростью относительно точки С, то есть в момент совпадения точек Ое и С абсолютные скорости этих точек должны быть одинаковы. При этом встреча точек Ое и С произойдёт без удара. Для этого вектор управления V в (39) необходимо построить так, чтобы вектор дд в (50) обратился в нуль за конечный промежуток времени при любых непрерывных и ограниченных значениях неуправляющих сил /(р,р, 1) в (39).
Для решения такой задачи продифференцируем (50) по и получим:
йр = д - йр + С. (51)
Определим решение трёх уравнений (51) относительно 2п элементов вектора р. Для этого ищем р в виде
р = йТЛ, (52)
где Л — искомый трёхмерный вектор.
Подставляя (52) в (51), получим (ййТ) Л = сд - йр + С. Отсюда
л = (ййТ)-1(д - йр + С). (53)
Теперь, определяя р из (39) в виде р = А-1Ви + А-1/ и подставляя в левую часть (52), получим
А-1Ви = йТ (ййТ )-1дд + X, (54)
где X — члены, не содержащие р и V.
Умножая (54) на й, получим дд = йА-1Ви - йХ. Теперь, скалярно умножая на дд, получим дд дд = дд йА-1Ви - дд йХ. Отсюда
1 НдО2 'Т 'Т
--= 0}1 йА-1Ви -доТ йХ. (55)
2 нг у J
Выберем значение ПА 1Ви в первом члене правой части кусочно-постоянным в виде
ПА~ 1Ви = -^пСи)М, (56)
где — диагональная матрица с элементами signc^)í (г = 1,2, 3), N — трёхмерный
вектор с постоянными положительными элементами
N > 5г + 1ПХ^, (1 = 1, 2, 3), (57)
где 6г — отличные от нуля заданные положительные постоянные, 1ПХ^ — абсолютные значения элементов трёхмерного вектора П Х.
Предположим, что размерность вектора и не меньше трёх. Тогда значение А~1 Ви в левой части (56) можно искать в виде
А- 1Ви = Пт\. (58)
Подставляя в (56), получим (ППТ )Х = —(sigпLд) N. Отсюда Л = -(ППТ )-1(^пО!) N.
Подставляя в (58), получим А-1Ви = -Пт(ППТ) 1(sigп¿J)N. Умножая на А, получим Ви = -АПТ(ППТ) (sigпLo)N. Умножая на Вт, получим
и = -(ВТВ )-1ВтАПт (ППТ )-1 (sigп¿J)N. 4. Заключение
Построены аналитические выражения главного вектора и главного момента сил, управляющих движением мобильного робота, оснащённого многозвенным манипулятором. При этих управляющих силах достигается движение робота по принципу пропорциональной навигации при погоне за непредсказуемо движущимся объектом. При этом точка крепления манипулятора к корпусу робота в конечный промежуток времени приводится в точку, находящуюся от преследуемого объекта на расстоянии досягаемости цели схватом манипулятора, чтобы избежать удара при контакте схва-та с захватываемым объектом. Построены соответствующие аналитические выражения сил и моментов управления поступательно и вращательно движущимися друг относительно друга звеньями манипулятора. При решении этой задачи используется лишь информация о расстоянии между схватом манипулятора и преследуемым объектом, благодаря применению методов, предложенных в работах [2-4]. Решение получено без использования информации о характере неуправляющих сил, в том числе возмущающих сил и сил инерции.
Литература
1. Кан В. Л., Кельзон А. С. Теория пропорциональной навигации. — Л.: Судостроение, 1965. — 423 с.
2. Пятницкий Е. С. Принцип декомпозиции в управлении механическими системами // Доклады АН СССР. — 1988. — Т. 300, № 2. — С. 300-303.
3. Мухаметзянов И. А. Самонастраиваемое управление процессом безударного приведения состояния механических систем в заданное многообразие // Вестник РУДН. Серия: Математика. Информатика. Физика. — 2013. — № 3. — С. 105112.
4. Мухаметзянов И. А, Чекмарёва О. И. Самонастраиваемое управление процессом безударной стыковки двух подвижных объектов // Вестник РУДН. Серия: Математика. Информатика. Физика. — 2013. — № 4. — С. 154-160.
5. Мухаметзянов И. А., Мухарлямов Р. Г. Уравнения программных движений ма-нипуляционных систем. — М.: Изд-во РУДН, 1989. — 60 с.
UDC h?A.?A:62-h6
DOI: l0.22?6?/2?l2-97?5-20l7-25-2A70A8l
Control over the Process of Unstressed Capture of Unpredictably Moving Target by the Robotic Arm I. A. Mukhametzyanov, O. I. Chekmaryova
Department of Theoretical Physics and Mechanics
Peoples' Friendship University of Russia 6, Miklukho-Maklaya str., Moscow, Russia, 117198
An algorithm is constructed for controlling a non-impact capture of unpredictably moving target by the robotic arm. Capture is performed in a finite time. The solution is obtained without the use of the information on the non-control forces, including the disturbing forces and forces of inertia.
The object is achieved in four stages. First, the principal vector of the forces is obtained, which provides movement of the center of mass of the robot body in the mode of persecution on the basis of proportional navigation in the pursuit of the object. Second, the principal moment of the forces about the center of mass of the body is obtained, which provides bringing of the one of the principal central axes of inertia of the moving coordinate system associated with the robot's body, in a position coinciding with the line of sight. Third, an additional driving force is determined, which provides the unstressed bringing of the attachment point of the first link of the arm with a robot body at a distance of "manipulator arm" from the target on the line of sight to provide capture. Fourth, the expression of forces and moments is constructed for the management of the translational and rotational motion of the links of the manipulator relative to each other, allowing bumpless capture of the pursued object.
The self-adjusting method is proposed to automatically select the optimal values of the control. It is carried out by the "principle of feedback on the quasi-acceleration" at discrete points in time. This principle was first proposed by I.A. Mukhametzyanov in an article published in the Bulletin of Peoples'Friendship University series "Mathematics. Information Sciences. Physics", No 3, 2013.
Key words and phrases: robotic arm, self-tuning control, unstressed, final time
References
1. V. L. Kan, A. S. Keljzon, Theory of Proportional Navigation, Sudostroenie, Leningrad, 1965, in Russian.
2. E. S. Pyatnitsky, Principle of Decomposition in the Management of Mechanical Systems, DAN SSSR 300 (2) (1988) 300-303, in Russian.
3. I. A. Mukhametzyanov, Process Self-Adjusting Control of Non-Impact Bringing of the Condition of Mechanics Systems to Given Set, PFUR Bulletin. Series: Mathematics. Information Sciences. Physics (3) (2013) 105-112, in Russian.
4. I. A. Mukhametzyanov, O. I. Chekmaryova, Self-Adjusting Control of Non-Impact Docking of Two Moving Objects, PFUR Bulletin. Series: Mathematics. Information Sciences. Physics (4) (2013) 154-160, in Russian.
5. I. A. Mukhametzyanov, R. G. Mukharlyamov, The Equations of Motion Program of Robotic Systems, PFUR, Moscow, 1989, in Russian.
© MyxaMeT3HHOB H.A., HeKMapëBa O.H., 2017
