Математическое моделирование кинематики и динамики робота-манипулятора типа «Хобот». 1. Математические модели секции манипулятора, как механизма параллельной кинематики типа «Трипод» Текст научной статьи по специальности «Математика»

Первые публикации

Программы и программные системы

Учебные программы

Студенческая весна

Общие проблемы инженерного образования

Инженер в современной России

Экобионика

Зарубежное образование

История технического прогресса

Будущий инженер

Вне рубрик

Расширеный поиск Подписаться на новости

Электронное научно-техническое издание

НАУКА и ОБРАЗОВАНИЕ

_Эл № ФС 77 - 30569. Государственная регистрация №0420900025. ISSN 1994-0408_

Математическое моделирование кинематики и динамики робота-манипулятора типа «хобот». 1. Математические модели секции манипулятора, как механизма параллельной кинематики типа «трипод»

# 10, октябрь 2009

авторы: Каганов Ю. Т., Карпенко А. П.

УДК 519.6

МГТУим. Н.Э. Баумана, 105005, Москва, 2-я Бауманская ул., д.5.

karpenko@nog.ru

Введение

анизотропия и неоднородность динамических, упругих и скоростных свойств манипулятора; возможность потери управляемости в некоторых конфигурациях манипулятора;

возможность интерференции отдельных кинематических цепей манипулятора, т.е. их соприкосновения;

В настоящее время в машиностроении актуальной является задача разработки технологических машин для выполнения механической обработки внутренних поверхностей полостей сложной формы, например, внутренних каналов охлаждаемых лопаток турбин для авиационной и космической техники. В технологии катастроф необходимы машины для организации доступа к внутренним объемам разрушенных зданий и сооружений. Аналогичные задачи возникают также, при проведении ремонтных и восстановительных работ в трубопроводах, при проведении ряда хирургических операций и т .д. Обычно для решения перечисленных задач используются многозвенные рычажные манипуляторы либо гибкие манипуляторы.

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

Наиболее известным примером механизма с параллельной кинематикой является гексапод или платформа Стюарта, которая состоит из двух пластин, шарнирно соединенных шестью поступательными парами. При изменении длины этих пар происходит пространственное перемещение верхней пластины относительно нижней.

Отметим, что механизмы с параллельной кинематикой требуют использования не прямоугольного (нелинейного) базиса, что порождает следующие особенности манипуляторов такого класса [1]:

а)

б)

в)

г) сложность задания движений манипулятора в обобщенных координатах, связанных со степенями подвижности манипулятора.

Известно несколько проектов, посвященных разработке роботов-манипуляторов типа «хобот». В качестве примеров приведем проект 0СГ01*, осуществляемый рядом университетов США, а также проект ОСАгт, реализуемый также американскими университетами. Проекты находятся в стадии создания опытных образцов роботов. Упомянем также манипуляционный робот ЬХ-4 компании 1_одаЬех построенный на основе гексаподов совместно компанией 1_одаЬех и университетом Торонто (Канада). Манипулятор состоит из 4-х идентичных механизмов параллельной кинематики типа «гексапод» и производится серийно [2].

В первом разделе работы рассматриваются варианты кинематических схем манипулятора типа «хобот» и обосновывается выбор рассматриваемых схем. Второй раздел посвящен разработке математических моделей кинематики и динамики трипода с двумя степенями свободы. Аналогично в третьем разделе рассматривается трипод с тремя степенями свободы. В четвертом разделе рассматриваются математические модели указанных механизмов с параллельной кинематикой, полученные средствами известного программного комплекса Ма^аЬ. В заключении формулируются основные результаты работы.

В работе используется двухуровневая нумерация формул и рисунков, содержащая номер раздела и номер объекта в этом разделе.

1 Кинематические схемы звеньев манипулятора

Вообще говоря, хобот слона, например, способен выполнять следующие движения: растяжение/сжатие; изгиб в любой из плоскостей; поворот вокруг свой оси. В зависимости от целевого назначения робота-манипулятора может быть необходимым воспроизведение не всех этих движений. Поэтому будем рассматривать следующую иерархию возможностей манипулятора:

- изгиб манипулятора в любой из плоскостей;

- изгиб манипулятора в любой из плоскостей, растяжение/сжатие;

- изгиб манипулятора в любой из плоскостей, растяжения/сжатия, поворот вокруг своей продольной оси;

- изгиб манипулятора в любой из плоскостей, растяжения/сжатия, поворот вокруг своей продольной оси, плоско-параллельное перемещение.

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

В манипуляторе второго типа к указанным двум степеням свободы добавляется одна поступательная степень свободы - смещение последующего звена манипулятора относительно продольной оси симметрии его предыдущего звена.

В манипуляторе третьего типа по сравнению с манипулятором второго типа добавляется еще одна вращательная степень свободы - вращение последующего звена манипулятора вокруг оси симметрии предыдущего звена.

Манипулятор четвертого типа обладает всеми шестью степенями подвижности - к возможным перемещениям

СОБЫТИЯ

На сайте еИЬгагу доступна новая услуга - "обсуждение статьи"

Фестиваль мехатроники и робототехники

НОВОСТНАЯ ЛЕНТА

25.11.2009

Олимпиада МГТУ им. Н. Э. Баумана по программированию для школьников старших классов

24.11.2009

Торжественная Церемония вручения "Премии Рунета-2009"

18.11.2009

Список 500 самых мощных компьютеров мира: 34-я редакция

17.11.2009

«Сименс» объявил о начале IV Всероссийского конкурса научно-инновационных проектов для старшеклассников

17.11.2009

17 ноября 2009 года состоится крупное мероприятие для преподавателей и студентов МГТУ им. Н.Э. Баумана «ДЕНЬ ТЕХНОЛОГИЙ MICROSOFT!

Пресс-релизы Библиотека Конференции Выставки оска объявлений рхив

Ассоциация технических Университетов Информация о проекте Авторы

Координационный совет

ПОИСК

Ред. совет Специальности Рецензентам Авторам Архив

Логин

ВХОД

регистрация забыли пароль?

манипулятора третьего типа добавляется два поступательных перемещения.

Отдельного рассмотрения заслуживает последнее звено манипулятора (на котором устанавливаются рабочие органы манипулятора). Целесообразно исходить из необходимости обеспечения перемещения этих органов по пяти-шести координатам.

1.1. Трипод с двумя степенями свободы. Манипуляторы первого типа будем строить на основе механизма с параллельной кинематикой типа трипода, который состоит из неподвижного основания, подвижной платформы, трех штанг, каждая из которых состоит из двух стержней и активной поступательной кинематической пары (привода), а также из центрального неподвижного стержня - рисунок 1.1.

Для оценки числа степеней свободы платформы используем известные формулы Грюблера и Сомова-Малышева.

-4 Основание -

- сферические шарниры; - шарниры Гука;

1,2,3 - поступательные кинематические пары Рисунок 1.1 - Схема трипода с двумя степенями подвижности

Формула Грюблера имеет вид

(1.1)

| подвижностей механизма (управляемых параметров); Й. — 6 - число степеней свободы твердого тела в

где

пространстве; к - общее число твердых тел; Р - общее число соединений; - число степеней свободы каждого из соединений.

Для трипода, представленного на рисунке 1.1, £ = 8, р —10 и — ^ (сферический шарнир),

~^ (шарнир Гука), — 1 (поступательная кинематическая пара). Итого,

2,

т.е. трипод имеет две степени свободы (вращательных). Формула Сомова-Малышева имеет вид

(1.2)

1Г = 1л-£<1-0й

где Й. = 6 - число степеней свободы твердого тела в пространстве; И - число подвижных звеньев механизма; Р1 -число подвижных кинематических пар, имеющих степень подвижности ¿.

Для трипода, представленного на рисунке 1.1, И = 7, Рг (поступательная кинематическая пара), Рг Р\ = ^ (сферический шарнир). Таким образом, так же, как по формуле Сомова-Малышева (1.1),

(шарнир Гука) имеем

.

1.2 Трипод с тремя степенями свободы. Для построения манипуляторов второго типа также используем механизмов с параллельной кинематикой типа «трипод», который состоит из неподвижного основания, подвижной платформы и четырех штанг ног, каждая из которых состоит из двух стержней и активной поступательной кинематической пары (привода) - рисунок 1.2.

Основание

- шарниры Гука; - сферические шарниры; 1,2,3, 4 - поступательные кинематические пары

Рисунок 1.2 - Схема трипода с тремя степенями подвижности

, *=9 п=11и «^«¿¡^(^ = 1

По формуле (1.1) для этого трипода имеем *

(поступательная

кинематическая пара), ^ (шарнир Гука), ^ (сферический шарнир), так что

№" = 6(9—11-1)+ 4x1+ 4x2+3x3 = 3.

Таким образом, трипод, представленный на рисунке 1.2, имеет три степени свободы (две вращательные и одну поступательную).

= 8, Р1 — 4 (поступательная кинематическая пара), — '

Аналогично, из формулы (1.2) следует, что и (шарнир Гука), Рз ~^ (сферический шарнир) и

1^=6x8-5x4-4x4-3x3=3.

1.3 Гексапод с четырьмя степенями свободы. В качестве звеньев манипуляторов третьего типа будем рассматривать механизм с параллельной кинематикой типа «гексапод», который состоит из неподвижного основания, подвижной платформы, шести штанг, каждая из которых состоит из двух штанг и активной поступательной кинематической пары (привода), а также аналогичной седьмой центральной штанги, неподвижно связанной с основанием, а с помощью сферического шарнира - с платформой (рисунок 1.3).

"б*" - сферические шарниры; —- шарниры Гука;

1 - 7 - поступательные кинематические пары Рисунок 1.3 - Схема гексапода с четырьмя степенями подвижности

=1

По формуле Грюблера (1.1) имеем £ = 15, Р — 20, >ниры Гу

1¥ =6(15-20-1) +7x1 + 6x2 + 7x3 =4.

(поступательные кинематические

пары),

3 - 2 (шарниры Гука),

» _ч

. (сферические шарниры), Таким образом,

Аналогично из формулы Сомова-Малышева (1.2) следует, что л =14, Р1 = 7 (поступательные

кинематические пары), Ръ =6 (шарниры Гука), ™3 (сферические шарниры). Итого,

.

1.4 Гексапод с шестью степенями свободы. В качестве звеньев манипуляторов четвертого типа будем рассматривать механизм с параллельной кинематикой типа «гексапод», который состоит из неподвижного основания, подвижной платформы и шести ног, каждая из которых состоит из двух стержней и активной поступательной кинематической пары (привода) - рисунок 1.4.

пары),

—- сферические шарниры; —- шарниры Гука;

1,2,3 - поступательные кинематические пары Рисунок 1.4 - Схема гексапода с шестью степенями подвижности

=1

По формуле Грюблера (1.1) имеем £ = 14, Р~ 1®, —-* (поступательные кинематические

^12 —^ (шарниры Гука), ^В'^И*——^ (сферические шарниры). Таким образом,

.

и=13, А = 6

Аналогично из формулы Сомова-Малышева (1.2) следует, что кинематические пары), Р1 ~ ®

(поступательные

(шарниры Гука), Л ® (сферические шарниры). Итого,

.

2 Кинематика и динамика трипода с двумя степенями свободы

2.1 Обратная задача кинематики. Использование механизмов параллельной кинематики приводит к усложнению задач управления манипуляторами на основе этих механизмов. Однако некоторые задачи кинематики и для таких механизмов, например, обратная кинематическая задача, решаются просто.

Пусть обобщенными координатами являются длины стержней Аа ВЬ, Сс соответственно

(рисунок 2.1). Пусть также в неподвижной декартовой системе координат СЖН координаты точек равны

точек а,Ъ,с. . где /е{ДД,С} 1е{лДс} Тогда очевидно, решение

обратной задачи кинематики для трипода (как с двумя, так и с тремя степенями сободы) дает следующая система уравнений:

.

Рисунок 2.1 - Схема трипода

2.2 Прямая задача кинематики. Свяжем с основанием систему координат АХ12 таким образом, что

начало координат А совпадает с центром симметрии основания, ось ЛЗГ проходит через шарнир 4, ось ЛТ направлена по нормали к основанию, а ось образует с осями АХГ, правую тройку. Аналогично, свяжем с платформой систему координат ^У2 (рисунок 2.2).

Рисунок 2.2 - Системы координат АХУУ., ^Ч®

Тогда положение шарниров в системе координат АХУ/. определяется векторами

Дг "(^А-^)7 - С4г.1-Дг.з*Ди)Г='

Аналогично, положение шарниров

в системе координат

Вхуг

определяется векторами

,Ь Л Ь

2 2

Положение платформы относительно основания зададим углами Эйлера Фг-ЧЪ (рисунок 2.3).

Тогда геометрические соотношения между системами координат АХХ£, ^У2 можно представить в виде (4x4) матрицы однородных преобразований

Рисунок 2.3 - К преобразованию систем координат

Таким образом, положение шарнира в системе координат АХ1Г£ определяется вектором

Отсюда следует, что обобщенная координата 'г, как функция углов ЯЧ-ЧЪ определяется выражением

,

где одну из величин

кл^л

следует трактовать, как избыточную обобщенную координату.

(2.1)

Выражения для скоростей и ускорений концов штанг (ТОчек легко найти, дифференцируя

и дважды дифференцируя по Ф выражение (2.1) соответственно. Однако эти выражения оказываются слишком громоздкими и мало пригодными для практического использования. Исследование скоростей и ускорений концов штанг

проще производить с помощью математического моделирования, например, с использованием программной системы Ма^аЬ (см. ниже).

2.3 Динамика механизма. Поскольку поступательные движения платформы отсутствуют, уравнения движения платформы будем искать в форме уравнений Лагранжа

а Ъ

/Ж

¿К л

1=Ц

(2.2)

где £ - кинетическая энергия системы; - обобщенная сила, соответствующая I -ой обобщенной координате.

Положим, что платформа, как твердое тело, симметрична относительно оси , так что ее моменты инерции J J J =J =J „

" равны: х * . В таком случае ее кинетическая энергия равна

(2.3)

Положим, что поступательная кинематическая пара, связанная со штангой является пассивной.

Выпишем силы, действующие на платформу, а также радиусы-векторы ' на оси системы координат :

точек их приложения в проекциях

;

;

и единичным вектором J -ой оси системы координат АХ1"А . Из определения скалярного произведения векторов легко получить явные выражения для косинуса этого угла:

Здесь - косинус угла между штангой

Таким образом, выражения для обобщенных сил 61=63 имеют вид

,

или

& = ^ нвг^СЛц]- Рг нв

Подставляя выражение (2.3) - (2.5) в уравнение (2.2), получим искомую систему обыкновенных дифференциальных уравнений второго порядка

(2.4)

(2.5)

(2.6)

Заметим, что в уравнении (2.6) силы ^з - это внешние силы, которые могут быть заданы как функции

времени, как функции обобщенной координаты Ф, а также как функции длин «своих» стрежней = Наоборот, при заданном законе изменения Ф из уравнения (2.6) могут быть найдены необходимые управляющие силы, как функции времени.

3 Кинематика и динамика трипода с тремя степенями свободы

Обратная задача кинематики для данного трипода рассмотрена в разделе 2. Перейдем поэтому к рассмотрению прямой задачи кинематики.

3.2 Прямая задача кинематики. Пусть невесомые стержни

«=1АЗ

состоят из двух полуштанг,

связанных поступательными кинематическими парами, присоединены к платформе в точках г с помощью

сферических шарниров, а к основанию в точках Дг - с помощью универсальных шарниров; невесомый стержень АВ, состоящий аналогично из двух полуштанг, связан с основанием неподвижно, а с платформой - с помощью

А 1.

универсального шарнира (рисунок 3.1). Точки г образуют правильный треугольник со стороной О и с центром в

точке В, в которой находится центр масс платформы. Будем считать, что неподвижная платформа (основание) горизонтальна и точки Дг также образуют правильный треугольник со стороной а и с центром в точке А. Опорные стержни имеют длины и наклонены к плоскости основания под углами (®

Расстояние между точкой В и основанием (плоскостью АХ2) обозначим Й . Введем также следующие обозначения:

Свяжем с основанием систему координат АХ32 таким образом, что начало координат А совпадает с центром симметрии основания, ось АХ проходит через шарнир 4, ось АТ направлена по нормали к основанию, а ось

А2 образует с осями АХ, АТ правую тройку. Аналогично, свяжем с платформой систему координат ^У2 (рисунок 3.1).

Рисунок 3.1 - Геометрия трипода с тремя степенями свободы

Положение шарниров в системе координат ЛХ12 определяется векторами

Л ^ ° (А.А.Л^

Аналогично, положение шарниров

л, = (-ЛЛ0)Т =(Л.,.Л.7.Л0Г-

в системе координат ^ЧУ2

определяется векторами

(3.1)

(3.2)

Положение платформы относительно основания определяется углами Эйлера 4*1-Ч*г (рисунок 2.3) и вектором

— — Поэтому геометрические соотношения между системами координат ЛХ^'А , можн

представить в виде (4x4) матрицы однородных преобразований

(3.3)

Из выражений (3.1) - (3.3) следует, что положение шарнира г в системе координат АХ1ГА определяется вектором

где

РМ

Е*а1 1

Га Л

1 }

-июф,

-5Юф1СОЕф3+-5к1ф3+А

ь . ь

-втф15Ш1ф3+-акф3 1

(3.4)

Из формул (3.1), (3.4) следует, что обобщенная координата как функция расстояния Й и углов ЧЧ-Фг определяется выражением

ь== I=

(3.5)

Выражения для скоростей и ускорений концов штанг ^^З^З (точек легко найти, дифференцируя

и дважды дифференцируя по ^ЧН^ЧЬ выражения (3.5) соответственно. Однако эти выражения оказываются слишком громоздкими и мало пригодными для практического использования. Исследование скоростей и ускорений концов штанг

проще производить с помощью математического моделирования, например, с использованием программной системы Ма^аЬ.

3.2 Динамика механизма. По методике подраздела 2.3 найдем уравнения движения платформы в форме уравнений Лагранжа

г=\Л

,3,

(3.6)

где £ - кинетическая энергия системы; 9\ ЧЧ, Фз - обобщенные координаты; - обобщенная

сила, соответствующая 1-ой обобщенной координате.

Положим, что платформа, как твердое тело, симметрична относительно оси ^У, так что ее моменты инерции ^х'^х равны: ^х ~ ^х ~ ^ (рисунок 3.2).

Рисунок 3.2 - Силы, действующие на платформу

Массу платформы обозначим М . В таком случае ее кинетическая энергия равна

2

(3.7)

где - величина полной скорости центра масс платформы В .

Поскольку в системе координат АХ1/. вектор скорости , эта величина равна — "

(рисунок 3.2).

Выпишем силы, действующие на платформу, а также радиусы-векторы

К, к, 1=1Д З

точек их

Наука и Образование: научно-техническое издание: Математическое моделирование кинематики и динамики робота-манипулятора типа «хобот». 1. Математические мо.. приложения в проекциях на оси системы координат ЛХЛ'А :

Р =(0, К - тм, V, «к Т, „ Ъ\ акт,, У

К, = (ОАО)7 к - 0Л,11Л2Ш131Г

(3.8)

(3.9)

Здесь аналогично подразделу 2.3

СИ!Ти = СЖТуС^ЧЬ) .

Л£

Нам далее понадобятся матрицы Якоби г векторов

[В.],

К^ КДА^ф,) 1=|ДЗ

Из выражения для

_го

вектора 1"и следует, что компоненты матрицы определяются формулами

_ ™ ь ■

ж

ш

&1

О -Я,

«Ре 2 а^

Л,

дк

11г-—|-=-НВф1С«Вф3 =

«Р| 2 «р..

-5Шф15Пф3+-С1К<р2

1Д1

О

■ид

<* '>1 2 [В3]

— аКф|Я1ф2 =- = ЯК^ОЕф-, - !Л

арг

Аналогично, из выражения для вектора

ж

следуют выражения для компонентов матрицы

Ж,

да.

зл

г1 О -

?и зн щ а*

2

ж

ав.

г.3

а»,.

г:з

3.3.1

Ж

3.3.3

1 мгг2 -тгг - Ф1чь

* . . а

- -ятф1ятф3--акф5

ар3

л

ав^.

ав,.

--О ■Яз.з.з =

эй ^Рк 2 ар3

З.ЗД

с»,., ь .

Ь .

2™Ф1«кф3--ятф3

По такой же схеме из выражений для вектора

ы

вытекают выражения для компонентов матрицы

ал,., „

ЗА

авХ7 эв,.7

— Г ГХК ф, ГХК ф2 Жу23 =- ГЯ1 ф, 31 ф^

О -л

53.2

ЭФе

ар3

ГГХКф, Ф2 Л!

ав.

V*

ЗАЗ

ар3

= -ГБпф1акф3

Составим выражение для работы на элементарных приращениях и, в соответствии с методикой составления уравнений Лагранжа, приравняем его нулю:

Здесь

(Г,Ж,) + (Р1,Б1Е1) + (^Ж,) + = 0.

ж, =(о,а,о) йч\ ъьУ i=1ДЗ

(3.10)

Из выражений для компонентов матриц

I 1ДЗ следует, что

ь. „

вй + ^ИВ ф^ ык ф3Бч\ - ^ ят ф^ ят фзБфг + ^ нвф3Бфг Ь . Ь . * -

-сояч^ ж фзйф, + -ят ф1 спяф36ф, - -ят ф3йф!

1 Ь )

BR3

Ь .

Ф1&Р1

5f¡ I ^COSlJ»! ОКф^ф, fjS^j —

^ икф! ski ф3Б<ц + ^ sn ч^ совфзбфз - ^ ski (fc&fc

^ 2 2 2

,

SRs

rski ф,йф,

ЙА + гакф1с1кфгБф, + гй VfSi ф^Бф, -rcosqi|ñ фгБчц — raí ф1нвф35ф3

J

Таким образом, учитывая (3.8), (3.9), из (3.10) имеем

МфЬ I

и* 2

^-нвуцМ ф|&|\ + cus y^j (2/ЬБЬ +cus ф1акф3Бф1 — м ^яф^бф; +со5ф,5ф3) + + cusru(ciisq^ sh ф35ф^ + ski ф1 окф^Бфз-sm ф2Бф2)

2 3^<жт„(акф1ятф3бф14^ф1с(кф3Бф3-даф3Бф;)

=0. (3.11)

Приравнивая в выражении (3.11) коэффициенты при независимых приращениях получим

следующие значения обобщенных сил:

(-

'Jxi ™ ф| + "»Tu ™sФ1 нвФз )+ ч^ + ывтггз cosqj, мкф2 -

ST„ cnsq^s

1ф2)н

+ г К

("«Til!

L ф, + ГХК уъ 2 гхгс ф, гхк ф^ ros f^j гхк ф, ski

Фз^

Подставляя выражения (3.12) - (3.14) в формулу (3.7), получим искомую систему обыкновенных дифференциальных уравнений

(3.12)

(3.13)

(3.14)

(3.15)

(3.16)

(3.17)

В уравнениях (3.15) - (3.17) силы - это внешние (управляющие) силы, которые могут быть заданы

как функции времени, как функции обобщенных координат ^ФиФз, а также как функции длин «своих» стрежней

+

+

Наоборот, при заданных законах изменения величин из этих уравнений могут быть найдены

необходимые управляющие силы, как функции времени.

4 MatLab моделирование кинематики и динамики трипода с двумя степенями свободы

Для проектирования и анализа механических систем (например, различных кинематических цепей) в рамках программной системы MatLab сущестует пакет SimMechanics - расширение модуля Simulink для физического моделирования. Пакет SimMechanics содержит набор инструментов для задания параметров кинематических звеньев механической системы (масса, моменты инерции, геометрические параметры), кинематических ограничений, локальных систем координат, способов задания и измерения движений. SimMechanics позволяет создавать модели механических систем подобно другим Simulink-моделям в виде блок-схем. Встроенные дополнительные инструменты визуализации Simulink позволяют получить упрощенные изображения трехмерных механизмов, как в статике, так и в динамике [3].

Модуль Simulink позволяет визуализировать движения моделируемой механической системы. Кроме того, модуль Simulink позволяет анализировать законы движения любой точки моделируемого механизма. Для этого необходимо к выходу соответствующего Simulink-блока подключить датчик - Sensor. Датчики могут регистрировать угловые и линейные перемещения, а также соответствующие скорости и ускорение. Выход датчика обычно соединяют с «осциллографом» - Scope.

Simulink-модель указанного трипода приведена на рисунке 4.1. Для наглядности на рисунке не показаны датчики и «осциллографы ». Приняты следующие обозначения: 1 - платформа; 2 - подвижная штанга; 3 - неподвижная штанга; 4 - сферический шарнир; 5 - верхняя полуштанга; 6 - призматическая кинематическая связь; 7 - нижняя полуштанга; 8 - шарнир Гука (карданный шарнир).

Simulink-модель рассматриваемого трипода с датчиками и «осциллографами» приведена на рисунке 4.2. Здесь использованы обозначения: 1 - блок регистрации перемещений, скоростей и ускорений платформы; 2 - блок измерения координат; 3 -блок измерения скоростей; 4 - блок измерения ускорений; 5 - блок актуатора штанги, обеспечивающего изменение ее длины; 6 - блок связи.

Использованные в модели средства визуализации движения представлены на рисунке 4.3.

Тестирование модели выполнено при изменении длины одной и его подвижных штанг по закону, представленному на рисунке 4.4. В этом случае, очевидно, ускорение движения этой штанги постоянно; длина

Ай до величины .

изменяется от величины

Формирование приведенного на рисунке 4.4 закона движения штанги выполнено с помощью блока БтиПпк-модели трипода, схема которого приведена на рисунке 4.5. Здесь приняты следующие обозначения: 1 - блок формирования перемещения штанги; 2 - блок измерения скорости перемещения штанги; 3 - блок измерения ускорения перемещения штанги.

Рисунок 4.2 - Полная 81тиИпк-модель трипода с двумя степенями свободы

Рисунок 4.3 - Визуализации движения гексапода (фрагмент)

Вреия(с)

Рисунок 4.4 - Тестовый закон изменения длины одной из штанг трипода

Рисунок 4.5 - Simulink-модель блока, формирующего тестовый закон изменения длины штанги

Заключение

На основе анализа требуемых движений манипулятора типа «хобот» произведен выбор вариантов конструктивных схема секций манипулятора - трипода с центральной неподвижной штангой, классического трипода, гексапода с центральной неподвижной штангой и классического гексапода. С помощью формул Грюблера и Сомова-Малышева выполнен анализ числа степеней свободы указанных конструктивных схема секций манипулятора.

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

Аналогичные результаты получены для трипода с тремя степенями свободы.

Кроме того, для трипода с двумя степенями свободы разработана Simulink-модель его кинематики и динамики. Тестовые эксперименты с указанной моделью показали ее адекватность.

Полученные в работе результаты представляют самостоятельный интерес, а также могут быть использованы для построения математических моделей многосекционного робота-манипулятора типа «хобот».

Литература

1 ; Подураев Ю.В. Мехатроника: основы, методы, применение. - М.: Машиностроение, 2007. - 256 с.

2 ; J.P.Merlet. Parallel Robots. Solid mechanics and its applications. - Kluwer Academic Publishers, V. 74, 2000.

3 ; Махов А.А. Моделирование механических систем с помощью пакета расширения SimMechanics / http://exponenta.ru/educat/systemat/mahov/simmechanics.asp

Публикации с ключевыми словами: кинематика, динамика. робот-манипулятор, трипод. гексапод Публикации со словами: кинематика. динамика. робот-манипулятор. трипод. гексапод Смотри так же:

Математическое моделирование кинематики и динамики робота-манипулятора типа «хобот». 2. Математические модели секции манипулятора. как механизма параллельной кинематики типа «гексапод»

Тематические рубрики:

Наука в образовании: Электронное научное издание

Rambler's Top100

moil run

Ассоциация технических Университетов Координационный совет Вузы Новости Информационное агентство УМО Вузов

Jmaqazine@xware.ru «».ф™ (ядчч) 263-68-67 Q RSS П STPGK GROUP

© 2003-2009 «Наука и образование: электронное научно-техническое издание»