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

МЕХАТРОНИКА И РОБОТОТЕХНИКА j

УДК 681.5.015

С. Л. Крутиков

БАЗОВЫЕ ИНЕРЦИОННЫЕ ПАРАМЕТРЫ МАНИПУЛЯЦИОННЫХ РОБОТОВ

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

E-mail: SERRK10@yandex.ru

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

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

Уравнение динамики манипулятора полностью определяется его кинематической схемой и инерционными параметрами. Кинематические характеристики манипулятора (в виде параметров Денавита-Хартенберга) обычно известны с достаточной точностью из конструкторской документации или данных САПР. Что же касается инерционных параметров, их также можно определить с помощью пакетов САПР, но такой способ дает довольно грубые результаты [1], которых недостаточно для реализации алгоритмов динамического управления. В связи с этим возникает задача идентификации инерционных параметров на основе данных о реальном движении манипулятора (положения, скорости, ускорения, силы и моменты в сочленениях). Проиллюстрируем постановку задачи идентификации на примере плоского двухзвенного манипулятора, кинематическая схема которого приведена на рис. 1. Известными полагаются геометрические параметры механизма — длины звеньев а1 и а2. Оценке подлежат массы

звеньев ш\, т2, статические моменты , , , и осевые моменты инерции , ¿2^. Кроме того, считается возможным в течение необходимого промежутка времени измерить углы в сочленениях (х, (2 и моменты приводов гх ,т2, а также вычислить или изме-

Оо

X.

От

4^2

а2

ХоО

ах

№

Рис. 1. Кинематическая схема плоского двухзвенного манипулятора

рить производные (¡г, (2 , (1, (2.

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

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

Основные понятия. Будем рассматривать N-звенный манипулятор как систему из N твердых тел, связанных кинематическими парами 5-го класса (поступательными или вращательными), соединенную с неподвижным основанием. Связи предполагаем идеальными голономными, а кинематическую цепь — не содержащей ветвлений и замкнутых контуров. С каждым звеном манипулятора связывается

подвижная система координат, положение которой относительно подвижной системы координат предыдущего звена определяется однородной матрицей перехода Аг(дг), где ^ — обобщенная координата ¿-го звена манипулятора, ¿ = 1,..., N. Положение системы координат ¿-го звена относительно абсолютной системы координат, связанной с неподвижным основанием, определяется соответствующей однородной матрицей перехода Тг(д1,..., дг), причем Тг = П\_1 Ак [2].

Динамика каждого звена такого механизма характеризуется набором из 10 независимых параметров: массы звена т; моментов первого порядка звена Би (и Е {х, у, г}), определяющих положение его центра масс в собственной системе координат; моментов второго порядка звена (и,ь Е {х,у,г}) (осевых и центробежных моментов инерции) в собственной системе координат.

Эти параметры будем называть элементарными инерционными параметрами звена. Вектор рг = [Рхх Рху Рхх Руу Рух Ргг Б!х Б'у Бгг тг]т, составленный из этих параметров, будем называть вектором элементарных инерционных параметров ¿-го звена. Совокупность элементарных инерционных параметров всех звеньев манипулятора будем называть элементарными инерционными параметрами манипулятора, а вектор р = [р1... рМ]т, составленный из этих параметров, — вектором элементарных инерционных параметров манипулятора. Очевидно, что рг е Л10, а р е Л10м.

Кинетическая энергия манипуляционного механизма является квадратичной формой относительно обобщенных скоростей манипулятора, причем коэффициенты этой квадратичной формы зависят от обобщенных координат и инерционных параметров манипулятора [2]:

1 N N / N

к (я,я,р) = 2 ЕЕНг Е икгнк) т. (1)

г=1 .7=1 \ к=тах(г,]]

В выражении (1) матрица и. есть частная производная вида дТг/дд., а Нг — матрица инерции ¿-го звена, имеющая вид

тг тг тг сг

1хх 1ху ^хх сх

тг тг тг сг

1ху 1гуу 1гух су

тг тг тг сг

^хх 1гух 1 хх сх

сх су Сх тг Что касается потенциальной энергии манипуляционного механизма, то ее можно разделить на две составляющие, одна из которых зависит от инерционных параметров, а другая — нет: П = Пин + Пнеин. Ограничимся рассмотрением манипуляторов, работающих в наземных условиях. Тогда Пин всегда будет представлять собой потенциальную энергию сил веса, причем Пин = Пин(я, р), а Пнеин — потенциальную

энергию сил и моментов приводов (в простейшем случае), а также любых внешних сил, действующих на механизм (например, силы сопротивления окружающей среды или силы реакции при сборке). Если Q — вектор обобщенных сил, который включает в себя все внешние силы, действующие на манипуляционный механизм и не зависящие от инерционных параметров, приведенные к обобщенным координатам, то можно записать Qт = — дПнеин/дц. Здесь и далее под потенциальной энергией манипулятора П будем подразумевать только ту ее часть, которая зависит от инерционных параметров манипулятора, т.е. Пин. Тогда выражение для потенциальной энергии манипулятора имеет следующий вид [2]: ^

П(я, р) = — [ет0] £ ТкИк [ 0 0 0 1 ]т , (2)

к= 1

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

Найдем частные производные кинетической и потенциальной энергии манипулятора по 1-му инерционному параметру к-го звена р1к:

N N

О Т-г

^ = 2ЕЕ * (^Гг- ) * j' °Pk 2 i=1 j= 1

д П

T = - [gT 0] TkDHlk[ 0 0 0 1 ]т ,

дрк

где БИк = дИк/дрк.

Можно заметить, что матрица БИ1к числовая, а значит, найденные частные производные не зависят от инерционных параметров манипулятора. Из этого следует, что энергия манипулятора линейна относительно них. Тогда выражения (1) и (2) можно записать в виде

К(я Я, р) = ^к^ я)р; (3)

П(Я, р) = wя(q)p, (4)

где wк = дК/др и wП = дП/др — вектор-функции 1 х 10^ векторных аргументов. Элементы этих вектор-функций и подобным образом определяемые величины будем называть коэффициентами влияния, поскольку они характеризуют вклад соответствующего параметра в суммарное значение. Можно показать, что рассматриваемые здесь коэффициенты влияния являются векторами в бесконечномерном линейном векторном пространстве непрерывных функций, определенных на всем пространстве {я, Я}. Поэтому далее будем работать с такими функциями именно с этой точки зрения.

Теперь запишем уравнение движения манипуляционного механизма с помощью уравнений Лагранжа второго рода:

= Q, (5)

'd ídL\ dL

dt \0q) дq

где L — функция Лагранжа манипулятора. Она определяется как

L^ q, Р) = K ^ q, p) - П (q, p),

или с учетом выражений (3) и (4)

L(( q, p) = Wk^ q)p - w^(q)p = с^ (6)

где wL = wK — wП — вектор 1 х 10N коэффициентов влияния элементарных инерционных параметров на функцию Лагранжа манипулятора. Перепишем уравнение движения манипулятора, учитывая равенство (6):

d (dwL\ дw

p = Q.

dt \ dq ) дq Обозначив выражение в квадратных скобках как WEM , получаем

Wem (q, q, q)p = Q. (7)

Матрица WEM рассматривается здесь и далее не как функциональная матрица размера N х 10N, а как система из 10N вектор-функций размерности N х 1. Эти вектор-функции будем также называть коэффициентами влияния, поскольку они аналогичны по смыслу введенным ранее с той лишь разницей, что они не скалярные, а векторные. Очевидно, что векторные коэффициенты влияния образуют бесконечномерное линейное векторное пространство вектор-функций, определенных на всем пространстве {q, q, q}.

Таким образом, отметим, что уравнение динамики манипулятора также линейно относительно инерционных параметров. Этот факт позволяет осуществлять их оценку с помощью следующей процедуры. Измерим движение манипулятора, т.е. обобщенные положения, скорости, ускорения, а также силы и моменты приводов, на некотором промежутке времени в (m > 10) точках. Затем составим матрицу W и вектор y следующим образом:

L

Wem (q(ti), q(ti), q(ti)) " Q(ti) "

W = , У =

Wem (q(tm), q(tm), q(tm)) Q(tm)

Учитывая равенство (7), получаем следующую систему линейных алгебраических уравнений относительно вектора элементарных инерционных параметров:

Ж р = у. (8)

Решая эту переопределенную систему уравнений, например с помощью метода наименьших квадратов (МНК), найдем искомые значения неизвестных параметров. Однако в действительности ранг основной матрицы системы (8) всегда оказывается меньше числа неизвестных (т.е. 10^) [3]. Это приводит к неоднозначности решения, поскольку их становится бесконечно много. Получаемое решение зависит от начального приближения МНК. Очевидно, что такая оценка параметров не годится, ведь для конкретного механизма требуется единственное решение. Поскольку дефект ранга основной матрицы системы (8) связан с линейной зависимостью коэффициентов влияния элементарных инерционных параметров, единственности решения можно добиться только понизив ее порядок так, чтобы число неизвестных стало равным значению гапк(Ж).

Ранее было отмечено, что элементы wь являются векторами в бесконечномерном линейном пространстве. Очевидно, что это утверждение справедливо и для Ь(я, Я, р). Тогда вектор-функция wь(q, Я) представляет собой систему из 10^ векторов этого пространства, а выражение (6) — разложение вектора Ь(я, Я, р) по векторам этой системы. Пусть ранг системы векторов wь равен гь, тогда можно записать

^ ¿1, р) = ^^ь^ ¿1)р^ (9)

где ь(я, — вектор-функция размерности 1 х гь, элементы которой образуют базис системы векторов wь, а рь € ЯТь — вектор-столбец, представляющий собой коэффициенты базисного разложения вектора Ь(я, Я, р). Вектор рь будем называть вектором базовых инерционных параметров уравнения движения манипулятора.

Теперь найдем, как вектор базовых инерционных параметров уравнения движения связан с вектором элементарных инерционных параметров. Пусть Уь — матрица размера гь х 10N коэффициентов разложения системы векторов wь по базису ь, так что

wь = ьУь, (10)

т.е. элемент УЬ этой матрицы представляет собой проекцию вектора wЬ на базисный вектор лугь. Очевидно, что ранг Уь равен гь. Тогда равенство (6) может быть переписано в виде Ь = ьУьр, откуда с учетом равенства (9) следует, что вектор базовых инерционных параметров уравнения движения манипулятора может быть выражен через вектор элементарных инерционных параметров:

р ь = Уьр. (11)

Перепишем уравнение динамики манипулятора (5) с учетом соотношения (9) как

й ( дW ь\ дW ь

dt \ дq ) dq

Р L = Q

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

^ем(я, Я, Я)рь = Q. (12)

Матрица ем имеет размер N х гь и представляет собой линейно независимую систему из гь вектор-функций размерностью N х 1 каждая. Это значит, что основная матрица системы уравнений (8) будет иметь максимальный ранг, а сама эта система — единственное решение. Таким образом, запись уравнения движения манипулятора в терминах базовых инерционных параметров позволяет успешно решать задачу параметрической идентификации его динамической модели. Кроме того, очевиден выигрыш в быстродействии при решении ОЗД на цифровых вычислительных машинах вследствие исключения избыточных вычислительных операций.

Алгоритм определения базовых инерционных параметров. В настоящее время существует несколько основных способов поиска базовых инерционных параметров. Халил и Клейнфингер [4] разработали прямую численную процедуру для определения базовых параметров. Она заключается в автоматическом получении уравнения движения манипулятора в форме Лагранжа-Эйлера, определении матрицы коэффициентов влияния инерционных параметров и, наконец, поиске линейно зависимых столбцов этой матрицы. Хотя с помощью этого алгоритма можно получить решение для любого манипулятора, время его работы довольно велико и существенно возрастает с увеличением числа звеньев. Готье и Халил [5] получили рекуррентные соотношения в аналитическом виде для группировки инерционных параметров манипуляторов с произвольной ветвящейся кинематической схемой. Однако этот способ не дает полного решения, а лишь позволяет получить верхнюю границу числа базовых инерционных параметров. Кроме того, поскольку этот метод основан на анализе энергии манипулятора, невозможно понять, какое влияние оказывают полученные базовые параметры на движение механизма (нет связи с уравнением движения). Майеда, Йошида и Осука [3] предлагают аналитическое решение, основанное на уравнении движения в форме Ньютона-Эйлера в символьном виде. Этот метод учитывает физический смысл инерционных параметров, однако он применим только к манипуляторам с вращательными сочленениями, причем оси вращения соседних сочленений должны быть параллельны или перпендикулярны. Таким образом, ни один из перечисленных методов полностью нас не устраивает, в связи с чем был разработан собственный метод. Далее рассмотрены его основные идеи.

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

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

Пусть Г — пространство непрерывных функций, определенных на множестве {я, Я}. Пусть Г2 — некоторое конечномерное подпространство пространства Г размерности г2 такое, что система векторов wь принадлежит этому подпространству. Обозначим базисное множество Г2 как , а вектор-строку, составленную из элементов , как Ь. Обозначим матрицу координат векторов wL в базисе пространства Г2, как Ъ. Тогда очевидно следующее равенство:

w ь = ЬЪ. (13)

Пусть у — матрица координат векторов Ь в базисе пространства Г2. Тогда можно записать

лл ь = Ьу. (14)

Следует отметить, что система столбцов матрицы у является базисом для системы столбцов матрицы Ъ, так как система векторов \Ъь является базисом для системы векторов wь. Вектор-функции wь и ЛЪь связаны соотношением (10). С учетом равенств (13) и (14) оно примет вид ЬЪ = ЬЪУЬ. Поскольку это равенство должно быть справедливо для любых базисов Ь, можно получить следующую формулу для определения матрицы Уь:

Уь = (ут у)-1 утЪ. (15)

Ранее было показано, что матрица Уь полностью определяет вектор базовых инерционных параметров. Однако для вычисления этой матрицы необходимо сначала найти матрицу у, которая, в отличие от матрицы Ъ, заранее неизвестна. В самом деле, алгоритм получения кинетической и потенциальной энергии определен, вектор элементарных инерционных параметров — тоже, следовательно, нетрудно найти вектор их коэффициентов влияния. Далее можно найти матрицу координат Ъ, полагая известным базис (или закон формирования базиса) пространства Г2. Это справедливо, так как можно задать этот базис с одним лишь условием: пространство Г2 должно содержать систему векторов wь. Матрица у неизвестна, как и \Ъь. Ее можно найти

с помощью следующего простого алгоритма: привести матрицу Ъ к ступенчатому1 виду и определить индексы столбцов, содержащих ступеньки, т.е. первые слева в своей строке ненулевые элементы. Легко показать, что система этих столбцов будет формировать базис матрицы Ъ, т.е. фактически задавать Ъ. Следовательно, элементы системы векторов wь с соответствующими индексами будут образовывать ее базис, т.е. #ь.

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

• поиск некоторого подпространства в пространстве функций, определенных на {я, Я}, базис (или алгоритм формирования базиса) которого известен заранее, такого, что система векторов принадлежит этому подпространству;

• нахождение координат векторов системы в найденном подпространстве и составление из них матрицы Ъ;

• приведение матрицы координат Ъ к ступенчатому виду и определение индексов столбцов, образующих базис системы столбцов этой матрицы;

• определение координат базиса системы векторов в искомом подпространстве как столбцов исходной матрицы координат Ъ с найденными на предыдущем этапе индексами и составление из них матрицы Ъ;

• вычисление на основе полученных матриц Ъ и Ъ, матрицы Уь, определяющей вектор базовых инерционных параметров через известный заранее вектор элементарных инерционных параметров.

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

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

Теорема2 (о базисном множестве). Система векторов полностью принадлежит конечномерному линейному векторному про-

1 Говорят, что прямоугольная матрица имеет ступенчатый вид, если номер столбца первого ненулевого элемента г-й строки больше номера столбца первого ненулевого элемента (г — 1)-й строки, г = 2,... ,т, где т — номер последней ненулевой строки (предполагается, что все ненулевые строки идут подряд).

Доказательство теоремы приведено в приложении.

странствуразмерности (N2 + N) • 5V • 3N v/2 + 3V • 2N v, задаваемому базисным множеством следующего вида:

вр2 = {{{2q?= 1 ...n}u{m3,i = 1 ...Nj = (i + 1)...N}

* {1, cos qh, sin qh, cos 2q^, sin 2q^ } * • • • * * {1, cos qiv, sin qiv, cos 2qlv, sin } *

* {1,qiv+i, qlV+1} * • • • * qiN}|U U {{1, cosqh, sinqh] * • • • * {1, cosqiv, sinqiv)*

* {1,qiv+4 *•••* (1,qi^},

где N — полное число звеньев манипулятора, а v — число вращатель-

3

ных звеньев .

Под операцией, обозначенной *, упрощенно понимается следующее: если имеются множества A = {ai, i = 1,..., m} и B = {bi, i = = 1,... , n}, то множество C = A * B будет иметь вид {aibj, i = = 1,..., m, j = 1,..., n}, причем |D| = |A| • |B

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

Рассмотрим однозвенный манипулятор с кинематической схемой, приведенной на рис. 2. Запишем выражения для кинетической и потенциальной энергии рассматриваемого манипулятора

K = 1 q2 + 4/ + 2aiSX + a2mi) ,

П = д (с^ — + агвгш^ .

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

Р = 171 Т1 Т1 Т1 Т1 Т1 91 <?1 91 ш "Г

Н \_±хх ху хг уу уг гг^х^у^г"1'1]

Найдем коэффициенты влияния элементарных инерционных параметров на функцию Лагранжа. Вообще говоря, определять выражения

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

Wl =

1 q2 002 q2 q2!-gci gsi o2 a2 q2-ai gci

Пусть базис системы векторов wL имеет вид

WL = [1 q? —gc1 gs J . Тогда вектор базовых инер-

„ Л т/. ционных параметров манипулятора равен

Рис.2. Кинематиче- г г J r г

ская схема одно- p= \l1xx + I1V + 2a1 SX + a?m1 S\ + a,m1 Si]т . звенного манипуля- L xx yy 1 x 11 x 11 yj

тора Очевидно, что эта пара (WL, p) является реше-

нием, поскольку WL — система линейно независимых векторов, и \v L p = K — П.

Теперь получим решение с помощью предлагаемого метода и сравним его с приведенным ранее. Сформируем базисное множество вспомогательного пространства F? в соответствии с теоремой о базисном множестве:

вр2 = {2q?, 2q?cos q1,2q?sin q1,1 q? cos2q1,

12 i -q? sin2q1, 2, cos q1, sin q1 >.

Найдем координаты векторов wlL и составим из них матрицу

2 0 0 2 0 0 2a1 0 0 a?

000000 0 00 0

0 0 0 0 0 0 0 0 0 0

0 0 0 0 0 0 0 0 0 0

0 0 0 0 0 0 0 0 0 0

0 0 0 0 0 0 0 0 0 0

Z =

000000 -g 00 -ai g

0 0 0 0 0 0 0 g 0

0

Матрицу Z необходимо привести к ступенчатому виду. Однако в нашем случае она фактически уже приведена к нему: очевидно, что, переставляя 2-ю и 7-ю, а также 3-ю и 8-ю строки, мы получаем искомую матрицу. Тогда базис системы столбцов матрицы Z образуют

1, 7 и 8-й столбцы. Соответственно базис системы векторов бу-

"1 "

дет иметь вид ^ =

2

•2 -2

?i чгх -gci gsi

, а матрица координат его

компонент Z записывается так

Z =

1 0 0 0 0 0 0 0 2а1 0 0 0 0 0 -g 0 0 00000 0 g _

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

1 0 0 1 0 0 0 0 0 -а\ п У= 000000100

0 0 0 0 0 0 0 1 0 0 Тогда вектор базовых инерционных параметров будет равен

р = Ур = [1Хх + 11у — а\ш\ Б1 + а1Ш1 БУ1]т .

Легко проверить, что этот результат соответствует полученному аналитически решению, т.е. wьр = ьр , где индекс Д соответствует аналитическому решению, а индекс Ч — решению с помощью предложенного метода. Отметим, что последнее решение имеет несколько более компактную форму в части базовых инерционных параметров, а первое — в части коэффициентов влияния базовых параметров. Особенно хорошо это будет заметно при рассмотрении механизмов с большим числом звеньев.

Вернемся теперь к плоскому двухзвенному манипулятору (см. рис. 1). Запишем следующие выражения для кинетической и потенциальной энергии механизма:

К = 2 ^Хх + ^у + 2а1 БХ + а1 т1 + 4х + 1уу + 2(а1С2 + а2) БХ 2а1 ^Б^ + (а1 + а2 + 2а1а2С2)т2) + <21<22(1ХХ + + (а1С2 + 2а2 )БХ —

— а^Б^ + (а2 + а1 а2С2 )т) + 1 ^(^Хх + ^у + 2а2БХ + а2т2),

П = д (С1БХ — + а1С1т1 + С12БХ — в^Б^ + (а1С1 + а2С12) тг) .

Тогда вектор элементарных инерционных параметров и вектор их коэффициентов влияния будут иметь следующий вид:

н

О

О

CS Ö

1 ся

с

н | СЯ

CS CS •Cq CS CS •Cq

U4 T—1 I СЯ + T—1 I C\| +

U4 cg

cg ö

CS CS

1 со о 1 о о

CS ^ч 5g CS ^ч •Cq •Cq

•Cq •Cq 1 1

CS ^H + +

ö Ö CS •Cq T—1 I СЯ CS •Cq T—1 I C\|

T—1 I СЯ

CS

•Cq

CS

Ö CS

+ со

CS g

•Cq -L

•Cq CS

^—^ •Cq

CS

Ö •Cq

СЯ CS

со

4-

\ ö

CS

О 1

Ö CS

•Cq

CS

+ со

CS Ö

•Cq |

^""cN

Ö _l_

CS

О

cscs •cq

CS CS Ö -ч | СЯ

•cq •Cq

О

CS CS Ö

•Cq

О

Ö ся

CS CS Ö

1 ся

а н 1

Со Со Со

'S.,8 с? сТс?

Проанализировав выражения коэффициентов влияния, можно найти решение в виде следующей пары (\Ур):

W L =

•2

qi -gc\ gsi qiq2 ^

1

^ +2q2 aic2 (q2 + qiq^ - gci2 - «1^2 (q2 + q^) + gsi2

p =

!xx + iyy + 2aiSi + aimi + ^Жж + !yy + 2a2Sa; + (a2 + «l)

a2)m2

Sx + aimi + aim2 S i

Sy

2

/'хх + /2у + 2а2Бж + а2т2

+ а2тх Бу

Проверка справедливости этого утверждения осуществляется так же, как и в предыдущем примере.

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

1

W l =

2

q2

aiqi - gci gsi

1 -2 • • 1 -2

2 q2 + qiq2 + 2 q2

(aiC2 + «2) q2i + (ад + 2«2) q^ + 0^2 - gci2

— /

P =

+ /Улу — а{т1 — а2т2 &1 + а1т1 + а1т2 91

1 хх + /уу — а2т2

Б+ а2т2

Бу

Отметим, что этот результат был получен с помощью программы, реализующей алгоритм поиска в пакете МаНаЪ. Аналитическое и численное решения эквивалентны, т.е. ^у^р^ = чу^р4. Кроме того, аналитическое решение более компактно в части коэффициентов влияния, а численное — в части базовых инерционных параметров.

Последний пример иллюстрирует, скорее, фактическую невозможность решить задачу предложенным методом аналитически, нежели

реальное его использование. Это связано с быстрым возрастанием размерности пространства ^2 (а значит, и матрицы координат коэффициентов влияния) при увеличении числа звеньев манипулятора: уже для двухзвенника она составляетт 84 х 20 элементов. Поэтому очевидна необходимость разработки соответствующих численных процедур.

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

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

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

В заключение автор выражает благодарность научному руководителю профессору С.Л. Зенкевичу за плодотворное обсуждение

основных моментов работы, а также заведующему кафедрой РК10 МГТУ им. Н.Э. Баумана, профессору А.С. Ющенко за методические указания по изложению материала статьи.

Приложение. Из всех утверждений теоремы о базисном множестве в доказательстве нуждается лишь факт принадлежности векторов wL линейному пространству, задаваемому базисными векторами из множества ßF . Действительно, линейная независимость системы векторов, получаемой по указанному в теореме алгоритму, очевидна. Как, впрочем, и размерность задаваемого ими пространства, равная числу векторов в сформированном базисе. Тогда для доказательства теоремы достаточно показать, что любой вектор wL может быть представлен в виде линейной комбинации векторов из указанного базисного множества и только их.

Проанализировав выражение матрицы перехода от системы координат k-го звена к системе координат (к — 1)-го звена3, можно заметить, что

A _ Е Ak 4, (16)

1=1

где xk е Xk, mk = |Xk|, Xk = {1, cos qk, sin qk} в случае вращательного звена и Xk = {1, dk} — в случае поступательного звена, а Alk — постоянные матрицы, зависящие от геометрических параметров. Матрица перехода от системы координат k-го звена к абсолютной системе координат определяется соотношением Tk = Ai... Ak. С учетом равенства (16) это соотношение запишется в виде

тк = (£ A1 x^j ...(EAk 4k

Раскрывая скобки, получаем

тох т*

4 = Е... Е (41 ...4") 4* ...41.

¡1=1 г*=1

Обозначим выражение в круглых скобках как 41 •г". Тогда имеем

т.1 т*

тк = Е... Е Тг^1-1* ...4.

¡1=1 г*=1

Теперь запишем выражение для коэффициента влияния 1-го инерционного параметра к-го звена на потенциальную энергию механизма. С учетом последнего соотношения оно примет вид

д П т1 т*

дП = — Е ... Е Ы* 0] Т"1^ [0 0 0 1]Л х" ...Х!1 .

др" ¡1 = 1 г*=1

Отметим, что выражение в круглых скобках является постоянной величиной. Обо-

10("-1) + 1'

значая его как DPl0(fcгk1)+г, а также имея в виду, что х1 = 1 (г = 1,..., N), получаем

Я П m1 mk

дП _ _ у^ Vnp¡1 -Ik xii xikX1 X1 fbj _ Z^ . . . Z^ DP10(k-1)+IX1 . . . Xk Xk+1 ...xN. dPk Ii = 1 I k = 1

3 Предполагается, что они построены по алгоритму Денавита-Хартенберга [2].

Рассмотрим частные производные Uki = dTk/dqi. Они могут быть вычислены следующим образом [2]:

TT =\ 0, k < i;

Uki = \ A ...DA ...Ak, k > i,

где Di — постоянная матрица. Тогда с учетом соотношений (16) имеем

(mi \ / то, \ / mk \

A1 Х[Л ...Dil 5 Ai xM ..Л 5k .

ii = i / \г,=1 / Vk=i /

Раскрывая скобки, получаем

Uki = Е... Е № ...DA ...Aí

ТО1 Ток

¡1=1 ¡к=1

Обозначим выражение в круглых скобках как йы'1*. Тогда последнее соотношение можно переписать в виде

TOI TOk

и, = Е... Е UrJk xkk ...x 1. (17)

¡i=i ik=i

Теперь рассмотрим матричное произведение Uj Uki. Воспользовавшись равенством (17) запишем

т

TOi TOk \ / TOi TOk

Ukj Uki = IE... Z Urik xkk... xi1 ) E.. ^ ^ik xkk... x i1

iií=i i',= i / Vii=i ik=i

Раскрыв скобки, получим

mi mi TOk TOk т

uj Uki = ЕЕ... ЕЕ [ (Uky • • ik) Ui • • • ikl xkk xkk ...x ii x ^. (is)

i'=iii=i i'=iik=i

Нетрудно убедиться, что выражение

mk mk

ЕЕ («i' ei)

ai' ei) xk xk >

i'= i=

где аг, и в; — некоторые постоянные коэффициенты, может быть представлено для любых к в виде следующей линейной комбинации:

rk

,то

I my

m=

Е YmC

где yj. G Yfc, rfc = |Y{ |, Yfc = {1, cos qfc, sin qfc, cos 2qfc, sin 2qfc} — в случае вращательного звена и Y^ = {l,dk, — в случае поступательного звена. Применяя такое преобразование в равенстве (18) последовательно k раз, очевидно, получим

rk

uj и, = Е • ik ykk ...^

¡1=1 ¡к=1

где Цу V ' ¡к — некоторая постоянная матрица. Тогда выражение для коэффициента влияния 1-го инерционного параметра к-го звена на кинетическую энергию меха-

низма примет вид

ятт 1 _N _N JTL

dK = 1 £ £ £... £ tr (%• ¡kDHk) yk... yl1 ^.

lk i=1 j = 1 ¡1 = 1 ¡k = 1

Принимая во внимание симметричность матрицы квадратичной формы кинетической энергии, а также имея в виду, что у! = 1 (г = 1,..., N), окончательно получаем

dK = £ ... £ £tr • • DHk) 1 +

Fk ¡1 = 1 ¡k = 1 L i=1

N i-1

+ ££tr (%• • ¡kDHk) 4iqj

i=2 j=1

¡1 ¡k 1 1 У11 ...ykk yfc+1 ...yN.

Коэффициенты при квадратах и смешанных произведениях обобщенных скоростей являются постоянными величинами, но по определению

~ 10("-1)+г_ дЬ _ дК дП

дРк

dplk

dplk

Из полученных выражений для коэффициентов влияния (10(к — 1) + 1)-го инерционного параметра на кинетическую и потенциальную энергию ясно, что коэффициент влияния этого параметра на функцию Лагранжа является линейной комбинацией указанных в теореме базисных векторов. Поскольку индексы к и 1 пробегают значения от 1 до N и от 1 до 10 соответственно, этот вывод справедлив для всех инерционных параметров механизма; следовательно, теорема доказана.

L

СПИСОК ЛИТЕРАТУРЫ

1.Atkeson C h. G., An C. H., Hollerbach J. M. Estimation of inertial parameters of manipulator loads and links. Intl // Journal of Robotics Research. -1986. - Vol. 5. No. 3. - P. 101-118.

2. З е н к е в и ч С. Л., Ю щ е н к о А. С. Основы управления манипуляционными роботами. - М.: МГТУ им. Н.Э. Баумана, 2004.

3. Mayeda H., Yoshida K., Osuka K. Base parameters of manipulator dynamic models // IEEE Trans. on Robotics and Automation. - 1990. - Vol. 6. No. 3. - P. 312-320.

4. K h a l i l W., Kleinfinger J.-F. Minimum operations and minimum parameters of the dynamic models of tree structure robots // IEEE Journal of Robotics and Automation. - 1987. - Vol. RA-3. No. 6. - P. 517-525.

5. Gautier M., Khalil W. Direct calculation of minimum set of inertial parameters of serial robots // IEEE Trans. on Robotics and Automation. - 1990. - Vol. 6. No. 3. - P. 368-372.

Статья поступила в редакцию 26.05.2010

Сергей Леонидович Крутиков родился в 1985 г., окончил МГТУ им. Н.Э. Баумана в 2008 г., получил степень магистра техники и технологии по направлению "Автоматизация и управление". Аспирант кафедры "Робототехнические системы" МГТУ им. Н.Э. Баумана. Специализируется в области робототехники.

S.L. Krutikov (b. 1985) graduated from the Bauman Moscow State Technical University in 2008, defended Master's degree in engineering and technology for "Automation and Control". Post-graduate of "Robotic Systems" department of the Bauman Moscow State Technical University. Specializes in the field of robotics.