Кинематический анализ манипулятора

Кинематический анализ манипулятора

1. Кинематический анализ манипулятора

Исходная схема плоского манипулятора с тремя степенями свободы приведена на рис. 1. Его структурная формула: [SП_Х] + (П_YП_X) + (П_YB) + (BC).

Исходные данные приведены в таблицах 1 и 2.

Рис. 1. Исходная схема плоского манипулятора с W = 3

Таблица 1. Фиксированные параметры

Направление стойки ОЕ - вдоль оси Y задано углом φ₀ = 90°.

Конструктивный угол в поступательных парах

{0-1}: φ₁₀ = 0° = const;

{1-2}: φ₂₁ = 0° = const.

Обобщённые координаты являются некоторыми функциями времени t.

S₁₀ = S₁₀ (t); S₂₁ = S₂₁(t); φ₃₂ = φ₃₂ (t).

Их величины ограничены снизу (min) и сверху (max). Изменение всех обобщённых координат от минимальных до максимальных значений происходит одновременно за время t_m = 4 с.

Исходные значения обобщённых координат в общем виде даны в таблице 2. Численные значения их предельных (min и max) и средних (mid) значений приведены в таблице 3.

манипулятор кинематический ускорение электронный

Таблица 2. Обобщённые координаты манипулятора

Таблица 3. Предельные и средние значения обобщённых координат

1. Расчёт степени подвижности плоского механизма по формуле П.Л. Чебышёва

,

где W - степень подвижности системы;

n - количество подвижных звеньев кинематической цепи;

 p₁ - количество одноподвижных кинематических пар;

p₂ - количество двухподвижных кинематических пар.

.

Это значит, что необходимо задать три координаты каким-либо подвижным звеньям механизма в системе координат, жестко связанной со станиной, чтобы определить положения всех звеньев. Таким образом, для управления таким манипулятором требуется три независимых привода.

2. Расчёт маневренности манипулятора. Условно закрепляем центр схвата посредством шарнира С₀ (рис. 2).

Рис. 2. К расчёту маневренности манипулятора

Здесь число подвижных звеньев осталось прежнее, n = 3 {1,2 и 3};

число одноподвижных пар изменилось, p₁ = 4 {0-1, 1-2, 2-3 и 3-0};

число двухподвижных пар не изменилось, p₂ = 0.

Для полученной схемы рассчитываем число степеней свободы по формуле П.Л. Чебышева

,

.

Полученный результат означает, что к заданной точке С₀ центр схвата можно подвести несколькими конфигурациями системы звеньев, но произвольно изменять можно только одну из трёх обобщённых координат, например S₁₀, остальные же станут зависимыми от неё функциями: S₂₁(S₁₀) и φ₃₂(S₁₀).

Вывод: исходная модель имеет три степени свободы W = 3, а её маневренность составляет W_м = 1.

.1 Корректировка исходной схемы манипулятора

Схема на рис. 2 соответствует данным задачи и на ней показано фактическое расположение звеньев манипулятора. Построим в масштабе по средним данным векторный контур ОABDCO из отрезков схемы манипулятора (рис. 3).

Рис. 3. Векторный контур

1.2 Расчёт параметров положения звеньев

. Расчёт средних значений обобщённых координат

. Расчёт угловых координат в глобальной системе

φ₀ = 90^О;φ₁ = 0^О;φ₂ = 90^О;φ₃ = <φ₃₂> + 90^О = -40 + 90 = 50^O.

Средние значения для дальнейших расчётов сведены в таблицу 4.

Таблица 4. Значения обобщённых координат и глобальные углы.

. Расчёт координат центра схвата С.

По методу замкнутого векторного контура (рис. 3) имеем

С учётом принятых обозначений в исходных данных (табл. 1) векторное уравнение, определяющее положение точки С, можно записать в виде

Используя разложение любого вектора на его проекции на оси X и Y, можем записать следующие выражения

;

;

;

;

;

.

. Модуль радиус-вектора центра схвата С

.

Угол α направления радиус-вектора R_С с осью Х

 > 0

 > 0

Так как cosα и sinα больше 0, то угол α острый (0^O<α<90^O), и лежит в I-ой четверти, а определяется через арксинус или через арккосинус

Окончательные результаты решения задачи положения центра схвата С

; ; ; .

1.3 Расчет скоростей

. Расчёт средних значений относительных скоростей соседних звеньев в кинематических парах

Поступательная пара А {1-0}

Угловая скорость звена 1 относительно стойки 0, ω₁₀ = 0, так как φ₁₀ = const.

Линейная скорость звена 1 относительно стойки 0:

Поступательная пара В {2-1}

Угловая скорость звена 2 относительно звена 1, ω₂₁ = 0, так как φ₂₁ = const.

Линейная скорость звена 2 относительно звена 1:

Вращательная пара D {3-2}

Угловая скорость звена 3 относительно звена 2:

градусная мера ;

радианная мера .

Линейная скорость звена 3 относительно звена 2 V₃₂ = 0, так как S₃₂ = L₃ = const

. Расчёт абсолютных угловых скоростей звеньев относительно стойки:

звено 1: ;

звено 2: ;

звено 3: .

Рассчитанные значения скоростей сведём в таблицу 5.

Таблица 5. Угловые и линейные параметры и скорости

3. Проекции скорости V_С центра схвата С.

Расчёт проекций скорости проводим для n = 3 по значениям из таблицы 5 по следующим формулам

;

.

Подставим данные из таблицы 5 и выполним вычисления

. Модуль вектора скорости центра схвата С

.

Угол β направления вектора V_С с осью Х

 < 0

 > 0

Так как cosβ<0, а sinβ > 0, то угол β тупой (90^O<β<180^O), и лежит во II-ой четверти, а определяется через арккосинус (но не через арксинус)

Окончательные результаты решения задачи скоростей центра схвата С

; ; ; .

1.4 Расчёт ускорений

Исходными данными при расчёте ускорений служат результаты решения задачи скоростей. Для средних значений обобщённых координат исходные параметры сведены в таблицу 6.

Таблица 6

1. Проекции ускорения а_С центра схвата С.

Расчёт проекций ускорения проводим для n = 3 по значениям из таблицы 6 по следующим формулам

;

.

Рассчитываем каждую сумму по отдельным i-м слагаемым

;;

Подставим численные значения и вычислим проекцию а_хс

При i = 1: ;

При i = 2: ;

При i = 3: ;

.

;

.

Суммируя полученные результаты, находим

.

Подставим численные значения и вычислим проекцию а_yс

При i = 1: ;

.

При i = 2: ;

.

При i = 3: ;

;

.

Суммируя полученные результаты, находим

.

2. Модуль вектора ускорения центра схвата С

.

Угол γ направления вектора a_c с осью Х

 < 0

 < 0

Так как cosγ<0 и sinγ < 0, то угол γ тупой (-90^O<α<-180^O), и лежит в III-ей четверти, а определяется через арккосинус (а не через арксинус)

Окончательные результаты решения задачи ускорений центра схвата С

; ; ; .

Итоговые результаты кинематического анализа сведём в таблицу 7

Таблица 7. Характеристики центра схвата манипулятора.

2. Моделирование манипулятора на ЭВМ

Кинематический анализ манипулятора выполним путём его моделирования на ЭВМ с помощью программы “Манипуляторы 3 степени свободы v0.2.2”.

Графические результаты моделирования представлены в файлах “Манипулятор - среднее положение”, “Манипулятор - зона обслуживания” и “Манипулятор - зона обслуживания -1”.

Данные моделирования представлены в таблице 8 в сравнении с данными, полученными расчётным путём.

Таблица 8. Сравнительные характеристики центра схвата

Путём моделирования получена геометрическая конфигурация зоны обслуживания (рис. 4). Задание предельных координат положения звеньев манипулятора позволило определить координаты характерных точек зоны обслуживания (таблица 9).

Таблица 9. Координаты характерных точек зоны обслуживания.

Рис. 4. Геометрическая конфигурация зоны обслуживания

3. Графоаналитический метод планов

. Построение плана механизма (рис. 5).

Принимаем произвольно АВ = 150 мм. Тогда масштабный коэффициент плана будет:

.

Размеры изображений на плане составляют (показаны длины звеньев)

;

Построим в масштабе план манипулятора (рис. 5) для средних значений обобщённых координат, указанных в таблице 4. Красной линией показан радиус-вектор центра схвата ОС. Его длина, измеренная на распечатке рисунка, ОС = =189,5 мм.

,

измеренный угол α = 53^О, что совпадает с аналитическим решением.

. Построение плана механизма (рис. 6).

На плане механизма (рис. 5) дуговой стрелкой показана абсолютная угловая скорость звена 3. Направление выбрано в сторону возрастания обобщённой угловой координаты φ₃₂.

.

Линейными стрелками показаны относительные скорости поступательного движения в парах А и В и вращательного движения в паре D. Масштаб векторов скоростей на рис. 5 .

Рисунок 5

. Построение плана скоростей

Построим план скоростей (рис. 6). Произвольно выберем масштаб скоростей .

Определим величину образов векторов скоростей

Определим относительную линейную скорость точки С от вращательного движения звена 3 относительно точки D

Направление вектора скорости  перпендикулярно направлению звена 3, т.е. угол этого вектора

.

Найдём проекции этого вектора

Определим величину образов векторов скоростей

3. Построение плана ускорений

Исходные данные, необходимые для построения плана ускорений.

Длина L_DC = L₃ = 40 см.

Скорость ω₃ = 0,349 .

Угловые ускорения ε₀ = ε₁ = ε₂ = ε₃ = 0.

Относительные ускорения а₁₀ = а₂₁ = 0.

Точка С вращающегося звена 3 движется по окружности с центром D с постоянной угловой скоростью ω₃. Тангенциальное ускорение отсутствует, так как ε₃∙L₃ = 0. Вектор полного ускорения  содержит только нормальную составляющую. Она направлена к центру D независимо от направления вращения (ω₃), а модуль ускорения имеет величину:

.

Ввиду простоты плана ускорений построим его на рис. 5 (сиреневый цвет). Произвольно выберем масштаб ускорений .

Направление вектора ускорения  противоположно направлению звена 3, т.е. угол этого вектора

.

Найдём проекции этого вектора

;

.

Определим величину образов вектора ускорений

;

;

.

Рис. 6. План скоростей

В таблице 10 произведено сравнение величин компонент скорости центра схвата определённых 4 способами.

Таблица 10. Сравнительные скорости центра схвата.

Расчёт на стр. 8 и моделирование на ЭВМ выполнены с ошибками, т.к. основаны на ошибочных формулах, приведённых в МУ на стр. 9 (16) и (17) и на стр. 17 без номеров.

Исправленные формулы приведены в файле “МУ - стр 8 - исправление”

Ниже на стр. 18 приведён исправленный расчёт со стр. 8 настоящего файла.

Исправленный расчёт со стр. 8

Подставим данные из таблицы 5 и выполним вычисления

4. Модуль вектора скорости центра схвата С

.

Угол β направления вектора V_С с осью Х

 > 0

 > 0

Так как cosβ>0 и sinβ > 0, то угол β острый (0^O<β<90^O), и лежит в I-ой четверти, а определяется через арккосинус или через арксинус

Окончательные результаты решения задачи скоростей центра схвата С

; ; ; .