Для решения прямой задачи кинематики необходимо составить матрицы. В нашем случае матрицы A1 ,A3 и A4 - матрицы сдвига, а A2 - матрица вращения. Эти матрицы получаются из результирующей матрицы перехода, связывающей системы (i-1) и i.
Рассчитаем результирующие матрицы перехода для заданной кинематической системы манипулятора.
; ; ;
Задача решается при помощи формулы:
Решение прямой задачи кинематики сводится к тому, что имея значения обобщенных координат определяются элементы матрицы T, которая однозначно устанавливает положение и ориентацию схвата в системе координат стойки.
Координаты центра схвата в системе, связанной со стойкой манипулятора:
3.4.8 Решение обратной задачи кинематики
Обратную задачу кинематики можно сформулировать так : задана кинематическая схема манипулятора и известны положение и ориентация схвата в системе координат стойки. Требуется определить значения обобщенных координат, которые обеспечат заданное положение схвата.
Задать положение схвата, как и любого твердого тела, можно с помощью шести величин. Обычно три из них - это координаты центра схвата, еще две - это направляющие косинусы одной из координатных осей схвата и последняя - это один из направляющих косинусов другой координатной оси схвата. Например, этими шестью величинами могут быть шесть наддиагональных элементов матрицы Тn.
Приравнивая шесть заданных величин соответствующим элементам матрицы Тn, получим систему шести уравнений (в общем случае трансцендентных), неизвестными в которых являются обобщенные координаты.
Если n = 6, то есть число неизвестных равно числу уравнений, то обычно можно отыскать вполне определенные значения обобщенных координат.
Если манипулятор имеет больше шести степеней свободы, то есть число неизвестных превышает число, то одному и тому же положению схвата могут соответствовать различные наборы значений обобщенных координат.
И наконец, если n < 6, то решения не существует, то есть за счет меньшего, чем шесть, числа обобщенных координат невозможно получить наперед заданные произвольные положение и ориентацию схвата.
Однако, если требуется лишь попадание центра схвата в определенную точку пространства ориентация схвата может быть любой, то для этой цели годится манипулятор с тремя степенями свободы. В этом случае при решении задачи потребуется составить лишь три уравнения для нахождения трех неизвестных.
Рекомендуем скачать другие рефераты по теме: мировая торговля, банк курсовых работ бесплатно.