- •Московский государственный технический университет им.Н.Э.Баумана
- •Манипуляционные роботы
- •Ису (су манипулятора)
- •Раздел 1. Кинематика им мр
- •Координаты и параметры им
- •Описание им мр
- •Системы координат
- •Координаты шарниров
- •Параметры им
- •Обобщенные координаты им
- •Матрицы преобразований поворота
- •1.6.1. Матрицы поворота вокруг одной координатной оси (матрицы элементарных поворотов).
- •1.6.2. Матрицы композиции элементарных поворотов
- •Этот факт иллюстрирует рисунок 1.10. Зеленый цвет – последовательность поворотов ск. Синий – последовательность преобразований векторов, заданных координатами в подвижной ск, в неподвижную.
- •1.6.3. Матрицы сложных поворотов
- •1.6.4. Матрицы поворота ск смежных звеньев им
- •Очевидно,
- •1.6.5. Матрица преобразования поворота ск произвольных звеньев
- •Положение им в рабочем пространстве. Линейные и угловые координаты звеньев
- •2.1. Линейные координаты звеньев им относительно базовой ск
- •Прямая позиционная кинематическая задача
- •Понятие обратной позиционной кинематической задачи
- •2.4.1 Сингулярности окз
- •2.4.2 Обратная кинематическая задача в управлении манипулятором
- •Однородные координаты и однородные преобразования в робототехнике
- •2.6 Блочные матрицы
- •2.7 Специальные системы координат
- •Угловая и линейная скорости звеньев им
- •3.1. Угловые скорости звеньев им
- •Введем обозначения
- •3.2. Свойства векторов сj(0) .
- •3.3. Матрицы-якобианы угловых скоростей им.
- •3.4. Производные по времени матриц преобразований поворота.
- •3.4.1. Запись производной по времени матрицы I-1i
- •3.4.2. Свойства матрицы векторного произведения (.)
- •3.4.3. Вычисление `I-1i .
- •3.4.4. Производная по времени матрицы 0i.
- •3.5. Линейные скорости звеньев им
- •(Различные индексы суммирования во втором и третьем слагаемых приняты для удобства дальнейших преобразований).
- •Развернем полученное выражение, подставив в него
- •Получим: I I
- •3.6. Свойства векторов Dij(0)
- •3.7. Матрицы-якобианы линейных скоростей им.
- •3.8. Матрица-якобиан последнего звена им.
- •3.9. Прямая кинематическая задача о скорости им
- •3.10. Понятие обратной задачи о скорости им
- •3.11. Примеры решения прямой и обратной задач о сокорости звеньев им
- •3.11.1. Прямая и обратная кинематические задачи об угловой скорости звеньев им
- •3.11.1. Прямая и обратная кинематические задачи о линейной скорости звеньев им
- •Угловые и линейные ускорения звеньев
- •4.1. Угловые ускорения
- •4.2. Линейные ускорения
- •Раздел 2. Динамика им мр
- •Силы и моменты.
- •Силы, действующие на звенья им
- •Моменты, действующие на звенья им.
- •Сумма двух последних слагаемых дает
- •С учетом этого выражение для I (0) примет вид:
- •Выражение для Mиj(0) имеет вид:
- •Силы, действующие вдоль осей шарниров им.
- •1.4. Моменты, действующие вдоль осей шарниров.
- •1.5. Силы и моменты, развиваемые приводами манипулятора. Обратная задача динамики им.
- •1.6. Уравнения статического равновесия им.
- •Симметрия уравнений озд и уравнений для определения скоростей звеньев им.
- •Управление по вектору силы
- •Уравнения движения им мр
- •Вывод уравнений движения
- •С учетом выполненных преобразований и введенных обозначений первое выражение п.2.1 примет вид:
- •2.4. Запись уравнений движения им с использованием матриц преобразования между ск звеньев.
- •2.3. Пример расчета матрицы инерционных коэффициентов.
С учетом выполненных преобразований и введенных обозначений первое выражение п.2.1 примет вид:
n n n
aij q``j + bi = дi + сi(0) T Mвj (0) + Dji(0) T Fвj (0) ,
j=1 j=i j=i
i = 1,2,…,n.
Полученная система дуравнений описывает движение ИМ под действием внешних сил и моментов, а также сил и (или) моментов, развиваемых приводами шарниров. Физический смысл каждого из слагаемых в этом выражении – силы и моменты, действующие вдоль осей шарниров:
n
aij q``j - часто называют “инерционными “ силами или моментами, с
j=1
которыми ИМ воздействует на оси шарниров,
bi – центробежные и кориолисовы силы и моменты, воздействующие на оси шарниров,
n
сi(0) T Mвj (0) – моменты, воздействующие на оси шарниров; обусловлены
j=i
внешними моментами, приложенными к звеньям ИМ,
n
Σ Dji(0) T Fвj (0) – силы и моменты, воздействиующие на оси шарниров;
j=i
обусловлены внешними силами, приложенными к звеньям ИМ,
дi – силы и моменты, развиваемые приводами ИМ.
Последнюю систему можно представить в виде одного уравнения, если обозначить
A = {aij} – матрица (nxn) при вторых производных обобщенных координат ИМ (матрица инерционных коэффициентов, матрица инерции ИМ),
b = [bi ] – вектор (nx1), (i = 1,2,…,n),
С(0) = {сj (0)} – матрица (3nxn) (см. п.2.5.2),
D(0) = {Dij(0)} – матрица (3nxn) (см. п.2.9),
д = [дi], вектор (nx1), i = 1,2,…,n,
Mв (0) = [Mв1(0)T Mв2(0)T … Mвn(0)T ]T – вектор (3nxn) с компонентами Mвj (0),
Fв (0) = [Fв1(0)T Fв2(0)T … Fвn(0)T ]T - вектор (3nxn) с компонентами Fвj (0).
Воспользовавшись сделанными обозначениями, получим:
A q`` + b = д + С(0)T Mв(0) + D(0) T Fв(0).
2.2. Свойства матрицы А = { aij }
а) Элемент aij есть:
сумма из (n - max(i,j) +1) скалярных произведений вектора сi(0) и вектора сj(0) , взятых с Ik(0) как с весовыми матрицами, причем k приобретает последовательно целосчисленные значения из диапазона max(i,j) ≤ k≤ n
плюс
сумма из (n - max(i,j) +1) скалярных произведений векторов Dki(0) и векторов Dkj(0), взятых с mk как с весовыми множителями, причем k приобретает последовательно целосчисленные значения из диапазона max(i,j) ≤ k≤ n.
Действительно, по свойству скалярного произведения
сi(0) T Ik(0) сj(0) = сi(0) . ( Ik(0) сj(0)),
Dki(0)T mk Dkj(0) = Dki(0) . ( mk Dkj(0)).
Число слагаемых в суммах и диапазоны суммирования легко устанавливаются из (4.3). Свойство а) удобно проиллюстрировать геометрически (рис.4.1 – случай i>j):
б) А – симметрическая матрица. Для этого нужно доказать, что aij = aji ; а для этого достаточно показать, что
сi(0) T Ik(0) сj(0) = сj(0) T Ik(0) сi0) и Dki(0)T mk Dkj(0) = Dkj(0)T mk Dki(0).
Поскольку сi(0)T Ik(0) сj(0) – скаляр, то (сi(0)T Ik(0) сj(0))T = сi(0)T Ik(0) сj(0). С другой стороны
выполнение предписанных действий транспонирования над (сi(0)T Ik(0) сj(0))T дает сj(0) T Ik(0)T сi(0) = сj(0)T Ik(0)T сi(0), что и служит доказательством.
Доказательство для Dki(0)T mk Dkj(0) полностью аналогично.
k
ck(0)
ck(0)
Dki(0)
i
ci(0)
n
i-1
Dkj(0)
cj(0)
j
Рис.4.1. Геометрическая интерпретация соотношений для расчета элементов матрицы A.
в) А – положительно определенная матрица (т.е. А>0).
Запишем выражение для кинетической энергии ИМ:
n
КЕ = ½ (Vj(0)T mj Vj(0) + j(0)T Ij(0) j(0)) =
j=1
n j j
½ (сk(0) T Ij(0) сl(0) + Djk(0)T mj Djl(0))q`kq`l.
j=1 k=1 l=1
Изменим порядок суммирования:
j = 1 k = 1 l = 1 -> k = 1,…,n
j = 2 k = 1,2 l = 1,2 l = k,…,n
j = 3 k = 1,2,3 l = 1,2,3 j = k (или l), т.е. = max(k,l)
… … …
j = n k = 1,2,3,…,n l = 1,2,3,…,n
n n n n n
КЕ = ½ (сk(0) T Ij(0) сl(0) + Djk(0)T mj Djl(0)) q`k q`l = ½ akl q`kq`l .
k=1 l=1 j=max(k,l) k=1 l=1
Таким образом, КЕ – квадратичная форма с матрицей A. По условиям физической реализуемости механической системы матрица квадратичной формы КЕ является положительно определенной. Поэтому A – положительно определенная матрица.
2.3. Свойства вектора b = {bi}.
j
С учетом выражений для с`k(0) и D`jk(0) q`k элемент bi можно
k=1
представить в виде
n j
bi = сi(0) T (Ij(0) (k(0)) сk(0) qk` + (j(0)) Ij(0) j(0) ) +
j=i k=1
n
Dji(0)T mj ( (j(0)) (j(0)) 0j tj +
j = i
j j
(k(0)) (k(0)) 0k (vk (1-k)qk + lk) + 2 (k(0)) 0k (vk (1-k)q`k) +
k=1 k=1
j j l
( (k(0)) 0kvkkqk` ) 0jtj + ( (k(0)) 0kvkkqk` ) 0l (vl (1-l) q l + l l )).
k=1 l =1 k =1
Физический смысл bi – сила или момент, воздействующие на оси шарниров при движении ИМ. Из представленного выражения видно, что bi квадратично зависит от вторых производных обобщенных координат. Слагаемые, входящие в bi представляют собой центробежные силы, моменты от действия этих сил, а также кориолисовы силы и моменты от действия сил Кориолиса.
