Студопедия.Орг Главная | Случайная страница | Контакты | Мы поможем в написании вашей работы!  
 

Матрица преобразования координат (матрица перехода) для поступательной КП. Пример



Пусть звенья s и (s –1) связаны поступательной кинематической парой (рис.2.15), тогда обобщенная координата qs – поступательное перемещение звена s относительно звена (s –1). Свяжем со звеном (s –1) систему координат 0s-1xs-1ys-1zs-1, а со звеном s – систему координат 0sxsyszs. Для определенности условимся так выбирать систему координат 0sxsyszs, чтобы ось s совпадала с линией относительного перемещения звеньев s и (s –1). Отметим, что в процессе работы механизма углы между звеньями s и (s –1) и соответствующими системами координат не меняются, поэтому Аs-1,s = const; перемещается точка отсчета 0s относительно звена (s –1). Пусть в начальном положении при qs = 0 система 0sxsyszs занимает положение 0s*xs*ys*zs*. Начальное положение определяется вектором . Найдем вектор :

(2.53)

Составим матрицу перехода в поступательной паре:

(2.54)

Рассмотрим пример (рис.2.16). Исполнительный механизм промышленного робота состоит из трех подвижных звеньев, связанных тремя кинематическими парами: двумя вращательными и одной поступательной. Из формулы Малышева–Сомова следует, что механизм обладает тремя степенями подвижности: W =6(4-1)-5×3=3. Следовательно, надо задать три обобщенные координаты: q1, q2, q3. Свяжем с каждым из подвижных звеньев локальные системы координат 01x1y1z1, 02x2y2z2, 03x3y3z3 так, как показано на рисунке. Зададим начальное положение каждой из систем координат: 01*x1*y1*z1*, 02*x2*y2*z2 *, 03*x3*y3*z3*. Для удобства зададим начальное положение звена 1 так, чтобы система координат 01*x1*y1*z1* совпадала с неподвижной системой 0x0y0z0. Зададим конструктивные параметры схемы a, b, c и входные обобщенные координаты q1, q2, q3. Требуется построить функцию положения точки М, принадлежащей третьему звену, или, иначе говоря, найти координаты точки М в неподвижной системе отсчета .

Решение. Положение точки М в системе координат 03 х 3 у 3 z 3 можно задать вектором-столбцом:

В соответствии с (2.49):

Составим матрицы перехода:

Для составления матрицы А12 построим табл. 2.4 направляющих косинусов:

Таблица 2.4

  X2 Y2 Z2
X1      
Y1   –1  
Z1      

Тогда матрица перехода Н12 (q2):

.

Для построения матрицы А23 *(0) составим табл. 2.5 направляющих косинусов:

Таблица 2.5

  X3* Y3* Z3*
X2      
Y2 –1    
Z2      

Найдем матрицу перехода :

Подставляя найденные матрицы перехода, получим:

.





Дата публикования: 2015-02-20; Прочитано: 652 | Нарушение авторского права страницы | Мы поможем в написании вашей работы!



studopedia.org - Студопедия.Орг - 2014-2024 год. Студопедия не является автором материалов, которые размещены. Но предоставляет возможность бесплатного использования (0.008 с)...