Размещено на http://www.allbest.ru

Размещено на http://www.allbest.ru

РОССИЙСКИЙ УНИВЕРСИТЕТ ДРУЖБЫ НАРОДОВ

ИНЖЕНЕРНЫЙ ФАКУЛЬТЕТ

КАФЕДРА КИБЕРНЕТИКИ И МЕХАТРОНИКИ

Дипломная работа

на тему

“Моделирование процесса нанесения краски устройством с применением робота Kawasaki”

550200 "Автоматизация и управление"

Разработчик

Студент группы ИУБ-401

Акела Ашраф .

Руководитель

к.т.н., доцент

кафедры Кибернетики и мехатроники

инженерного факультета РУДН

Внуков А.А.

Москва, 2013 г.

Оглавление

• 1. Обзор современных робототехнических комплексов
• 1.1 Определения работа 6
• 2. Формальная постановка задачи 26
• 2.1 Описание задачи 26
• 2.2 Описание рабочей системы 27
• 2.3 Способы управления движением манипулятора 29
• 2.4 Формулировка требований 31
• 3. Прямая задача кинематики 33
• 3.1 Описание робота-манипулятора. Представление Денавита-Хартенберга 33
• 3.2 Прямая задача кинематики 40
• 3.3 Обратная задача кинематики робота-манипулятора 42
• 3.4 Решение методом Ньютона 50
• 3.5 Позиционирование захвата робота 52
• 3.6 Построение траектории 57
• 4. Разработка программной реализации алгоритмов 62
• 4.1 Прямая задача кинематики 62
• 4.2 Обратная задача кинематики 63
• 4.3 Позиционирование 71
• Заключение 75
• Библиографический список 76
• Приложение 79
• Введение

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

Эффективность деятельности предприятия во многом зависит от автоматизации технических процессов. Минимизация человеческого труда везде, где это возможно приводит, как правило, к увеличению качества производимых изделий. Разница заметна при сравнении продукта, изготовленного вручную и того, что был создан при помощи специализированного робота, и она тем значительнее, чем сложность производимых изделий выше, а начиная с определённого момента, возникают такие задачи, которые никаким другим способом, кроме как автоматизированным решить невозможно. Точность, сложность и безопасность определённых видов работ затрудняют вмешательство человека.

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

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

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

Цель квалификационной работы бакалавра - разработать алгоритмы и решения, позволяющие организовать процесс нанесения рисунков на поверхность изделия при помощи робота-манипулятора FS03N фирмы Kawasaki. Полученные данные и алгоритмы впоследствии должны быть использованы специальной программой, управляющей движением манипулятора.

Для достижения поставленной цели необходимо решить следующие задачи:

· Прямую задачу кинематики манипуляционного робота;

· Обратную задачу кинематики манипуляционного робота;

· Задачу позиционирования захвата манипуляционного робота;

· Разработать алгоритмы и их программные реализации, позволяющая моделировать конкретный шестизвенный манипулятор с шестью вращательными степенями свободы;

· Получить ряд траекторий в рабочей зоне установки для нанесения краски;

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

манипуляционный робот устройство

1. Обзор современных робототехнических комплексов

1.1 Определения работа

Рис. 1

Робот (чеш. robot, от robota -- подневольный труд, rob -- раб), машина с антропоморфным (человекоподобным) поведением, которая частично или полностью выполняет функций человек (иногда животного) при взаимодействии с окружающим мира . Термин "робот" (Р) был впервые введён К. Чапеком в пьесе "R. U. R." (1920), где Р называли механических людей. С развитием робототехники определились 3 разновидности Р с жёсткой программой действии; управляем человеком-оператором; с искусственны интеллектом (иногда называемые интегральными), действующие целенаправленно ("разумно") без вмешательства человека. Большинство современных Р (все три разновидностей) -- Р-манипулятор (см. Манипулятор), хотя существуют и другие виды Р (например, информационные, шагающие и т. п.). Возможно объединение Р первый и второй разновидностей в одной машине с разделением времени их функционирования. Допустим также совместная работ человек с Р третьего вида (в так называем супервизорный режим). Первые Р ( андроиды, имитировавшие движения и внешний облик человека) использовались преимущественно в развлекательных целях (см. Автомат). С 30-х гг. в связи с автоматизацией производства Р-автоматы стали применять в промышленности наряду с традиционными средствами автоматизация технологическая процесса, в частности в мелкосерийном производстве и особенно в цехах с вредными условиями труда (рис. 1).

Промышленный Р-манипулятор имеет "механическую руку" (одна или несколько) и вынесенный пульт управления или встроенный устройство программа управления, реже ЭВМ.

Он может, например, перемещать детали массой до несколько десятков кг в радиусе действия его "механическая рука" (до 2 м),выполняя от 200 до 1000 перемещений в час.

Промышленные Р-автомат имеют преимущество перед человека в скорости и точности выполнения ручных однообразных операций.

Наиболее распространены Р-манипуляторы с дистанционным управлением и "механической рукой", закрепленной на подвижном или неподвижном основании.

Оператор управляет движением "руки", одновременно наблюдая её непосредственно либо на телевизионном экране; в последнем случае. Р снабжается "телевизионным глазом" -- передающей телевизионной камерой

Часто Р оснащают обучающейся автоматической системой управления. Если такому Р "показывают" последовательность операций, то система управления фиксирует сё в виде программы управления и затем точно воспроизводит при работе.

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

В конце 60-х гг. в робототехнике возникло новое научное направление, связанное с созданием интеллектуальных Р Такие Р имеют датчики очувствления (сенсорную систему), воспринимающие информацию об окружающей обстановке, устройство обработки полученной информации (искусственный интеллект) -- специализированную ЭВМ с набором программ -- и исполнительные механизмы (моторную систему). Действия интеллектуального Р обладают некоторыми признаками человеческого поведения: датчики собирают информацию о предметах окружающего мира, их свойствах и взаимодействии; на основе этих данных искусственный интеллект формирует модель внешнего окружения и принимает решение о последовательности действий Р, которые реализуются исполнительными механизмами. К 1975 интеллектуальные Р находились в стадии научных разработок и попыток использования их в промышленности.

1.2 Роботы-пылесосы

Пылесос в современном мире - незаменимый помощник при уборке в квартире, офисе или автомобиле. Он поможет провести сухую или влажную уборку, почистить ковёр или диван, а разнообразные насадки способны выполнить другие функции по уборке дома. Существуют различные типы:

Рис. 2

пылесосы с мешком для сбора пыли обладают высокой степенью очистки, но требуют регулярной замены мешков и фильтров. В этой категории мы рекомендуем пылесосы Bork, Miele, Electrolux. Среди технологии безмешковых стоит отдельно отметить пылесосы циклонного типа Dyson, которые в процессе работы не теряют силу всасывания и не имеют дополнительных затрат на смену расходных материалов. Моющие пылесосы Bissell, VAX пользуются популярностью для уборки офисов и больших загородных домов. Мы поможем выбрать и купить пылесос, при необходимости вы можете оформить покупку пылесоса в кредит.

1.3 Охранный робот ROVIO

Гонконгская компания WowWee (широко известная по андроиду Robosapien) представила на международной выставке бытовой электроники (2008 International CES) самоходную вебкамеру-робот. Новинка называется Rovio. Она симпатична, "умна" и обладает рядом полезных навыков.

Робот оснащенную WiFi, и может контролироваться удаленно при помощи устройства с доступом в Интернет - мобильными телефоном, ПК или игровой видеоконсолью. Пользователи могут удаленно наблюдать за своим домом или офисом при помощи камеры встроенной в роботе, который передает видео через Интернет. 

Кроме просмотра видео микрофон робота позволяет прослушивать помещение, в котором он находится.

Рис.4

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

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

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

Рис. 5

Помимо связи Wi-Fi, робот оснащён USB-портом. Причём настройка этой машинки-охранника облегчается её способностью определять при подключении к компьютеру пользователя настройки PC.

При цене менее 1000$ этот робот становится недорогой альтернативой целой когорте роботов-охранников самых разных размеров и с самыми разными возможностями, которые мы уже видели в действии.

1.4 Робот хирург

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

Использование во время операции робота - оригинальная технология, появившаяся сравнительно недавно. Первым фактом использования робота во время операции было проведение нейрохирургической биопсии с помощью манипулятора PUMA 560 зарегистрированным в 1985 году.

Рис. 6

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

После этого роботизированная хирургия стала несомненным прорывом в разделе минимально инвазивных манипуляций.

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

Итак, использование роботов дало возможность установить 2 исключительных направления в медицине:

1) телехирургия, где хирург при проведении операции сам руководит роботом, не контактируя непосредственно с пациентом, т.е. хирург оперирует руками робота.

2) хирургия с минимальным (малоинвазивным) вмешательством.

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

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

Такое определение «роботизированная операция» может любых больных ввести в заблуждение.

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

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

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

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

Рис. 7

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

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

Рис. 8

Благодаря аппарату да Винчи лапароскопическая простатэктомия стала наиболее безопасной и простой.

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

Основными преимуществами роботизированной хирургии являются:

- наименьший риск осложнений, свойственных классической хирургии;

- сравнительно короткий послеоперационный период и стремительное выздоровление (точность манипуляций и минимальные разрезы существенно сокращают протекание заживления);

- понижение необходимости в переливании крови;

- уменьшение риска попадания инфекции в раны;

- после операции минимальная болезненность;

-усиленный косметический эффект из-за отсутствия

послеоперационных больших шрамов;

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

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

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

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

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

Робот при этом оказывается под подробнейшим контролем ассистентов и хирурга.

Таким образом, при оперировании риск сводится к нулю и у пациента почти не остается никаких послеоперационных рубцов.

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

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

Значительные технические недостатки имели ее предшественники и полагались исключительно на эндоскопический метод, непосильный без ассистирования многочисленных помощников.

Теперь же многократное увеличение и цветное трехмерное отображение позволяет врачу-хирургу видеть полную четкую картину всего операционного пространства.

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

Рис. 9

Эта особенность существенно понижает риск инфицирования раны и ограничивает контакт операционного оборудования со скрытой тканью надреза.

Да Винчи робот-манипулятор обеспечен инструментами, подобные человеческому запястью (EndoWrist®), которые на много превосходят ловкость руки человека.

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

Все эти вышеуказанные достоинства обеспечивают высокоточный доступ и аккуратность передвижений при проведении операции в ограниченных закрытых пространствах.

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

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

Европейские, в частности немецкие врачи-хирурги расширили еще больше возможности использования робота да Винчи.

Компания Smith & Nephews в тесном сотрудничестве с URS Orthopedic Systems написали компьютерную программу, применяемую системой да Винчи при внедрении имплантов в коленный сустав.

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

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

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

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

Будущее поколение роботов, вероятнее всего, будет использовать удаленное приготовление к операции, совершенно устраняя лишний человеческий фактор.

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

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

Да Винчи робот одними из первых на континенте и первыми в Израиле начали использовать в Иерусалиме медицинском центре Хадасса. В настоящее время его уже так же применяют в медицинских центрах Шиба и РАМБАМ.

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

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

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

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

1.5 Робот space system (Космические)

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

Еще с 50-х годов прошлого века роботы и автоматические станции начали осваивать солнечную систему.

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

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

Одним из самых ярких представителей полных по своей автоматизации и интеллекту космических роботов являлся загубленный из-за перестроечного дуризма корабль-челнок "Буран" советского производства.

Рис. 10

Этот корабль еще в 80-е годы показал, чего можно добиться с помощью роботов.

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

Если бы не бездарная политика руководства страны в тот период, мы могли бы быть лидерами в этой области. «Буран» задумывался как военная система.

Тактико-техническое задание на разработку многоразовой космической системы выдано Главным управлением космических средств Министерства обороны СССР и утверждено Д. Ф. Устиновым 8 ноября 1976 года. «Буран» предназначался для:

-комплексного противодействия мероприятиям вероятного противника по расширению использования космического пространства в военных целях;

-решения целевых задач в интересах обороны, народного хозяйства и науки;

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

-выведения на орбиты, обслуживание на них и возвращение на землю космических аппаратов, космонавтов и Грузов.

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

Рис. 11

Что еще важнее, потеря автоматического исследователя гораздо предпочтительнее гибели астронавта, хотя разработка и производство киберов - занятие недешевое.

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

Рис. 12

Весьма скоро, в конце декабря этого года, посадочный модуль "Гюйгенс" отделится от аппарата "Кассини", чтобы впервые прилуниться на крупнейшем в Солнечной системе планетоиде Титане.

Американские марсоходы Spirit и Opportunity уже доказали, что автоматам по силам исследовательские миссии чрезвычайной сложности, но киберпомощников конструируют не только в NASA.

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

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

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

Тем не менее, к автоматам для работы в безвоздушном пространстве предъявляются некоторые особые требования. Они должны:

*перенести запуск

* функционировать в сложных условиях враждебной среды, зачастую на большом удалении

* весить как можно меньше, так как каждый килограмм, выведенный на орбиту, стоит дорого

* потреблять мало энергии и иметь долгий срок службы

* работать в автоматическом режиме

* обладать чрезвычайной надежностью

Для соответствия всем этим требованиям требуются передовые и инновационные технологии, а также сложные системы и механизмы.

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

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

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

Европейское космическое агентство в сотрудничестве с некоторыми промышленными концернами разработало необычайно мелкий микроровер Nanokhod ("Наноход").

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

Более крупный робот был спроектирован для сбора образцов грунта других планет.

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

Третий минировер ,разрабатывающийся в ЕКА - пятнадцатикилограммовый Solero, все энергопотребности которого обеспечиваются солнечной батареей и миниатюрными подзаряжаемыми аккумуляторами. Данный аппарат имеет принципиально новую конструкцию шасси: шесть колес, расположенных по вершинам шестиугольника, обеспечивают ему отличную проходимость.

Рис. 13

Конструкторы роботов черпают вдохновение в творениях природы. Хорошим примером тому служит автомат Aramies/Scorpion, разработкой которого также заведует Европейское космическое агентство. Восемь ног позволяют киберу передвигаться подобно скорпиону по очень пересеченной местности и песчаным дюнам.

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

Автомат величиной с человека предназначен для помощи астронавтам в выполнении разных работ на Международной космической станции. EUROBOT сможет передвигаться по обшивке МКС, удерживаться за поручни подобно астронавту и управляться по телесигналу вышедшими в открытый космос членами экипажа.

Не обошлось без природы и при создании прыгающего робота.

При размерах даже меньше сорока сантиметров такой автомат способен перепрыгивать препятствия высотой в два метра.

Подобное практически неосуществимо на Земле, с ее силой тяжести, зато вполне возможно на Луне или Марсе.

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

Рис. 14

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

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

2. Формальная постановка задачи

2.1 Описание задачи

Конечной целью проекта является разработка средств, при помощи которых будет решена задача по организации покраски объектов с использованием робота-манипулятора. Цель внедрения именно такого способа заключается в экономии средств: система, состоящая из манипулятора, печатающей головки и сушильной установки гораздо дешевле специализированного оборудования. Более того такая система обладает большей гибкостью так как с лёгкостью может быть изменена при необходимости, что в случае со специализированным, жёстко настроенным и сконструированным под узкий класс задач оборудованием невозможно.

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

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

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

2.2 Описание рабочей системы

В качестве манипулятора используется робот фирмы Kawasaki - FS03N (рисунок 2.1). Управление роботом осуществляется через контроллер. К контроллеру может быть подключён пульт управления и компьютер (рисунок 2.2).

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



Рис. 2.1. Робот-манипулятор Kawasaki FS03N.

Контроллер - это центр управления всей системой, осуществляющий ежедневные операции.

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

· Ручное управление роботом

· Обучение данных позиции (координат)

· Обучение вспомогательных данных (блочное программирование)

Рис. 2.2. Система управления роботом.

· Установка условий повторения

· Управление сигналами

· Выбор программы

· Отображение программных шагов и имён

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

2.3 Способы управления движением манипулятора

Программа для робота-манипулятора пишется на языке AS. Фактически, эта программа должна осуществить движение манипулятора по определённой траектории. Соответствующая траектория в программе обычно задаётся в виде массива позиций, через которые проходит центр схвата робота (TCP - tool center point). В языке используется термин «позиция» так как этот термин выбран в стандарте ISO, фактически же позицией является совокупность трёх координат конца центра схвата (TCP), а также трёх эйлеровых углов, определяющих векторы ориентации и подхода (ориентацию схвата в пространстве относительно базовой системы координат). В языке AS позиция может быть описана двумя способами: либо как последовательность из трёх декартовых координат и трёх углов, определяющих положение свата в пространстве, т.е. в декартовых координатах, либо при помощи шести углов, возникающих между цепями манипулятора (угловые координаты или обобщённые координаты), которые также определяют положение захвата. Фактически управление роботом осуществляется посредством указания этих углов (рисунок 2.3.). Если для описания позиции используется положение захвата, то эта позиция всё равно неявно преобразуется автоматически к системе из шести углов при помощи решения обратной задачи кинематики, встроенной во внутреннюю систему управления манипулятором.

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

Рис. 2.3. Перемещение манипулятора, состоящего из трёх

Поэтому, исходя из возможностей данного манипулятора FS03N и его языка программирования, можно выделить два способа управления движением которые определяют также и способы построения его траектории:

1) Траектория вычисляется заранее при помощи алгоритмов, имитирующих те, что вшиты во внутреннюю систему управления роботом. Необходимая траектория, таким образом, вычисляется непосредственно на компьютере, в результате получается совокупность позиций, которые должен пройти манипулятор. Эти позиции заносятся в массив AS программы, которая осуществляет необходимое движение.

2) Траектория сначала формируется предварительно при помощи соответствующих моделирующих алгоритмов, вставляется в AS программу, но кроме этого во внешней среде реализуется также алгоритм позиционирования, который в режиме реального времени может активизироваться, если вдруг движение манипулятора по каким-либо причинам отклонится от намеченной траектории. Этот алгоритм вычисляет отклонения текущих углов от заданных и возвращает набор из шести приращений, используя которые манипулятор должен откорректировать своё положение.

Модель робота FS03N достаточно точна и, вероятно, предпочтительным является первый способ, однако учёт только кинематических характеристик движения создаёт риск отклонения от выбранной траектории, поэтому для подстраховки необходимо также рассмотреть вариант, при котором придётся осуществлять позиционирование манипулятора.

2.4 Формулировка требований

В соответствии со сформулированными сценариями управления движением необходимо решить четыре задачи:

1) Прямая задача кинематики

2) Обратная задача кинематики

3) Позиционирование манипулятора

4) Построение траектории движения манипулятора

Впоследствии при разработке программы управления должна быть сгенерирована последовательность позиций, которые, по сути, являются траекторией движения. Эти позиции вставляются в AS программу. В случае если практическая реализация таким способом окажется невозможна - во внешнюю систему управления будет заложен алгоритм позиционирования, а в AS программу должны быть внесены изменения, позволяющие ей корректировать отклонения при помощи внешней программы.

Осуществить всё это язык AS позволяет, так как в нём предусмотрена возможность выполнения алгоритмов в режиме реального времени во время движения манипулятора (состояние при котором манипулятор остановился, осуществляется при помощи инструкции BREAK или DELAY, которая программой воспринимается как особая форма движения).

3. Прямая задача кинематики

3.1 Описание робота-манипулятора. Представление Денавита-Хартенберга

С точки зрения кинематики манипуляционный робот может рассматриваться как незамкнутая цепь твёрдых звеньев, соединённых последовательно посредством либо призматических (поступательных), либо шарнирных (вращательных) сочленений (рисунок 3.1.). Один конец этой цепи соединён с основанием манипулятора, другой её конец, как правило, снабжён захватным устройством. Способность осуществлять какие-либо движения достигается благодаря тому, что манипулятор обладает несколькими степенями свободы. Число степеней свободы это число возможных перемещений системы. Расположение и ориентация захватного устройства зависит от совместного действия вращения и/или переноса каждого сочленения цепи звеньев. В данной задаче используется шестизвенный робот-манипулятор с шестью вращательными степенями свободы, здесь и далее рассматривается манипулятор именно с такой конфигурацией.

Управление манипулятором представляет собой перемещение захвата в определённую точку с определённой ориентацией. Это перемещение осуществляется за счёт указания обобщённых координат.

Рис. 3.1. Шарнирное (вращательное) и призматическое соединения.

Обобщенными координатами являются измеряемые угловые перемещения между двумя соседними звеньями робота. С каждым звеном робота связана локальная декартова система координат. Начало систем координат совмещено с каждой степенью подвижности манипулятора (рисунок 3.2).

Рис. 3.2. Система локальных координат робота-манипулятора.

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

Каждая система координат формируется на основе трёх правил:

1. Ось z_i-1 направлена вдоль оси i-го сочленения.

2. Ось x_i перпендикулярна оси z_i-1 и направлена от неё.

3. Ось y_i дополняет оси x_i, z_i до правой декартовой системы координат.

Локальные системы декартовых координат выберем следующим специальным образом (в соответствии с представлением Денавита-Хартенберга): пронумеруем все звенья манипулятора от стойки (звено 0) до схвата (звена n, которое в рассматриваемом случае равно 6), ось z_i идет по оси кинематической пары (i, i+1); начало координат системы i, жестко связанной со звеном i, лежит на общем перпендикуляре к осям z_i-1 и z_i, либо в точке их пересечения, если таковая имеется, либо в любой точке оси кинематической пары, если ось z_i совпадает с осью z_i-1 или параллельна ей. Ось x_i идет по общему перпендикуляру, проведенному к осям z_i-1 и z_i, и направлена от точки пересечения этого перпендикуляра с осью z_i-1 к точке его пересечения с осью x_i (или в любую сторону по нормали к плоскости, содержащей оси z_i-1 и z_i, если они пересекаются, или произвольным способом, если z_i-1 и z_i идут по одной прямой). Ось y_i выбирается по правилу правой тройки векторов. Начало координат системы 0, т. е. системы, жестко связанной со стойкой, может лежать в любой точке оси пары (0, 1).

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

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

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

Для разрешения этих вопросов, с целью описания вращательных и поступательных связей между соседними звеньями Денавит и Хартенберг предложили матричный метод построения систем координат, связанных с каждым звеном кинематической цепи. Смысл представления Денавита-Хартенберга состоит в формировании однородной матрицы преобразования, имеющей размерность 4х4 и описывающей положение системы координат каждого звена относительно системы координат предыдущего. Это даёт возможность последовательно преобразовать координаты схвата манипулятора из системы отсчёта, связанной с последним звеном, в базовую систему отсчёта [6].

Так как управление состоит в указании угла между двумя соседними звеньями - изменение этого угла приводит к изменению положения одной локальной системы координат относительно другой, что приводит к необходимости описывать каждую последующую локальную систему относительно предыдущей. Для описания изменения положения и ориентации одной локальной системы координат относительно предыдущей используются однородные матрицы преобразования (А-матрицы, эти матрицы также называют преобразованием Денавита-Хартенберга, рисунок 3.3).

Рисунок 3.3. Однородная матрица преобразования.

Матрица преобразования ставится в соответствие каждой локальной системе координат (кроме самой первой, что у стойки) и несёт двойной смысл: во-первых она описывает положение и ориентацию локальной системы координат (i-й) относительно предыдущей локальной системы координат (i-1, если нумеровать, начиная со стойки), а во-вторых является средством преобразования i-й координатной системы в i-1-ую, то есть координаты вектора, в i-й системе координат могут быть представлены в i-1-й путём умножения координат этого вектора на i-ю матрицу преобразования (А матрицу). Матрица А состоит из четырёх частей: 3х3 матрица, которая определяет с одной стороны ориентацию соответствующей локальной системы координат относительно предыдущей при помощи углов Эйлера (она состоит из трёх единичных векторов направления которых совпадают с направлениями соответствующих осей i-й локальной системы координат, эти векторы рассматриваются относительно i-1-й системы) и с другой стороны является матрицей поворота, 3х1 вектор с одной стороны является координатой i-й локальной системы относительно i-1-й и с другой стороны вектором переноса, последние две части - строка 1х3 определяет перспективу и один элемент, является коэффициентом масштабирования. Эти две части не используются. Вектор положения и коэффициент масштабирования вообще с точки зрения линейной алгебры можно воспринимать как единое целое - вектор, выраженный в однородных координатах. В более общем случае матрица А в линейной алгебре является однородной матрицей преобразования, которая преобразует вектор, выраженный в однородных координатах из одной системы отсчёта в другую.

Матрицы преобразования для локальной системы координат высчитываются исходя из геометрических особенностей звеньев. Представление Денавита-Хартенберга твёрдых звеньев зависит от четырёх геометрических параметров, соответствующих каждому звену. Эти четыре параметра полностью описывают любое вращательное или поступательное движение. Этот набор параметров достаточен для описания кинематической схемы каждого звена (рисунок 3.4).

и_i - присоединённый угол (обобщённая координата) - угол, на который надо повернуть ось x_i-1 вокруг оси z_i-1, чтобы она стала со направлена с осью x_i (знак определяется в соответствии с правилом правой руки).

d_i - расстояние между пересечением оси z_i-1 с осью x_i и началом (i-1-й системы координат, отсчитываемое вдоль оси z_i-1).

a_i - линейное смещение - расстояние между пересечением оси z_i-1 с осью x_i и началом i-й системы координат, отсчитываемое вдоль оси x_i, т.е кратчайшее расстояние между осями z_i-1 и z_i.

б_i - угловое смещение - угол, на который надо повернуть ось z_i-1 вокруг оси x_i, чтобы она стала со направленной с осью z_i (знак определяется в соответствии с правилом правой руки).

Параметры a_i и б_i характеризуют конструкцию звена, их можно рассматривать соответственно как длину и угол скрутка i-го звена. Для вращательных сочленений d_i, a_i и б_i являются постоянными характеристиками сочленения для данного робота. и_i является переменной величиной, изменяющейся при вращении i-го звена относительно i-1-го.

Как только системы координат сформированы для всех звеньев, можно построить однородные матрицы преобразования, связывающие i-ю и i-1-ю системы координат.

Систему i-1можно преобразовать в систему i с помощью поворота, двух сдвигов (переносов) и еще одного поворота, выполняемых в следующем порядке:



Рис. 3.4. Система координат звена.

1. Поворот системы i-1вокруг оси z_i-1 на угол и_i до тех пор, пока ось x_i-1 не станет параллельной оси x_i.

2. Сдвиг повернутой системы вдоль оси z_i-1 на величину d_i до тех пор, пока оси x_i-1 и x_i не окажутся на од-ной прямой.

3. Сдвиг вдоль оси x_i на величину a_i до тех пор, пока не совпадут начала координат.

4. Поворот вокруг оси x_i на угол б_i до совмещения оси z_i-1 с осью z_i.

Каждому из этих элементарных движений соответствует одна из матриц: либо матрица вращения (В_вр), либо матрица сдвига (В_сд). Результирующая матрица перехода А_i, связывающая системы i-1 и i, является произведением этих матриц:

(3.1)

После перемножения получаем:

(3.2)

Таким образом, матрица преобразования зависит от четырёх параметров, один из которых (в данном случае обобщённая координата) меняется.

3.2 Прямая задача кинематики

манипуляционный робот устройство кинематика

Прямая задача кинематики манипуляторов формулируется следующим образом: задана кинематическая схема манипулятора (то есть параметры d_i, a_i и б_i для всех звеньев) и в некоторый момент времени известны значения обобщенных координат, определяющие положение всех звеньев манипулятора друг относительно друга. Требуется определить положение и ориентацию последнего звена манипулятора (схвата) в системе отсчета, связанной со стойкой.

Для того, чтобы получить координаты последней, шестой локальной системы координат относительно базовой необходимо провести последовательно цепочку преобразований локальных систем. Таким образом, кинематическое положение схвата может быть получено последовательным преобразованием координат точки Ri (rxi, ryi, rzi) из одной системы координат i в другую систему координат i-1 следующим образом:

R0=А1*R1·

R1=А2*R2

R2=А3*R3

R3=А4*R4

R4=А5*R5

R5=А6*R6

и получим =====> R0= А1*А2*А3*А4*А5*А6*R6

Обозначим Т6= А1*А2*А3*А4*А5*А6 (3.3)

Таким образом, R₀= Т_6*R₆ (3.3)

Произведение матриц преобразования также даёт матрицу преобразования поэтому получается, что матрица Т₆ в итоге является матрицей А и имеет полностью такую же структуру, но в данном случае нас интересует рассмотрение её с точки зрения описания позиции схвата относительно базовой системы координат, а не как средство преобразования в базовую систему координат. Матрицу Т называют однородной матрицей композиции преобразования. В матрице Т вектор p является координатой центра схвата - это вектор положения, а единичные векторы, определяющие ориентацию схвата в базовой системе (эти же векторы можно рассматривать как направляющие косинусы) называются соответственно векторами подхода - а, ориентации - о, и нормали - n, все они образуют правостороннюю систему координат (рисунок 3.5). Так как каждый из этих векторов может быть получен в результате векторного произведения двух других, то для однозначного неизбыточного определения ориентации в пространстве достаточно выбрать любые два вектора из этой тройки.