Наука к Образование
МГТУ им. Н.Э. Баумана
Сетевое научное издание
Наука и Образование. МГТУ им. Н.Э. Баумана. Электрон. журн. 2015. № 11. С. 12-30.
ISSN 1994-0408
Б01: 10.7463/1115.0826673
Представлена в редакцию: Исправлена:
© МГТУ им. Н.Э. Баумана
УДК 621.865.8
Модифицированная система координат Денавита-Хартенберга для исполнительных механизмов роботов с древовидной кинематической структурой
Ковальчук А. К
10.10.2015 29.10.2015
1,*
а!ек&апФ-а1е?&сгуг@уапс1ех.ли 1МГТУ им. Н.Э. Баумана, Москва, Россия
Предложена модифицированная система координат Денавита-Хартенберга, являющаяся результатом совместного применения методов теории графов и системы координат Денавита-Хартенберга, разработанной для описания кинематики исполнительных механизмов роботов с линейной разомкнутой кинематической цепью. Она позволяет формировать математические модели исполнительных механизмов роботов, имеющих древовидные кинематические структуры. Введены понятия основных и вспомогательных систем координат. Рассмотрен пример формирования матрицы достижимости и графа достижимости звеньев для древовидного исполнительного механизма роботизированного манекена. Эффективность использования предлагаемой модифицированной системы координат Денавита-Хартенберга показана на примерах математического описания кинематики и динамики древовидных исполнительных механизмов конкретных роботов, рассмотренных в опубликованных ранее работах. Показано, что предложенная система координат может с успехом применяться и для описания исполнительных механизмов роботов с линейной разомкнутой кинематической цепью, являющейся частным случаем древовидной кинематической структуры. Отсутствие в ней узлов ветвления не требует введения вспомогательных систем координат, а параметры Щ) и ш^) необходимы только для формальной записи уравнений, которые для древовидной и линейной цепей имеют одинаковый вид. В таком случае модифицированная система координат и традиционная совпадают.
Ключевые слова: древовидный исполнительный механизм, система координат Денавита-Хартенберга, кинематическая схема робота, проектирование исполнительного механизма робота, уравнения кинематики и динамики робота
Введение
Методам математического описания кинематики и динамики ИМ роботов посвящена обширная литература [1-6]. Авторы рассматривают ИМ как линейную разомкнутую кинематическую цепь, что характерно для промышленных роботов и манипуляционных
устройств специального назначения. Наибольшее распространение получили два метода описания кинематики и динамики ИМ таких роботов.
Первый метод основан на использовании блочных матриц [7, 8]. Он позволяет получать уравнения кинематики ИМ как в аналитической, так и в алгоритмической формах. Важно отметить, что для практического использования данного метода авторами разработано программное обеспечение, позволяющее исследовать и проектировать исполнительные системы роботов, в том числе и с упругими звеньями. В работе [9] рассмотрен пример использования данного метода к построению модели кинематики ИМ промышленного робота с разветвлённой кинематической структурой (КС) схвата.
Второй метод описания кинематики ИМ роботов предложили Денавит (J. Denavit) и Хартенберг (R.S. Hartenberg) в работе [10]. Он основан на использовании матриц однородных преобразований (4x4), дающих однозначные и чёткие правила построения математической модели ИМ робота. При этом число параметров, входящих в матрицу Ai относительного положения последовательных звеньев ИМ, минимально, и естественным образом определяет взаимное расположение последовательных звеньев ИМ. Вид матрицы Ai одинаков как для вращательного, так и для поступательного сочленений.
Существенным преимуществом такого метода построения связанных СК является то, что можно указать только четыре параметра, определяющих относительное положение двух последовательных СК i-1 и i, а следовательно и матрицу пересчёта Ai.
Итоговая матрица Ai, связывающая СК i-1 и i имеет следующий вид [10]:
At =
cos(Oi) —cos(ai) ■ sm(0j) sin(ai) ■ sin
ßi) at ■ cos(0j)
sm(0j) cos(cij) ■ cos(0j) — sm(cij) ■ co;;(0щ ■ sin(0j)
0 sm(cij) cos(cij)
0 0 0
dt
(1)
Из четырёх параметров (0Ь аь а^, входящих в выражение (1), два параметра а^ и а^ всегда постоянны и определяются конструкцией ИМ робота. Один из двух других параметров (0£ либо й) является переменным. Для вращательного сочленения величина 01 характеризует угол относительного поворота звеньев 1-1 и I, а линейная величина й постоянна. Для телескопического соединения наоборот, переменной величиной является й. Переменную величину 1-го сочленения (0£ или й) обычно называют обобщённой координатой ИМ робота.
При построении кинематических моделей роботов данный метод получил наибольшее распространение среди разработчиков из-за его наглядности и привязки к конструктивным параметрам ИМ.
Однако попытки использовать данный метод к описанию роботов, ИМ которых имеют древовидную КС, выявили определённые сложности его применения.
1. Актуальность
При создании шагающих роботов (ШР), получивших интенсивное развитие в последнее время, у разработчиков возникла проблема математического описания кинематики и динамики их ИМ, представляющих собой пространственные древовидные КС с большим числом степеней подвижности. Использование известных методов, дающих хорошие результаты для описания ИМ роботов с линейной разомкнутой кинематической цепью, не всегда приемлемо для описания ИМ, имеющих древовидные кинематические цепи.
Важно и то, чтобы полученные этими методами математические модели кинематики ИМ могли быть использованы при построении уравнений динамики и алгоритмов управления движением роботов.
Поэтому разработка новых эффективных методов построения математических моделей кинематики и динамики древовидных ИМ роботов является важной научно-технической задачей.
2. Метод
Предлагается метод построения модифицированной СК Д-Х, позволяющий формировать математические модели ИМ роботов, имеющих произвольные древовидные КС. Метод основан на совместном применении теории графов [11] и СК Д-Х, предложенной в [10] для описания кинематики роботов с линейной разомкнутой кинематической цепью. При этом сохраняются известные преимущества СК Д-Х и появляется возможность описания кинематики произвольной древовидной КС с использованием методов теории графов.
3. Результаты
Представим кинематическую схему ИМ робота (рис. 1) в виде древовидного направленного графа (рис. 2) [11]. Звенья ИМ в таком графе являются вершинами, а соединяющие их сочленения - дугами [12]. За корень дерева (звено с номером «0») примем окружающее пространство, в котором находится робот. Звенья ИМ робота нумеруются с 1 -го и далее по возрастающим номерам, от корня дерева к его листьям без пропусков. При этом должно выполняться условие, что собственный номер звена меньше номера любого звена-потомка. Номер обобщённой координаты ИМ, как и номер соответствующего сочленения тот же, как и у звена, присоединяемого этим сочленением к предыдущему звену. Для ШР, корпус которого не закреплён к неподвижному основанию, общее число степеней его свободы равно N+6, где N - число степеней подвижности его ИМ. Для "привязки" ИМ ШР к абсолютной СК и описания его движения в пространстве, вводится фиктивная кинематическая цепь, соединяющая корпус робота с неподвижной в абсолютной СК фиктивной стойкой. Эта фиктивная цепь состоит из невесомых звеньев
(0^5), (три поступательные и три вращательные кинематические пары 5-го класса) и характеризует положение и ориентацию корпуса робота в абсолютной СК.
Такое описание кинематической схемы древовидного ИМ робота допускает различные варианты нумерации звеньев. Количество вариантов нумерации зависит от сложности древовидной кинематической структуры. При этом каждому варианту нумерации соответствует свой направленный граф, своя матрица достижимости и свой блочный вектор Z, определяющий последовательность ортов осей г, соответствующих сочленениям, соединяющим звенья ИМ с их звеньями-отцами.
Разработчику предоставляется право выбора конкретного варианта нумерации исходя из его приоритетов. Однако, надо помнить, что все варианты нумерации равноправны и приводят к искомому результату.
Рис. 1. Кинематическая схема ИМ Рис. 2. Древовидный граф, представляющий кинематическую структуру роботизированного манекена с ИМ роботизированного манекена
фиктивными звеньями
При математическом описании кинематических структур ИМ роботов, представленных в виде древовидных направленных графов, воспользуемся следующими определениями [12]:
Ь=(1,2...,М} - неупорядоченное множество, элементами которого являются номера звеньев ИМ;
/(¡) - номер звена, являющегося звеном-отцом для звена I;
ъ(1,к) - номер звена, являющегося к-м звеном-сыном для звена I;
^8+(!) - полустепень исхода звена I, определяет количество звеньев-сыновей звена I;
Г(1) - кортеж номеров звеньев, являющихся для звена / звеньями-сыновьями Г(1)={(8(/,1),
8(/,2),...8</,к),...8(/, &0)))У,
т(1) - определяет, каким по счёту звеном-сыном является звено I для своего звена-
отца;
5 = { 0,1 } - коэффициент, определяющий тип сочленения звена I (1 - вращательное, 0 - поступательное);
- диагональная матрица, определяющая типы сочленения
звеньев древовидного ИМ.
Рассмотрим порядок назначения СК связанных со звеньями древовидного ИМ [13, 14]. С каждым звеном ИМ связывается столько СК, сколько звеньев-сыновей оно имеет. Одна из СК, связанных со звеном, назначается за основную, остальные являются вспомогательными. В качестве примера на рис. 3 показаны три СК, связанные со звеном I, имеющим три звена-сына. Все СК назначаются в соответствии с правилами Денавита-Хартенберга [10].
Рис. 3. Назначение СК, связанных с ветвящимся звеном
Переход из основной СК звена / в СК его звена-отца /(/), соответствующую этому звену, определяется матрицей преобразования Л{.
/(¿),П5(1) д ^ /(¿),П5(*)7 н . (2)
ООО 1
А переходы из вспомогательных СК в основную СК звена I определяется постоянными матрицами однородных преобразований М^ф, где ] - число звеньев сыновей звена I.
1Ц.М. ...
Г,
¿,П5(/)
(3)
ООО
Выражения (2) и (3) позволяют записать рекуррентные соотношения для определения матрицы Т, которая характеризует переход от основных СК звеньев в абсолютную СК.
Т= Т/^МьтоА
Матрица М^ф всегда постоянна и выполняет вспомогательную функцию при переходе из основной СК звена-сына в основную СК звена-отца. В случае, если убГ^ и ему соответствует основная СК звена г, то М1,тф=Е.
Порядок следования СК в древовидной кинематической структуре ИМ робота
задаётся с помощью блочного вектора Z. Он определяет последовательность ортов осей г,
соответствующих сочленениям, соединяющим звенья ИМ с их звеньями-отцами. Так, для
ИМ, кинематическая схема которого представлена на рис. 1, блочный вектор Z имеет
следующий вид:
7-/^0 о о о о о о о о о о о
(4)
0„ о О О О О О О О О О О ЛГ 212> 213> 214> 215> 26,2> 216> 217> 218> 26,3> 219> 220>
Первым элементом (соответствует первому звену) является г0 абсолютной СК. Вторым элементом - орт оси г первого звена. А, например, для 19 звена - орт оси г вспомогательной СК 6-го звена. Оси СК звеньев-листьев в этот блочный вектор не входят.
Необходимо отметить, что в рассматриваемом примере блочный вектор Z имеет размерность (24х24), а блочный вектор г - размерность (21х21). Это связано с тем, что элементы °гб,з, °г7,2 вектора не являются осями кинематических пар ИМ, а
соответствуют вспомогательным системам координат робота, определяющим их положение и ориентацию в основных системах координат. Для линейной разомкнутой кинематической цепи размерности векторов и совпадают.
Для математического описания древовидной кинематической структуры ИМ необходимо также определить порядок расположения звеньев друг относительно друга. Он определяется матрицей достижимости Б - квадратной матрицей, каждый элемент которой й у = 1, если 1-я вершина направленного графа, описывающего кинематическую структуру ИМ, достижима из вершины а, и йц = 0 , если 1-я вершина не достижима из вершины /
При нумерации звеньев ИМ робота в соответствии с изложенными выше правилами, матрица достижимости Б получается нижней треугольной матрицей, размерность которой равна числу звеньев ИМ. Следовательно, как древовидный граф, представляющий
древовидную кинематическую структуру робота, так и матрица достижимости Б отражают взаимное расположение и достижимость звеньев его ИМ.
Таким образом, предлагаемый метод построения модифицированной СК Д-Х позволяет определить значения параметров основных и вспомогательных СК древовидного ИМ робота. В таблицах 1 и 2 представлены значения модифицированных параметров Д-Х для основных и вспомогательных СК ИМ робота, кинематическая схема которого представлена на рис. 1 [11].
Таблица 1. Значения модифицированных параметров Д-Х для основных СК ИМ робота
№ СК 0, рад й, м а, м а, рад № тф
1 - п/2 0 0 - п/2 0 1
2 - п/2 0 0 - п/2 1 1
3 - п/2 0 0 - п/2 2 1
4 п/2 0 0 п/2 3 1
5 п/2 0 0 п/2 4 1
6 0 -0,349 0 - п/2 5 1
7 п/2 -0,1 0,17 п/2 6 1
8 0 0 0 - п/2 7 1
9 0 0 0,4 0 8 1
10 0 0 0,42726 0 9 1
11 0 0 0,051 0 10 1
12 - п/2 0 0 - п/2 7
13 0 0 0,4 0 12 1
14 0 0 0,42726 0 13 1
15 0 0 0,051 0 14 1
16 п 0,2 0 п/2 6
17 п 0 0,262 - п/2 16 1
18 0 0 0,444 0 17 1
19 п 0,2 0 - п/2 6
20 п 0 0,262 - п/2 19 1
21 0 0 0,444 0 20 1
Таблица 2. Значения модифицированных параметров Д-Х для вспомогательных СК ИМ робота
№ СК 0, рад й, м а, м а, рад 1(1,) т(1)
6,2 п/2 0 -0,349 п 6 2
6,3 п/2 0 -0,349 0 6 3
7,2 п/2 0 0,2 0 7 2
По древовидному графу (рис. 2), представляющему кинематическую структуру робота, определим матрицу достижимости Б(21х21) звеньев ИМ робота, численные значения элементов которой представлены в таблице 3.
Таблица 3. Численные значения элементов матрицы Б
Б(21 X 21)=
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 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
1 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0
1 1 0 0 0 0 0 0 0 0 0 0 0 0 0 0 0
1 1 1 0 0 0 0 0 0 0 0 0 0 0 0 0 0
1 1 1 1 0 0 0 0 0 0 0 0 0 0 0 0 0
1 1 1 1 1 0 0 0 0 0 0 0 0 0 0 0 0
1 1 1 1 1 1 0 0 0 0 0 0 0 0 0 0 0
1 1 1 1 1 1 1 0 0 0 0 0 0 0 0 0 0
1 1 1 0 0 0 0 1 0 0 0 0 0 0 0 0 0
1 1 1 0 0 0 0 1 1 0 0 0 0 0 0 0 0
1 1 1 0 0 0 0 1 1 1 0 0 0 0 0 0 0
1 1 1 0 0 0 0 1 1 1 1 0 0 0 0 0 0
1 1 0 0 0 0 0 0 0 0 0 1 0 0 0 0 0
1 1 0 0 0 0 0 0 0 0 0 1 1 0 0 0 0
1 1 0 0 0 0 0 0 0 0 0 1 1 1 0 0 0
1 1 0 0 0 0 0 0 0 0 0 0 0 0 1 0 0
1 1 0 0 0 0 0 0 0 0 0 0 0 0 1 1 0
1 1 0 0 0 0 0 0 0 0 0 0 0 0 1 1 1
Первые шесть столбцов матрицы Б(21 X21) соответствуют звеньям фиктивной кинематической цепи, соединяющий корпус робота с неподвижной в абсолютной системе фиктивной стойкой. Единичные значения элементов первых шести столбцов указывают на то, что из этих звеньев достижимы все остальные звенья кинематической цепи робота. Седьмой столбец матрицы Б(21 X21) соответствует звену 7, из которого достижимы звенья 8 -15. Восьмой столбец соответствует звену 8, из которого достижимы только звенья 9 -11. Звено 11 (11 столбец) достижимо только из самого себя и т.д.
Таким образом, если традиционные параметры Д-Х 0 щ, щ дополнить
параметрами /(г), т(1), а также блочным вектором г, диагональной матрицей а и матрицей достижимости Б, характеризующих особенности конкретной КС, то можно формализовать запись уравнений кинематики для ИМ робота с произвольной древовидной кинематической цепью.
Используя предложенный выше метод описания кинематики древовидного ИМ робота с помощью модифицированной СК Д-Х, запишем в блочно-матричном виде кинематические зависимости для всех звеньев ИМ [13, 14]. Используемы ниже обозначения величин в выражениях (5) -(14) соответствуют принятым в работе [14]. Выражения для определения угловых скоростей и угловых ускорений звеньев представим в следующем виде:
0 Ш = {0- V ■ а)ъ (5)
0е = {О- + °г). (6)
Запишем выражения для определения скоростей 0 V и ускорений 0 V начал основных СК звеньев:
0 V = (лт ( 0 1Я) V ■ а + Я ■ V ■ (Я - а) ) ц ; (7)
°У = (Лг( \) V ■ а + Я ■ V ■ (Я - а)) ц +
(8)
+ (Лт(01Я)0^а + Лт(01Я)0г^а + Я^ V ■ (Я - а)) ц.
Ускорения центров масс звеньев ИМ определим с помощью следующего выражения:
°ац.м. = (Я ■ V .{Е-а) + Лг( °С/Я) V ■ + +ЛГ( °С/Я)ЛГ( V ■ а ■ ^(Я - Я) V ■ а ■ ц +
+Лт (Лт( 0С/0) ■ а ■ V ■ V + Я +Лт( 0С/0) ■ (9)
■ ((Я - Я) ■ а ■ V ■ $<*)) V ■ а ■ <7 + +2 ■ Я ■ Лт ( V) ■ (Я - а) ■ ц й (Я - Я) V ■ а ■ ц.
Во все выражения (5 —9) входят определённые выше матрица достижимости Б, блочный вектор г, определяющий последовательность ортов г СК, связанных со звеньями, и диагональная матрица а, определяющая типы сочленений для звеньев ИМ (поступательные или вращательные). Верхний индекс «0» указывает на то, что все полученные выражения (5- 9) записаны в базовой СК «0».
Предложенный выше метод позволяет также записать в блочно-матричном виде динамические соотношения для всех звеньев ИМ робота. Схема приложения действующих между звеньями древовидного ИМ сил и моментов представлена на рис. 4.
Выражения, описывающие динамические соотношения, запишем при выполнении следующих условий [13, 14]:
• силы и моменты, действующие между звеньями ИМ робота, будем рассматривать через силы и моменты, действующие на звено со стороны его звена-отца;
• силы, действующие на звенья со стороны их звеньев-отцов, и внешние силы, действующие на звенья, приводятся к началам СК звеньев-отцов, соответствующих этим звеньям;
• моменты, действующие на звенья, включают в себя моменты от приведения этих сил к началам соответствующих СК.
Тогда блочно-матричные выражения для определения сил 0/ и моментов 0п, действующих между звеньями ИМ, запишутся в следующем виде:
0/ = Я т ■ тй ■ 0 «■Я г- 0 /в; (10)
0п = - [Лт (0С/Я)] Т ■ тй ■ 0 а + Я т ■ 7й ■ 0е + Ят ■ Л( 0Ий ) ■ ■ (11)
■ 0 И - (Я т - Я) ■ Л ( 05 й) ■ Я т ■ 0/в - Я т ■ 0 пв - Я т ■ Л ( 0 £й) ■ 0/в;
Рис. 4. Силы и моменты, действующие между звеньями древовидного ИМ робота
Выражения для определения сил и моментов, развиваемых приводами ИМ робота,
■■ Ог 0
получим при проецировании вышеопределенных сил / и моментов п взаимодействия звеньев между собой, на оси I СК, соответствующих сочленениям, связывающим эти звенья с их звеньями-отцами.
т = а-(°г£г)Т-[-(л(0С/о))Т-т£г- °а + ЯГ ■ °/с" +
+БТ ■ Л( V) ■ °/в - Бт ■ °пв] +
+(Е -<;)■( V) Т ■ (Бт ■ т( ■ 0 а-Б 0 Г в) .
Если в выражении (12) для усилий, развиваемых приводам, выразить скорости и ускорения через обобщенные координаты д и их производные и сгруппировать слагаемые
при абсолютных скоростях и ускорениях, то получим следующее уравнение динамики ИМ робота, имеющего древовидную кинематическую структуру:
А( ц) ■ ц + В( ц, ц) - С( ц) ■ 0/в - Я ( ц) ■ Ч = т, (13)
где:
А(д) = а ■ ( V)7 ■ (- (А( 0С/о))Т ■ ша ■ (О ■ V ■(*-*)+ Аг( V) ■
■ °га-а) + От- Ус-О- V-
;
В(Ч, ф = а ■ ( V)7 ■ {- (А( 0С/о))Т ■ та ■ [Лг( V) ■
■ Лг( V ■ а ■ ■ (О - Е) +
+ЛГ (Лг( 0С/о) ■ а ■ <1а ■ V ■ Я + Лг( 0С/о) ■ ((О - Е) ■ а ■ V ■ <7/) + +2 Я Лт( V -{Е-а)- ца) ■ (Я -£")]+ ■ ■ й ■ а ■ (¡а ■ АТ ■
■ ( V) ■ (Б — Е) +
+БТ ■ Л(Я ■ V ■ а ■ <7/ £ ■ Я} ■ V ■ а ■ $ + (Я - а) ■
■ ( V)7 ■ ■ ■ [ЛГ( °СГо) -ЛГ( V ■ а ■ цй) ■ ■ (Я - Е) + 2 ■ Я ■ Лт( V ■ (Е - а) ■ <7**) ■ (7) — Я) + +ЛТ(ЛТ( °Сд>) ■ а ■ (¡а ■ °га ■ Я + +Лт(лт( V) ■ а ■ ■ V ■ Я + ЛГ( V) ■
■ ((Я - Я) ■ а ■ 0гй^ц)й)]0^ ^^ачц;
С(ч) = а ■ ( V)7 ■ ((ЯГ — Я) ■ Л( V) ■ Бт + Бт ■ Л( V)) +
+(Я - а) ■ ( V) т ■ Я т; Я ( ц) = а ■ ( V) т ■ Я т;
_______ у
0/в = ( 0/в 1 , 0/в2 , ■ ■ ■ 0/вл) и 0 пв = ( 0 п в 1, 0 Пв 2 , ■ ■ ■ 0 пвл) - блочные матрицы внешних сил и моментов, действующих на звенья древовидного ИМ робота.
Данное уравнение справедливо при выполнении следующих допущений:
• звенья ИМ абсолютно жёсткие;
• связи в сочленениях - голономные;
• кинематические цепи, составляющие древовидную кинематическую структуру, -разомкнутые.
Полученное уравнение (13), в основе формирования которого лежит модифицированная СК Д-Х, является универсальным (при указанных допущениях) для
целого класса ИМ роботов с древовидными кинематическими структурами, определяемыми матрицами достижимости Б, блочными векторами г и диагональными матрицами а.
В работе [15] представлены результаты исследования кинематики и динамики древовидного ИМ робота-собаки. Для ИМ, имеющего 22 степени подвижности, получены численные значения модифицированных параметров Д-Х, матрицы достижимости Б, блочный вектор г и диагональная матрица о. На основе уравнения (13) с использованием специально разработанной в среде МЛТЬЛВ программы [16] определены значения моментов и мощностей в степенях подвижности робота-собаки.
Работа [17] посвящена синтезу КС и исследованию динамики древовидного ИМ робота-краба, имеющего 62 степени подвижности. Использование модифицированной СК Д-Х позволяет построить математическую модель кинематики и динамики его ИМ. Разработанная 3-Б модель ИМ робота-краба позволила определить массо-инерционные характеристики элементов его конструкции. С использованием программы [16] получены численные значения элементов матриц, входящих в уравнение (13), а также значения моментов и мощностей в степенях подвижности робота-краба.
В работе [18] рассмотрен пример использования модифицированной СК Д-Х при формировании математической модели кинематики и динамики древовидного ИМ антропоморфного робота, имеющего 114 степеней подвижности. Для уравнения (13) получены значения элементов входящих в него матриц , , , , а также
вычислены с помощью программы [16] значения моментов и мощностей в степенях подвижности ИМ робота. Полученные результаты рекомендованы для использования при создании современных образцов антропоморфных шагающих роботов.
В работах [19, 20] показано, что модифицированная СК Д-Х является эффективным средством формирования математических моделей ИМ роботов, имеющих линейную разомкнутую кинематическую цепь, являющуюся частным случаем древовидной.
В этом случае кинематическую схему можно представить в виде ориентированного графа, не имеющего циклов. Вершины графа соединены последовательно, так как любая из них будет иметь не более двух смежных вершин.
При этом матрица достижимости Б звеньев ИМ робота вырождается в нижнюю треугольную единичную матрицу порядка М, где N - число степеней подвижности ИМ робота.
Если на схват манипулятора или на какое-либо звено ИМ наложены внешние связи, то уравнение динамики ИМ запишется в следующем виде [14]:
4. Обсуждение
(14)
Матричные коэффициенты , , , , , , ,
определяются в соответствии с [14].
Уравнение (14) позволяет определить движение ИМ робота с произвольной древовидной КС при наложенных на него кинематических связях и вычислить значения возникающих при этом сил и моментов реакций связей.
В работе [21] показана эффективность применения предлагаемой СК для построения уравнений кинематики и динамики древовидного ИМ активного экзоскелета. Использование уравнения (14) позволило определить не только значения мощности приводов в степенях подвижности его ИМ при наложенных на него кинематических связях, но и вычислить силы и моменты реакции этих связей, возникающие при его взаимодействии с опорной поверхностью шагания. При этом эффективным средством расчета и исследования является специально разработанная в среде MATLAB программа [22].
В исследовании [23] описан метод синтеза КС древовидных ИМ ШР по фотографическим изображениям скелета его биологического прототипа, в основе которого лежит применение алгоритма восстановления КС [24-26] и модифицированной СК Д-Х. В качестве примера использования метода приведены результаты синтеза КС ИМ робота-стегозавра.
Таким образом, рассмотренные выше результаты исследований позволяют сделать заключение, что предложенная модифицированная СК Д-Х обладает определенной общностью и может быть использована при формировании математических моделей кинематики и динамики ИМ роботов с произвольной КС.
Выводы
Создание современных шагающих роботов сдерживается отсутствием эффективных методов формирования математических моделей их ИМ, имеющих древовидные КС.
При построении математических моделей кинематики и динамики таких ИМ предлагается использовать модифицированную СК Д-Х. Ее использование дает разработчику четкий алгоритм построения математических моделей ИМ роботов с произвольной древовидной КС.
Полученные таким образом математические модели и разработанное для их исследования программное обеспечение могут быть использованы при создании перспективных образцов шагающих роботов.
Список литературы
1. Медведев В.С., Лесков А.Г., Ющенко А.С. Системы управления манипуляционных роботов / под ред. Е.П. Попова. М.: Наука, 1978. 416 с.
2. Воробьев Е.И. и др. Механика промышленных роботов: учеб. пособие для вузов / под ред. К.В. Фролова и Е.И. Воробьева. М.: Высшая школа, 1988.
3. Фу К., Гонсалес Р., Ли К. Робототехника: пер. с англ. / под ред. В.Г. Градецкого. М.: Мир, 1989. 624 с.
4. Шахинпур М. Курс робототехники: пер. с англ. М.: Изд-во Мир, 1990. 528 с.
5. Крутько П.Д. Управление исполнительными системами роботов. М.: Наука, 1991. 336 с.
6. Зенкевич С.Л., Ющенко А.С. Основы управления манипуляционными роботами. М.: Изд-во МГТУ им. Н.Э. Баумана, 2004. 480 с.
7. Лесков А.Г., Ющенко А.С. Моделирование и анализ робототехнических систем. М.: Машиностроение, 1992. 80 с.
8. Лесков А.Г. Теоретические основы моделирования и анализа динамики манипуляционных роботов, их приложение к задачам проектирования и подготовки операторов: дис. ... докт. техн. наук. М., МГТУ им. Н.Э. Баумана, 2002. 329 с.
9. Лесков А.Г., Бажинова К.В., Морошкин С.Д., Феоктистова Е.В. Построение моделей кинематики исполнительных механизмов манипуляционных роботов с использованием блочных матриц // Инженерный журнал: наука и инновации. 2013. № 9. DOI: 10.18698/2308-6033-2013-9-954
10. Denavit J., Hartenberg R.S. A kinematic notation for lower-pair mechanisms based on matrices// Journal of Applied Mechanics. 1955. Vol. 22. P. 215-221.
11. Ковальчук А.К. Разработка математической модели исполнительного механизма роботизированного манекена // Научный Вестник МГТУ ГА. 2011. № 168 (6). С. 103109.
12. Алексеев В.Е., Таланов В.А. Графы и алгоритмы. Структуры данных. Модели вычислений. М.: Изд-во Бином, 2006. 319 с.
13. Ковальчук А.К., Кулаков Д.Б., Семенов С.Е. Математическое описание кинематики и динамики исполнительных механизмов роботов с древовидной кинематической структурой // Известия вузов. Машиностроение. 2008. № 11. С.13-25.
14. Ковальчук А.К., Кулаков Б.Б., Кулаков Д.Б., Семенов С.Е., Яроц В.В. Основы теории исполнительных механизмов шагающих роботов. М.: Изд-во Рудомино, 2010. 170 с.
15. Ковальчук А.К. Выбор кинематической структуры и исследование древовидного исполнительного механизма робота-собаки // Известия вузов. Машиностроение. 2011. № 8. С. 65-73. DOI: 10.18698/0536-1044-2011-8-65-73
16. Ковальчук А.К., Каргинов Л.А., Кулаков Б.Б., Кулаков Д.Б., Семенов С.Е., Яроц В.В. Программа моделирования древовидных исполнительных механизмов шагающих роботов: свидетельство о гос. регистрации программ для ЭВМ № 2012610398. 2012.
17. Ковальчук А.К. Выбор кинематической структуры и исследование динамики древовидного исполнительного механизма робота-краба // Известия вузов. Машиностроение. 2013. № 7. С. 73-79. DOI: 10.18698/0536-1044-2013-7-73-79
18. Ковальчук А.К. Проектирование исполнительного механизма антропоморфного шагающего робота // Естественные и технические науки. 2014. № 2 (70). С. 162-166.
19. Ковальчук А.К. Расчёт мощности приводов робота с учётом динамики его исполнительного механизма // Естественные и технические науки. 2014. № 1 (69). С. 128-131.
20. Kovalchuk A.K. Designing Drives of a Médical Robot Actuator // Life Science Journal. 2014. Vol. 11, no. 11s. P. 337-340.
21. Верейкин А.А., Ковальчук А.К., Каргинов Л.А. Исследование динамики исполнительного механизма экзоскелета нижних конечностей с учётом реакций опорной поверхности // Наука и образование. МГТУ им. Н.Э. Баумана. Электронный журнал. 2014. № 12. С. 256-278. DOI: 10.7463/1214.0745388
22. Ковальчук А.К. Каргинов Л.А., Кулаков Б.Б., Кулаков Д.Б., Семенов С.Е., Яроц В.В., Верейкин А.А. Моделирование древовидных исполнительных механизмов шагающих роботов с учётом внешних наложенных связей: свидетельство о гос. регистрации программ для ЭВМ № 2014612547. 2014.
23. Ковальчук А.К., Каргинов Л.А., Ахметова Ф.Х., Устюжанин А.Ю., Секерин С.С., Верейкин А.А. Синтез кинематической схемы древовидного исполнительного механизма робота-стегозавра с использованием фотографических изображений его биологического прототипа // Наука и образование. МГТУ им. Н.Э. Баумана. Электронный журнал. 2015. № 5. С. 82-102. DOI: 10.7463/0515.0766349
24. Пупков К.А., Ковальчук А.К., Кулаков Б.Б. Использование биологических прототипов при построении кинематических схем современных шагающих роботов // Вестник РУДН. Сер. Инженерные исследования. 2009. № 4. С. 44-54.
25. Pupkov K.A., Kovalchuk A.K., Kulakov B.B. Usage of Biological Prototypes for Kinemati-cal Scheme Construction of Modern Robots // Proc. of the 13th IFAC Symposium on Information Control Problems in Manufacturing. 3-5 June 2009. Moscow, 2009. P. 1829-1834. (Preprint).
26. Ковальчук А.К. Использование биологического прототипа при проектировании древовидных исполнительных механизмов двуногих шагающих роботов // Известия вузов. Машиностроение. 2011. № 9. С. 49-56.
Science and Education of the Bauman MSTU, 2015, no. 11, pp. 12-30.
DOI: 10.7463/1115.0826673
Received: Revised:
10.10.2015 29.10.2015
Science^Education
of the Bauman MSTU
ISS N 1994-0408 © Bauman Moscow State Technical Unversity
Modified Denavit-Hartenberg Coordinate System for Robot Actuating Mechanisms with Tree-like Kinematic Structure
A.K. Kovalchuk1' ''alek&andi-ale;dccv@yandgxju
bauman Moscow State Technical University, Moscow, Russia
Keywords: tree-like actuating mechanism, coordinate system of Denavit-Hartenberg, kinematic
scheme of robot, robot actuating mechanism designing, robot kinematic and dynamic equations
To build mathematical models of actuating mechanisms (AM) of robots with linear kinematic structure, J. Denavit and R.S. Hartenberg (D-H) proposed to use a special coordinate system (CS). It uses a matrix of homogeneous transformation and provides clear and unambiguous rules to build mathematical models of robot actuating mechanisms. Developers widely use this approach because of its clarity and binding to AM design parameters. However, its use to describe robots the AM of which has a spatial tree-like kinematic structure revealed the certain hardship.
The paper offers a method for building a modified D-H coordinate system. Its using allows to create mathematical models of robot AM, having spatial kinematic structure. The method is based on using both the graphs theory and the known D-H coordinate system jointly.
The paper defines concepts of main and auxiliary coordinate systems and the order of their location on the tree-like AM. The values of the modified parameters of D-H are obtained. There its known parameters 6¿, d£ , a¿, a£ are complemented by parameters f(i), which determine the father number of the link i, and ns(i), that shows, which son in succession is the link i for the link f(i). An algorithm to form the matrix of reachability and the graph of reachability of the tree-like AM is proposed.
It is proved that the use of the modified D-H coordinate system allows us to record in a block-matrix form both kinematic and dynamic equations for all links of the tree-like AM of robot. The use of these equations together with DAlembert principle allowed us to write the equations of the tree-like AM dynamics of robot in the form traditional for recording the AM dynamics equations with open kinematic structure.
Via examples of mathematically described kinematics and dynamics of tree-like AM of specific robots (robot-dog, robot-crab, anthropomorphic walking robot, etc.) the paper shows efficiency of modified D-H coordinate system
Obtained research results of the medical robot AM have shown that the proposed model can be successfully used to describe robots with linear open kinematic structure, which is a special case of tree-like kinematic one.
References
1. Medvedev V.S., Leskov A.G, Jushhenko A.S. Sistemy upravlenija manipuljacionnykh robotov [Robotic Manipulators Control Systems]. Moscow, Nauka Publ., 1978. 416 p. (in Russian).
2. Vorob'ev E.I., et al. Mekhanika promyshlennykh robotov [Mechanics of industrial robots]. Moscow, Vysshaia shkola Publ., 1988. (in Russian).
3. Fu K., Gonzalez R., Lee K. Robotics: Control, Sensing, Vision, and Intelligence. Mcgraw-Hill Book Company, 1987. (Russ. ed.: Fu K., Gonzalez R., Lee K. Robototekhnika. Moscow, Mir Publ., 1989. 624 p.).
4. Shahinpoor M. A Robot Engineering Textbook. New York, HarperCollins Publishers, 1987. (Russ. ed.: Shahinpoor M. Kurs robototekhniki. Moscow, Mir Publ., 1990. 528 p.).
5. Krut'ko P.D. Upravlenie ispolnitelnimi sistemami robotov [Control of Robots Actuating System]. Moscow, Nauka Publ., 1991. 336 p. (in Russian).
6. Zenkevich S.L., Iushchenko A.S. Osnovy upravleniia manipuliatsionnymi robotami [Bases of controlling of manipulators]. Moscow, Bauman MSTU Publ., 2004. 480 p.
7. Leskov A.G., Jushhenko A.S. Modelirovanie i analiz robototekhnicheskikh system [Simulation and Analysis of Robotic Systems]. Moscow, Mashinostroenie Publ., 1992. 80 p. (in Russian).
8. Leskov A.G. Teoreticheskie osnovi modelirovaniya i analiza dinamiki manipulyatcionnikh robotov, ikh prilozhenie k zadacham proektirovaniya i podgotovki operatorov. Dokt. diss. [Theoretical Bases of Simulating and Analysis of the Dynamics of Manipulation Robots, Their Application to Problems of Designing and Operator Training. Dr. diss.]. Moscow, Bauman Moscow State Technical University, 2002. 329 p. (in Russian, unpublished).
9. Leskov A.G., Bazhinova K.V., Moroshkin S.D., Feoktistova E.V. Modeling of trobotic arms kinematics by means of block matrixes. Inzhenernyy zhurnal: nauka i innovatsii = Engineering Journal: Science and Innovation, 2013, no. 9. DOI: 10.18698/2308-6033-2013-9954 (in Russian).
10. Denavit J., Hartenberg R.S. A kinematic notation for lower-pair mechanisms based on matrices. Journal of Applied Mechanics, 1955, vol. 22, pp. 215-221.
11. Koval'chuk A.K. Development of Mathematical Model of the Robotic Mannequin Actuating Mechanism. Nauchnyi Vestnik MGTU GA = Scientific Bulletin of Moscow State Technical University of Civil Aviation, 2011, no. 6 (168), pp. 103-109. (in Russian).
12. Alekseev V.E., Talanov V.A. Grafy i algoritmy. Struktury dannykh. Modeli vychisleniy [Graphs and Algorithms. The Structure of the Data. Computation Models]. Moscow, Binom Publ., 2006. 319 p. (in Russian).
13. Kovalchuk A.K., Kulakov D.B., Semenov S.E. The Mathematical Description of the Kinematics and Dynamics of the Actuating Mechanisms of Robots With Tree-like Kinematic Structure. Izvestiia vysshikh uchebnykh zavedenii. Mashinostroenie = Proceedings of Higher Educational Institutions. Machine Building, 2008, no. 11, pp. 13-25. (in Russian).
14. Kovalchuk A.K., Kulakov B.B., Kulakov D.B., Semenov S.E., Yarots V.V. Osnovi teorii ispolnitelnikh mekhanizmov shagayushikh robotov [Bases of the Theory of Walking Robots Actuating Mechanisms]. Moscow, Rudomino Publ., 2010. 170 p. (in Russian).
15. Kovalchuk A.K. Choice of a kinematic structure and research of a "Robot-dog" tree-like actuator. Izvestiia vysshikh uchebnykh zavedenii. Mashinostroenie = Proceedings of Higher Educational Institutions. Machine Building, 2011, no. 8, pp. 65-73. DOI: 10.18698/05361044-2011-8-65-73 (in Russian).
16. Kovalchuk A.K., Karginov L.A., Kulakov B.B., Kulakov D.B., Semenov S.E., Yarots V.V. Programma modelirovaniya drevovidnykh ispolnitel'nykh mekhanizmov shagayushchikh robotov [Simulation program of tree-like actuators of walking robots]. Certificate of state registration of computer program, no. 2012610398 RF, 2012. (in Russian).
17. Kovalchuk A.K. Choosing the Kinematic Structure and Dynamics Study of Tree-like Robot Crab Actuator. Izvestiia vysshikh uchebnykh zavedenii. Mashinostroenie = Proceedings of Higher Educational Institutions. Machine Building, 2013, no. 7, pp. 73-79. DOI: 10.18698/0536-1044-2013-7-73-79 (in Russian).
18. Kovalchuk A.K. Design of Actuator of Anthropomorphic Walking Robot. Estestvennye i tekhnicheskie nauki = Natural and technical sciences, 2014, no. 2, pp. 162-166. (in Russian).
19. Kovalchuk A.K. Calculation of capacity drives for robot based on dynamics of its executive machinery. Estestvennye i tekhnicheskie nauki = Natural and technical sciences, 2014, no. 1, pp. 128-131. (in Russian).
20. Kovalchuk A.K. Designing Drives of a Medical Robot Actuator. Life Science Journal, 2014, vol. 11, no. 11s, pp. 337-340.
21. Vereikin A.A., Kovalchuk A.K., Karginov L.A. The Lower Extremities Exoskeleton Actuator Dynamics Research Taking into Account Support Reaction. Nauka i obrazovanie MGTU im. N.E. Baumana = Science and Education of the Bauman MSTU, 2014, no. 12, pp. 256278. DOI: 10.7463/1214.0745388 (in Russian).
22. Kovalchuk A.K., Karginov L.A., Kulakov B.B., Kulakov D.B., Semenov S.E., Yarots V.V., Vereikin A.A. Modelirovanie drevovidnikh ispolnitel'nikh mekhanizmov shagajushhikh robotov s uchetom vneshnikh nalozhennikh svjazej [Simulation of Walking Robots Tree-like Actuating Mechanisms, Taking into Account Imposed External Relations]. Certificate of state registration of computer program, no. 2014612547 RF, 2014. (in Russian).
23. Kovalchuk A.K., Karginov L.A., Akhmetova F. Kh., Ustjuzhanin A.Yu., Sekerin S.S., Vereikin A.A. Tree-like Robot-stegosaurus Actuator Kinematic Scheme Synthesis Using Photographic Images of its Biological Prototype Skeleton Nauka i obrazovanie MGTU im.
N.E. Baumana = Science and Education of the Bauman MSTU, 2015, no. 5, pp. 82-102. DOI: 10.7463/0515.0766349 (in Russian).
24. Pupkov K.A., Kulakov B.B., Kovalchuk A.K. Usage of biological prototypes for kinemati-cal scheme construction of modern walking robots. Vestnik RUDN. Ser. Inzhenernie issledovaniya = Bulletin of Peoples' Friendship University of Russia. Ser. Engineering Researches, 2009, no. 4, pp. 44-54. (in Russian).
25. Pupkov K.A., Kovalchuk A.K., Kulakov B.B. Usage of Biological Prototypes for Kinemati-cal Scheme Construction of Modern Robots. Proc. of the 13th IFAC Symposium on Information Control Problems in Manufacturing. 3-5 June, 2009. Moscow, 2009, pp. 1829-1834. (unpublished).
26. Kovalchuk A.K. Use of a biological prototype when designing tree-like actuators of bipedal walking robots. Izvestiia vysshikh uchebnykh zavedenii. Mashinostroenie = Proceedings of Higher Educational Institutions. Machine Building, 2011, no. 9, pp. 49-56. (in Russian).