Добавил:
Upload Опубликованный материал нарушает ваши авторские права? Сообщите нам.
Вуз: Предмет: Файл:
Лекция 2011 3 курс.doc
Скачиваний:
37
Добавлен:
21.09.2019
Размер:
1 Мб
Скачать
☆

3.6. Свойства векторов Dij(0)

а) Dj(0) - орт оси Zj-1, спроецированный на оси СК0., если j = [ПП].

б) Dij(0) = (0j vjj) Rij(0), если j = [ВП].

г) |Dj(0) | = 1, если j = [ПП] .

е) Rij(0) - есть вектор, проведенный из начала СКj-1 к точке на звене i, скорость которой определяется, рассматриваемый в проекциях на оси СК0.

ж) | Rij(0) | - длина вектора, проведенного из начала СКj-1 к точке на звене i, скорость которой определяется.

з) | Dij(0) | = площади прямоугольника, построенного на векторах сj(0) и Rij(0) как на сторонах. Поскольку |сj(0)| = 1, |Dij(0)| численно равен длине перпендикуляра, опущенного из конца вектора Rij(0) к линии вдоль вектора сj(0).

Геометрическая иллюстрация свойств векторов Dij(0) и Rij(0) дана на рис.3.1.

Dij(0) (j = [ПП])

CКi

| (сj(0)) Rij(0) |

Zj-1

i

Dij(0) (j = [ВП])

j

cj(0)

Rij(0)

CКj-1

СК0

Рис.3.1. Векторы Dij(0), Rij(0).

3.7. Матрицы-якобианы линейных скоростей им.

Из выражений для расчета линейных скосротей звеньев ИМ следует

Vn(0) = Dn(0)q`

где

Dn(0) = [Dn1(0) Dn2(0) … Dnn(0) ] -

матрица, составленные из векторов Dj (0) , имеющие размер (3хn).

Матрица Dn(0) линейно связывает между собой векторы производных по времени обобщенных координат ИМ и угловых скоростей последнего (n-го) звена ИМ и носит название матриц-якобианов линейных скоростей (n-го звена) ИМ.

Аналогично можно построить матрицу-якобиан Di(0) для любых других звеньев ИМ.

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

Зная Di(0) , можно составить блочную матрицу D(0) , в которой матрицы Di(0) представлены (блочными) строками размера (3хn) с соответствующими номерами. Размер блочных матриц – (3nхn).

С использованием таких блочных матриц ИМ можно записать выражения выражения для расчета угловых скоростей сразу всех звеньев ИМ:

V (0) = D(0) q` ,

где

V (0) = [V1(0)T V2(0)T … Vn(0)T ]T .

Элементы блочной матрицы D(0) = {Dij(0)} – векторы Dij (0) .

Поскольку в выражениях для расчета линейных скоростей суммирование ведется только до i, элементы матрицы D(0) следует принять равными нулю при j>i.

Блочная матрица D(0) носит название матрицы-якобиана линейных скоростей ИМ.

3.8. Матрица-якобиан последнего звена им.

Выпишем выражения для расчета линейных и угловых скоростей последних звеньев ИМ:

n(0) = Cn(0)q`

Vn(0) = Dn(0)q`

С оставим теперь блочный вектор [n(0) T Vn(0) T]T и блочную матрицу (0), элементы которой сi (0) и Dni(0) :

с1(0) с2(0) … сn(0)

(0) = ------------------------ .

Dn1(0) Dn2(0) … Dnn(0)

Тогда систему уравнений (2.15) можно представить в виде одного уравнения

n(0)

--------- = (0) q` ,

Vn(0)

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

Связь между обобщенными и декартовыми координатами – линейная. Матрица (0), связывающая между собой обобщенные и декартовы кординаты последнего звена ИМ, называется матрицей-якобианом скоростей ИМ или просто матрицей-якобианом.

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

Если при составлении матрицы (0) использовать в качестве элементов векторы сj(0) и Dij(0) , можно решать задачи расчета скоростей любых других звеньев ИМ, а также обратные задачи.