МИНИСТЕРСТВО НАУКИ И ВЫСШЕГО ОБРАЗОВАНИЯ РФ
АСТРАХАНСКИЙ ГОСУДАРСТВЕННЫЙ УНИВЕРСИТЕТ
Факультет физики, математики и
инженерных технологий
Кафедра электротехники, электроники и автоматики
Форма обучения очная
Допускается к защите
«_____» _______________ 20__ г.
Зав. кафедрой Ключарев А.Ю.
Тамков Павел Игоревич
РАЗРАБОТКА СИСТЕМЫ УПРАВЛЕНИЯ ГРУЗОВЫХ МОБИЛЬНЫХ
РОБОТОВ
Бакалаврская работа
по направлению подготовки 15.03.06 «Мехатроника и робототехника»
Профиль «Промышленная робототехника»
Научный руководитель:
к.ф.-м.н., доцент кафедры ЭЭиА
_______________________ Рыбаков А.В.
Нормоконтроль:
________________________Козлова И.А.
С размещением работы в электронной
библиотеке «Астраханский государственный
университет. Выпускные квалификационные
работы» согласен
/
Тамков П.И.
(подпись / расшифровка подписи)
Астрахань – 2020
МИНИСТЕРСТВО НАУКИ И ВЫСШЕГО ОБРАЗОВАНИЯ РФ
АСТРАХАНСКИЙ ГОСУДАРСТВЕННЫЙ УНИВЕРСИТЕТ
Факультет физики, математики и
инженерных технологий
Кафедра электротехники, электроники и автоматики
Форма обучения очная
Утверждаю
Зав. кафедрой _____________________
«____» ___________________20__ г.
ЗАДАНИЕ
на бакалаврскую работу студента
Тамкова Павла Игоревича
1. Тема дипломного проекта: «Разработка системы управления грузовых мобильных
роботов»
утверждена приказом по университету от «_____» ____________ 20__ г. №_______
2. Дата выдачи задания на бакалаврскую работу «_____» ______________ 20__ г.
3. Основные компоненты РТС:
− грузовая платформа;
− БДПТ и линейные приводы;
− контроллер БДПТ с датчиками Холла Maxon с датчиками Холла;
− всенаправленные омни-колеса;
− датчики.
4. Функции, реализуемые РТС:
− возможность перемещения по ячейкам складского помещения;
− возможность поднятия и перевозки ящика с грузом;
− возможность перемещения ящика по грузовой платформе робота;
− возможность размещения ящика на полке стеллажа.
5. Общие требования к РТС:
− грузоподъёмность не менее 100 кг;
− всенаправленность перемещений;
− скорость перемещения не менее 1 м/с;
− ускорения не менее 1 м/с2;
6. Требования к габаритно-массовым характеристикам:
− линейные размеры мобильной платформы 550х550х190 мм;
− масса не более 35 кг.
7. Требования к эксплуатации:
− возможность размещения QR-меток на поверхности передвижения
− робота;
− установка мобильной платформы на ровную поверхность;
− установка стеллажей карусельного типа с измененным видом полок.
8. Перечень графического материала:
− сборочный чертеж колёсного узла;
− сборочный чертеж мобильного складского робота;
− чертеж несущей плиты;
− чертеж крепления валок ролика омни колеса;
− принципиальная электрическая схема нижнего уровня РТК;
− принципиальная электрическая схема контроллера БДПТ Maxon;
− чертеж печатной платы контроллера БДПТ моторов;
− технологическая схема сборки колёсного узла.
Руководитель
___________________
Рыбаков А.В.
Задание принял к исполнению
___________________
Тамков П.И.
РЕФЕРАТ
Ключевые
слова:
РОБОТ,
МОБИЛЬНЫЙ
РОБОТ,
АГРАРНЫЙ
РОБОТ,
КИНЕМАТИКА, ДИНАМИКА, QR–НАВИГАЦИЯ, БДПТ MAXON.
Пояснительная записка представлена на 106 страницах, включает 57 иллюстраций,
17 таблиц, 55 формул и 27 использованных источников.
Объектом проектирования является мобильная грузовая платформа абсолютной
мобильности для ее использования на складах плодоовощной продукции с возможностью
коллаборативного управления.
Целью выпускной квалификационной работы является разработка мобильной
грузовой платформы и системы группового управления роботами. Исходя из целей были
сформулированы следующие задачи:
− провести обзор существующих решений;
− подобрать конфигурацию шасси;
− спроектировать колесный узел;
− подобрать элементную базу РТК;
− построить объемную 3D модель мобильной платформы;
− разработать контроллер управления БДПТ maxon;
− сформулировать
математическое
описание
мобильной
платформы
и
составить математические модели стабилизации скорости и положения.
Назначение: транспортировка и расположение ящиков с плодоовощной продукцией
на полках стеллажей карусельного типа.
Разработанная система отличается от аналогов тем, что на грузовой платформе
присутствуют приводы для перемещения груза по платформе в любом направлении, данное
преимущество позволяет сократить время, нужное для расположения ящиков на полках
стеллажей. Также из группы роботов можно выстраивать конвейерные линии, это позволит
создавать адаптивные системы распределения грузов в сортировочных центрах.
ABSTRACT
Keywords: ROBOT, MOBILE ROBOT, AGRICULTURAL ROBOT, KINEMATICS,
DYNAMICS, QR–NAVIGATION, BLDC MAXON.
The explanatory note is presented on 106 pages, including 57 illustrations, 17 tables, 55
formulas, and 27 used sources.
The object of design is a mobile cargo platform of absolute mobility for its use in
warehouses of fruit and vegetable products with the possibility of collaborative management.
The goal of the final qualification work is to develop a mobile cargo platform and a system
for group robot control. Based on the goals the following tasks were formulated:
− review existing solutions;
− choose the configuration of the chassis;
− design a wheel Assembly;
− select the element base;
− build a 3D model of the mobile platform;
− to develop the controller for BLDC maxon;
− formulate a mathematical description of the mobile platform and create
mathematical models for speed and position stabilization.
Purpose: transportation and arrangement of boxes with fruit and vegetable products on the
shelves of carousel type racks.
The developed system differs from its analogues in that the cargo platform has drives for
moving cargo along the platform in any direction, this advantage allows you to reduce the time
needed to place the boxes on the shelves.
СОДЕРЖАНИЕ
ВВЕДЕНИЕ ................................................................................................................................... 8
1 АНАЛИТИЧЕСКАЯ ЧАСТЬ .................................................................................................. 9
1.1
Анализ аналогов разрабатываемой системы .............................................................. 10
1.2
Патентный поиск .......................................................................................................... 18
2 КОНСТРУКТОРСКО-ТЕХНОЛОГИЧЕСКАЯ ЧАСТЬ ..................................................... 19
2.1
Техническая характеристика мобильной платформы ............................................... 19
2.2
Разработка структурной схемы мобильной платформы ........................................... 20
2.3
Конструкция мобильной грузовой платформы ......................................................... 23
2.3.1
Разработка колёсного узла мобильной платформы ........................................... 23
2.3.2
Подбор и расчет основных приводов .................................................................. 25
2.3.3
Расчет привода платформы .................................................................................. 27
2.3.4
Расчет привода перемещения груза ..................................................................... 28
2.3.5
Расчет параметров актуатора для подъёма грузовой платформы..................... 29
2.3.6
Подбор редукторов ................................................................................................ 33
2.3.7
Сборка колёсных узлов ......................................................................................... 35
2.4
Выбор элементной базы РТК ...................................................................................... 36
2.5
Разработка контроллера БДПТ .................................................................................... 49
2.6
Разработка внешнего вида мобильной платформы ................................................... 54
3 ИССЛЕДОВАТЕЛЬСКАЯ ЧАСТЬ ...................................................................................... 56
3.1
Алгоритм поиска пути ................................................................................................. 56
3.2
Кинематика мобильной платформы ........................................................................... 59
3.3
Динамика мобильной платформы ............................................................................... 66
3.4
Выбор регулятора ......................................................................................................... 71
3.5
Моделирование ............................................................................................................. 73
ЗАКЛЮЧЕНИЕ ........................................................................................................................... 76
СПИСОК ИСПОЛЬЗОВАННЫХ ИСТОЧНИКОВ ................................................................. 77
ПРИЛОЖЕНИЕ А Перечень принятых сокращений .............................................................. 79
.
ПРИЛОЖЕНИЕ Б Блок схема ПИ–регулятора стабилизации скорости ............................... 80
ПРИЛОЖЕНИЕ В Блок–схема планирования пути движения по складу ............................ 81
ПРИЛОЖЕНИЕ Г Блок-схема стабилизации положения мобильной платформы .............. 82
ПРИЛОЖЕНИЕ Д Блок–схема динамической модели РТК................................................... 83
ПРИЛОЖЕНИЕ Е Сборочный чертеж колесного узла ........................................................... 84
ПРИЛОЖЕНИЕ Ж Спецификация на сборочный чертеж колесного узла ........................... 86
ПРИЛОЖЕНИЕ И Технологическая схема сборки колесного узла ...................................... 88
ПРИЛОЖЕНИЕ К Черетеж пластины крепления валов ролика ........................................... 90
ПРИЛОЖЕНИЕ Л Чертёж несущей плиты РТК ..................................................................... 92
ПРИЛОЖЕНИЕ М Сборочный чертеж мобильного складского робота .............................. 94
ПРИЛОЖЕНИЕ Н Спецификация на сборочный чертеж мобильного складского робота . 96
ПРИЛОЖЕНИЕ П Схема электрическая принципиальная контроллера БДПТ .................. 98
ПРИЛОЖЕНИЕ Р Плата печатная контроллера БДПТ ........................................................ 100
ПРИЛОЖЕНИЕ С Листинг программы контроллера БДПТ................................................ 102
ПРИЛОЖЕНИЕ Т Материалы на электронном носителе .................................................... 105
ВВЕДЕНИЕ
В
настоящее
время
автоматизация
процесса
транспортировки
грузов
на
промышленных предприятиях приобретает всё большие масштабы. Идёт стратегия
вытеснения ручного труда, на смену которому приходят роботизированные комплексы,
обеспечивающие перевозку и доставку грузов в складах, цехах и т. д. Эти действия обычно
выполняют грузовые мобильные роботы, которые представляют собой передвижную
платформу на колёсной базе. Такие роботы именуются «складскими роботами», они
перевозят на себе полезный груз, при этом перемещаются по намеченным траекториям,
определяемыми начальным и конечным пунктом расположения груза.
Отдельный мобильный робот обладает ограниченными возможностями. У него
малый радиус действия и небольшое число выполняемых функций. Поэтому, при решении
сложных задач, целесообразным является одновременное применение нескольких роботов,
т.е. распределенной робототехнической системы. Преимущества использования группы
роботов очевидны. Во–первых, это больший радиус действия, во–вторых, расширенный
набор выполняемых функций, и, наконец, более высокая вероятность выполнения задания,
достигаемая за счет возможности перераспределения целей между роботами группы [1].
Например, такой подход к применению мобильных грузовых роботов использует,
американская компания Amazon Robotics, которая переоборудовала большинство
складских и сортировочных помещений основной компании Amazon, что помогло
сократить не только время, затрачиваемое на комплектацию заказа, но и увеличить
площадь, занимаемую товарами. Также возможна взаимосвязь мобильного робота с
автоматической системой учета товаров.
В настоящем проекте целью является разработка мобильной грузовой платформы с
возможностью
автоматического
размещения
ящиков
с
продукцией
на
полках
автоматизированного стеллажа и разработка методов централизированного управления
коллективом мобильных роботов. В круг задач разрабатываемой робототехнической
системы входят вышеописанные варианты применения: работы на складах и участие в
технологическом процессе. Конструкция мобильного робота обеспечивает абсолютную
мобильность движения на плоскости, что даёт большие возможности по заданию движений.
.
.
1
АНАЛИТИЧЕСКАЯ ЧАСТЬ
Складские роботы – это роботы, предназначенные для ведения операций на складах.
Существует уже несколько их разновидностей, а также комплексные решения
автоматизации складов, задействующие, например, промышленные манипуляторы,
мобильные роботизированные тележки, паллетайзеры и т. п. технику. Роботы–тележки
способны автономно перемещать паллеты по территории склада. Некоторые из них
способны автоматически снимать нужные товары с полки и помещать их в контейнеры или
на паллет, а также, наоборот, – раскладывать товары по полкам.
Роботы–паллетайзеры, как правило, это промышленный манипулятор, приводимый
в движение серводвигателями, предназначенный для автоматического захвата и укладки
продукции на паллеты. Роботы–сортировщики – незаменимы при упаковке товаров,
например, в системах онлайн–торговли. В идеале они должны уметь справляться с задачей
разбора предметов из кучи с их точной идентификаций. Это можно делать, например, если
иметь цифровую базу трехмерных изображений всех предметов, которыми манипулирует
робот.
Ряд таких изделий требуют для использования подготовки склада – разметки на полу
или установки специальных меток (беспроводных или отражательных) на стенах и полках.
Появляются также системы, не требующие разметки склада – они ориентируются на
системы
технического
искусственного
зрения
интеллекта
с
(ИИ).
распознаванием
образов
базе
встроенного
Ряд
робототехнических
комплексов
подобных
на
представлен на рисунке 1.1.
Рисунок 1.1 – Складские роботы Adept Lynx, Locus, Aethon TUG, KUKA KMR iiwa
(слева направо)
.
В промышленности подобные системы в основном представлены как складские
роботизированные погрузчики – складские роботы, мобильные платформы на колёсной
базе. Они выполняют работу по перемещению груза по территории складов, цеховых
помещениях и т.д. вдоль заранее определённого маршрута. Способны выполняют
коллаборативные функции (взаимодействуют с людьми и с другими роботами).
Конструкция таких аппаратов должна выдерживать высокие статические нагрузки и
обладать эргономичностью. Как правило конструкция представляет собой платформу,
оснащенная ходовой частью, которая обеспечивает необходимую мобильность.
1.1
Анализ аналогов разрабатываемой системы
Amazon Pegasus и Xanthus
Компания Amazon Robotics присутствует на рынке с 2003 года, но свою известность
получила в 2016, когда произвела полную автоматизацию одного из складов Amazon Store,
на котором находятся всего 19 операторов, которые компонуют посылки, и 156
робототехнических комплексов, которые доставляют стеллажи с продуктами к операторам.
Рисунок 1.2 – Робот Amazon Xanthus
Рассмотрим мобильные робототехнические платформы, которые используются в
сортировочных центрах Amazon Cargo. Два робота Xanthus (рисунок 1.2) и Pegasus (рисунок
1.3) – это одинаковые по функционалу, но разные по размерам многоцелевые платформы,
которые предназначены для перемещения посылок по складу как по отдельности, так и
создавая из роботов конвейерные линии. Плюс таких роботов заключается в малых
габаритах и их быстром перемещении. Создание конвейерных линий необходимо для
быстрой сортировки посылок по контейнерам и последующей отправке посылок по
городам. Данный робот позволил сократить количество людей в сортировочном центре до
2 человек, одного оператора и одного контроллера, который необходим для обработки
посылок с нечитаемыми идентификационными номерами.
Данные роботы для навигации используют разметку в виде QR кодов на полу и
дополнительную систему навигации, размещенную на потолке сортировочного помещения.
Основные технические характеристики робота Amazon Pegasus указаны в таблице 1.1.
Рисунок 1.3 – Роботы Amazon Pegasus
Таблица 1.1 – Характеристики Amazon Pegasus
Векторное перемещение по складу
Кол–во степеней перемещения груза по
платформе робота
нет
2
Возможность поднятия груза
нет
Грузоподъемность, кг.
1500
Скорость, м/с
до 1,4
Габариты (длина х ширина х высота),
мм.
1065х665х310
Габариты платформы для груза, мм.
1280х850
Вес, кг.
180
Зарядная станция
есть
Мобильная платформа KUKA KMP 1500
Это автоматически управляемое транспортное средство для транспортировки
продукции на всех этапах производственного процесса (рисунок 1.4).
Рисунок 1.4 – KUKA KMP 1500
Эта мобильная платформа способна перемещать объекты массой до 1,5 т., причём
точность перемещений до +/– 5 мм. К тому же приводная часть платформы оснащена
роликонесущими колёсами, благодаря которым возможно перемещение во всех
направлениях,
т.е.
платформа
обладает
высокой
мобильностью.
Технические
характеристики представлены в таблице 1.2.
KMP 1500 самостоятельно доставляет необходимые детали или возвращает
обработанные детали на склад. Навигационная система «KUKA.NavigationSolution»,
использующая алгоритмы SLAM, позволяет системе передвигаться в пространстве
свободно без классических элементов наведения на траекторию и навигации. Это упрощает
интеграцию в изменяющихся условиях, повышая тем самым экономичность управления
логистическими процессами.
Платформа может оснащаться подъёмным механизмом, максимальная высота
подъёма которого 200 мм.
Таблица 1.2 – Характеристики KUKA KMP 1500
Векторное перемещение по складу
Количество степеней перемещения груза
по платформе робота
Возможность поднятия груза
да
нет
опция
Продолжение таблицы 1.2
Грузоподъемность, кг.
1500
Скорость, м/с
до 1
Габариты (длина х ширина х высота), мм.
2000х800х470
Габариты платформы для груза, мм.
1800х700
Вес, кг.
479
Зарядная станция
есть
KMP 1500 обладает функциями безопасности: четырехкратный аварийный останов,
указатель направления, светодиодные индикаторы и два лазерных сканера с датчиками
безопасности и предупреждения для контроля в диапазоне 360 градусов.
Конфигурирование и программирование возможно, как по кабелю, так и по
беспроводному интерфейсу.
KUKA KMR QUANTEC
Ещё один представитель автономных мобильных платформ производства KUKA
KMR QUANTEC – мобильная промышленная робототехническая система KUKA,
предназначена для строительства судов, самолетов или ветровых установок (рисунок 1.5).
Система позволяет без особых усилий обрабатывать даже очень большие детали.
Рисунок 1.5 – KMR QUANTEC
Это сложная робототехническая система, объединяет в себе следующие
компоненты:
− мобильную платформу KUKA omniMove;
− промышленный манипулятор серии KR QUANTEC;
− программное обеспечение и система управления.
Мобильная платформа, как и описанная выше, может двигаться во всех
направлениях благодаря специальной конструкции колёс (роликонесущее колесо Илона).
Навигационная система «KUKA.NavigationSolution» исполнена на лазерных сканерах,
используется SLAM алгоритм для точного позиционирования.
Как видно по рисунку, мобильная платформа перемещает манипулятор, который в
свою очередь обрабатывает какое–то изделие. Взаимосвязь манипулятора и платформы,
учёт
их
относительного
перемещения
осуществляет
встроенным
программным
обеспечением и системой управления. Большой диапазон перемещений платформы с
закреплённым на ней манипулятором даёт последнему возможность обрабатывать
протяжённые объекты, например, фюзеляжи самолётов и т.д.
Мобильная платформа KUKA omniMove имеет стандартную грузоподъемность 7000
кг. На ней установлен робот KR QUANTEC 150 R3300 prime грузоподъемностью 150 кг и
радиусом действия 3300 мм. Это позволяет использовать KMR QUANTEC для
манипулирования особенно крупными и тяжелыми деталей. Несмотря на большую
грузоподъемность он достигает точности позиционирования +/– 5 мм – независимо от уже
пройденного расстояния.
Ronavi 01R
Разработчик – российская компания Ronavi Robotics. Это первый в России робот для
обслуживания складов. Способен работать на любом складе. Для навигации использует
разметку на полу и QR–коды, размещённые на стеллажах. Его технические характеристики
приведены в таблице 1.3. Внешний вид изображён на рисунке 1.6.
Таблица 1.3 – Характеристики Ronavi 01R
Векторное перемещение по складу
Кол–во степеней перемещения груза
по платформе робота
нет
0
Возможность поднятия груза
есть
Грузоподъемность, кг.
1500
Скорость, м/с
до 1,4
Габариты (длина х ширина х высота),
мм.
Габариты платформы для груза, мм.
1065х665х310
1280х850
Рисунок 1.6 – Ronavi 01R
Одна из особенностей разработки – возможность создать сеть из 250 складских
роботов. Специальное разработанное программное обеспечение контролирует и управляет
сетью складских роботов: регулирует их движение и отдает заказ на доставку тому роботу,
который находится ближе всего к нужному грузу.
К недостаткам относится то, что для позиционирования этого робота необходима
специальная разметка на полу склада, что накладывает ограничения на возможности
движения.
ОТТО 100
Производитель – Clearpath Robotics, Канада. OTTO 100 (рисунок 1.7) интеллектуальный и
достаточно гибкий аппарат, способен избегать препятствия самостоятельно, планировать
новые маршруты, когда это необходимо, убеждаясь в том, что он не угрожает людям,
встречающимся ему на пути. Способен взаимодействовать с другими аппаратами, образуя
сеть складских роботов. Его технические характеристики представлены в таблице 1.4.
Рисунок 1.7 – OTTO 100
Таблица 1.4 – Характеристики OTTO 100
Векторное перемещение по складу
Кол–во степеней перемещения груза по
платформе робота
нет
0
Возможность поднятия груза
есть
Грузоподъемность, кг.
100
Скорость, м/с
до 2
Габариты (длина х ширина х высота), мм.
740х550х301
Габариты платформы для груза, мм.
740х550
Вес, кг.
127
Зарядная станция
есть
Навигационная система смешанная, состоит из 2D лидара, одометрических и
инерциальных сенсоров. Программное обеспечение позволяет задавать пункт доставки и
заранее определять маршрут; робот в автоматическом режиме выполняет команду и
доставляет груз в нужное место.
Помимо складских роботов, как говорилось выше, существуют решения,
направленные на участие в технологическом процессе производства. Роботы выполняют
роль транспортной оснастки, например, для промышленных манипуляторов или
перемещают обрабатываемое изделие по пунктам обработки – задача автоматизации
логистики. Также могут нести на борту инструмент обработки, например, тот же
манипулятор.
Такие мобильные роботы также имеют конструкцию в виде платформы,
обеспечивающую
требуемую
грузоподъёмность
и
мобильность.
Система
позиционирования в некоторых случаях может отсутствовать, тогда управление
происходит только в ручном режиме оператором. В случае, если подразумевается
автоматическая
работа,
из–за
особенности
применения
на
точность
системы
позиционирования накладывается более жёсткие требования, нежели к складским роботам.
Основным производителем этого типа роботов является немецкая компания KUKA.
В таблице 1.5 приведём сравнительную характеристику рассмотренных аналогов.
Скорость
м/с
кг.
Аналог
Грузоподъёмность
Таблица 1.5 – Сводная таблица характеристик аналогов
Достоинства
Универсальность
Amazon
Pegasus
400
3
платформы,
длительное время
автономной работы
Недостатки
Необходимость в
специальной разметке
для позиционирования
Сложная и
KMP 1500
1500
0,56–
1
Большая
ресурсоёмкая система
грузоподъёмность,
позиционирования,
высокая мобильность
высокая стоимость
системы
Высокая мобильность,
возможность
KMR
QUANTEC
150
0,8–
монтирования
1,5
промышленного
манипулятора на
борту
Сложная и
ресурсоёмкая система
позиционирования,
высокая стоимость
системы
Простота
конструкции,
Ronavi 01R
1500
1,4
способен работать на
Необходимость в
любых складах,
специальной разметке
возможность
для позиционирования
создавать сеть из
нескольких роботов
Сложная система
ОТТО 100
100
2
Интеллектуальный и
позиционирования при
гибкий аппарат
сравнительно малой
точности
1.2
Патентный поиск
Результат поиска многофункциональной грузовой робототехнической платформы
для перевозки и создания конвейерных линий указан на рисунке 1.8. Патентный поиск
осуществлялся в информационно поисковой системе ФИПС. По результатам поиска было
найдено девять подобных систем по названию, но аналогичных по функционалу не
найдено.
Рисунок 1.8 – Результаты патентного поиска
2
КОНСТРУКТОРСКО-ТЕХНОЛОГИЧЕСКАЯ ЧАСТЬ
В этом разделе приведён подбор и расчёт некоторых конструктивных элементов
платформы. Подробно рассмотрен колёсный узел как основная сборочная единица
разрабатываемой конструкции. Выполнен расчёт на прочность и жёсткость несущей части
платформы. Разработаны чертежи колёсного узла и остова платформы.
Предложен
принцип работы системы локального позиционирования.
2.1
Техническая характеристика мобильной платформы
Мобильная платформа должна состоять из:
− бесколлекторных двигателей постоянного тока с датчиками Холла (БДПТ);
− линейных актуаторов постоянного тока;
− блока управления моторами;
− ультразвуковых дальномеров;
− инфракрасных дальномеров;
− 2D лидара;
− модуля камеры с углом обзора 130 градусов;
− блока управления;
− аккумуляторных блоков;
− омни–колес;
− набора стальных и алюминиевых пластин;
− литых алюминиевых креплений моторов;
− подшипников;
− крепежных изделий (болты, гайки).
Основные технические характеристики:
− размеры мобильной платформы (ДхШхВ): 470х530х160–230 мм.;
− масса мобильной платформы со всем оборудованием: 30 кг.;
− масса полезной нагрузки на грузовую платформу: 100 кг.;
− ёмкость аккумуляторной батареи: 40 А*ч;
− время работы в режиме сортировки грузов: 3,5 часа;
.
− время работы в режиме перевозки: 2 часа;
− максимальная скорость 1,5 м⁄с;
− диаметр сортировочного омни–колеса: 0,06 м.;
− диаметр приводного омни–колеса: 0,09 м.
2.2
Разработка структурной схемы мобильной платформы
Рассматриваются два варианта работы робототехнического комплекса (РТК):
Первый вариант
Вариант работы в режиме перевозки грузов: группа роботов перевозит грузы,
полученные на конвейерной линии на стеллаж карусельного типа [2] рисунок 2.1 с
разработанными полками, представленными на рисунке 2.2.
Рисунок 2.1 – Стеллаж карусельного типа
Рисунок 2.2 – Полка карусельного стеллажа для разрабатываемой системы
Такой вариант работы позволит сократить количество занимаемого места. В случаях
использования данной системы для хранения овощей и фруктов будет обеспеченны все
нормы хранения по СанПиН нормам за счет использования стеллажей закрытого типа [3].
При использовании стеллажей закрытого типа будут обеспеченны температурные нормы
только внутри стеллажа, а не во всем помещении, что хорошо скажется на электрическом
потреблении в сравнении с нынешним методом хранения.
Второй вариант
Разрабатываемая система подразумевает отказ от статичных конвейерных линий, в
силу их трудного обслуживания и гибкости систем в целом, и заменой группами роботов,
которые могут собирать конвейерные линии и производить сортировку грузов весом до ста
килограммов. Подобная система позволит оборудовать любое помещение с ровной
поверхностью под нужды сортировки. При нынешней системе дистанционных покупок
потребность в подобных системах будет только расти. Пример конвейерной линии из
роботов представлен на рисунке 2.3.
Рисунок 2.3 – Вариант использования РТК
Мехатронная система основывается на платформе на базе трех омни–колес. Каждое
колесо имеет независимое вращение от БДПТ с датчиками холла, датчики холла
необходимы для отслеживания скорости вращения колес. Такая платформа позволяет
передвигаться в произвольном направлении изменяя скорости колес. Также на грузовой
платформе робота расположены три омни–колеса для перемещения груза по платформе, это
необходимо в случаях, когда группе роботов необходимо построить конвейерную линию
для сортировки грузов. В случае работы в режиме перевозки и складирования для
приподнятия груза используются три линейных актуатора.
Чтобы независимо управлять скоростями всех шести БДПТ с датчиками холла
применяется шесть контроллеров двигателей, которые принимают на вход показания с
датчиков холла, затем микроконтроллер производит обработку сигналов и подает на
выходы обмоток мотора ШИМ сигнал, тем самым регулируя скорость вращения вала
двигателя. Для приподнятия грузов, как уже говорилось выше используются линейные
актуаторы, которые представляют из себя двигатель постоянного тока и шарико–винтовую
передачу, для управления данного типа привода используются два MOSFET транзистора на
каждый привод.
Вся работа грузовой мобильной платформы осуществляется на низком уровне с
помощью микроконтроллеров, объединенных в общую сеть по протоколу передачи I2C.
Система верхнего уровня обрабатывает все внешние сигналы, обрабатывает стек задач и
передает управляющий сигнал на все шесть контроллеров двигателей.
Также для предотвращения столкновений в РТК были применены ультразвуковые
(УЗ) и инфракрасные (ИК) датчики и 2D лидар, три разных типа определения расстояния
необходимы для сокращения ошибки работы каждого. Все показания с датчиков
обрабатываются системой верхнего уровня, и в случае возникновения преграды система
отправляет сигнал нижнему уровню о приостановке работы всех актуаторов.
Для
локальной
системы
позиционирования
используются
QR
метки
и
высокочастотная камера. За счет считывания информации с метки робот определяет
текущую позицию на складе. Все данные обрабатывает система верхнего уровня.
Структурная схема проектируемой системы нижнего уровня представлена на
рисунке 2.4.
Рисунок 2.4 – Структурная схема нижнего уровня управления грузового робота
2.3
Конструкция мобильной грузовой платформы
Шасси определяет схему расположения колёс, и соответственно конструкцию
платформы. В общем виде конструкцию можно представить следующим образом: несущая
часть (рисунок 2.5) – жёсткая рама (Приложение Л) со скреплёнными с ней колёсными
узлами (Приложение Е).
Всенаправленное колёсное шасси обычно исполнено на двух типах роликонесущих
колесах. Например, в работе [4] рассматриваются платформы на омни- и меканум–колёсах.
У первых оси роликов направлены вдоль плоскости колеса, у вторых под углом 45°.
На несущую часть крепятся остальные конструктивные элементы – линейные
актуаторы на которые грузовая платформа с омни–колесами для размещения груза,
внутренние секции для электроники и аккумуляторной батареи (АКБ) и т.д. Грузовая
платформа крепится на трех валах линейных актуаторов. Таким образом нагрузка с плиты
равномерно распределена по несущей части.
Для обеспечения большей грузоподъёмности делают многоколёсное шасси, и тогда
удельная нагрузка на колеса уменьшается. Например, в работе [5] рассматривается
шестиколёсный мобильный робот, где колёса расположены по три с каждой стороны
робота.
Рисунок 2.5 – Схема конструкции платформы
Есть немалое число публикаций с рассмотрением кинематики и динамики
мобильных платформ с использованием именно такого шасси [6, 7, 8, 9].
2.3.1 Разработка колёсного узла мобильной платформы
Колёсный узел – это основная часть шасси, приводящая в движение мобильную
платформу и груз на плите. На них опирается вся конструкция платформы и груза. Всего в
мобильной платформе шесть идентичных колёсных узлов (в силу симметрии конструкции).
Кинематическая схема колесного узла изображена на рисунке 2.6.
1 – опорные подшипники
2 – омни–колесо
3 – редуктор
4 – БДПТ с датчиками Холла
Рисунок 2.6 – Кинематическая схема колёсного узла
На выходной вал редуктора напрессовывается омни–колесо и фиксируется
металлической шпонкой. Опорный подшипник устанавливается после закрепления сборки
мотор–редуктор–колесо на несущую платформу.
Колесо является опорной частью платформы, и вся нагрузка, которая складывается
из массы самой платформы и массы перевозимого её груза, распределяется между всеми
колёсами. Примем, что общая масса платформы с полезным грузом в 100 кг. будет равна
150 кг. т.к. колёса относятся к ответственным элементам конструкции то их необходимо
подобрать с запасом по параметру статической грузоподъёмности. Выберем омни–колеса
14146 (рисунок 2.7) производства фирмы NEXUS ROBOT. Они специально применимы для
использования
в
грузовых
передвижных
платформах
Характеристики колёс приведены в таблице 2.1.
Таблица 2.1 – Характеристики омни–колес 14146
Диаметр, мм
94,5
Ширина, мм
40,8
Диаметр ступицы, мм
11
Ширина ступицы, мм
8
в
промышленной
сфере.
Продолжение таблицы 2.1
Кол–во роликов, шт.
Материал пластин крепления
Материал покрытия роликов
8
AISI 316T (10Х17Н13М2Т) нерж.
сталь
AISI 316T (10Х17Н13М2Т) нерж.
сталь
Материал основы роликов
ЛС63–3 Латунь
Масса, кг
1.1
Грузоподъемность, кг
170
Рисунок 2.7 – Внешний вид омни–колеса 14146
2.3.2 Подбор и расчет основных приводов
Бесколлекторные двигатели постоянного тока с датчиками Холла
Бесколлекторные двигатели с датчиками Холла (Sensored brushless motors)
применяются как тяговые, в электроприводах [10], где нужен высокий крутящий момент
при низких оборотах. Переключение обмоток двигателя происходит по сигналу датчиков.
Обычно они встроены в корпус двигателя (рисунок 2.8).
Рисунок 2.8 – БДПТ с датчиками Холла
Преимущества:
− срок службы значительно дольше, чем у коллекторных аналогов;
− высокий КПД;
− быстрый набор высокой скорости;
− отсутствие искр при работе, что позволяет использовать привод в
пожароопасных условиях;
− не требуется дополнительное охлаждение;
− компактность;
− позиционирование двигателя за счет встроенных датчиков Холла;
− высокий момент при низких оборотах (рисунок 2.9).
Рисунок 2.9 – Характеристики БДПТ мотора
2.3.3 Расчет привода платформы
Рассчитываем ускорение мобильной платформы:
𝛼=
где
𝑣 1
= = 1(м/𝑐 2 )
𝑡 1
(2.1)
𝑣 – требуемая скорость поворота платформы;
t – время нужное для достижения нужной скорости.
Рассчитываем количество оборотов в минуту:
N=ω⋅
где
60
60
= 22,22 ∙
= 212,31 (об/мин)
π
π
(2.2)
𝜔 – угловая скорость поворота платформы.
Рассчитываем крутящий момент:
𝑇=
где
(𝑎 + 𝑔 ⋅ 𝑠𝑖𝑛(𝜃)) ⋅ 𝑀 ∙ 𝑅 1 ∙ 200 ∙ 0,045
=
= 3 (Н ∙ м)
𝐵
3
(2.3)
М – масса мобильной платформы с грузом;
g – ускорение свободного падения;
𝜃– максимальный угол наклона поверхности;
𝐵– количество приводов на платформе;
R – радиус колеса.
Рассчитываем мощность двигателей:
𝑃 = 𝑇 ⋅ 𝜔 = 3 ∙ 22,22 = 67 (Вт. )
(2.4)
Рассчитываем максимальный ток работы мотора:
𝐼=
где
𝑇 ⋅ 𝜔 67
=
= 5,58(А)
𝑉
12
v – напряжение работы привода.
(2.5)
Рассчитаем емкость аккумуляторной батареи:
𝑐 = 𝐼 ⋅ 𝐵 ∙ 𝑡раб = 5,58 ∙ 3 ∙ 2 = 33,48 (А ∙ ч)
где
(2.6)
tраб – время работы приводов.
При расчетах не учитывалось КПД редуктора, мотора, передачи, подшипников,
контроллера, поэтому примем коэффициент запаса, который будет равен k = 1,5.
2.3.4 Расчет привода перемещения груза
Рассчитываем ускорение груза на платформе:
𝛼=
где
𝑣 0,5
=
= 0,5(м/𝑐 2 )
𝑡
1
(2.7)
𝑣 – требуемая скорость перемещения груза;
t – время нужное для достижения нужной скорости.
Рассчитываем количество оборотов в минуту:
𝑁=𝜔⋅
где
60
60
= 16,667 ∙
= 159,24 (об/мин)
𝜋
𝜋
(2.8)
𝜔 – угловая скорость перемещения груза.
Рассчитываем крутящий момент [11]:
𝑇=
где
(𝑎 + 𝑔 ⋅ 𝑠𝑖𝑛(𝜃)) ⋅ 𝑀 ∙ 𝑅 0,5 ∙ 120 ∙ 0,03
=
= 0,6 (Н ∙ м)
𝐵
3
М – масса мобильной платформы с грузом;
g – ускорение свободного падения;
𝜃– максимальный угол наклона поверхности;
𝐵– количество приводов на платформе;
R – радиус колеса.
(2.9)
Рассчитываем мощность двигателей:
𝑃 = 𝑇 ⋅ 𝜔 = 3 ∙ 22,22 = 10 (Вт. )
(2.10)
Рассчитываем максимальный ток работы мотора:
𝐼=
где
𝑇 ⋅ 𝜔 10
=
= 0,88(А)
𝑉
12
(2.11)
V – напряжение работы привода.
Рассчитаем емкость аккумуляторной батареи:
𝑐 = 𝐼 ⋅ 𝐵 ∙ 𝑡раб = 5,58 ∙ 3 ∙ 2 = 5 (А ∙ ч)
где
(2.12)
tраб – время работы приводов.
При расчетах не учитывалось КПД редуктора, мотора, передачи, подшипников,
контроллера, поэтому примем коэффициент запаса, который будет равен k = 1,2;
2.3.5 Расчет параметров актуатора для подъёма грузовой платформы
Основные параметры лифтовой системы:
− максимальная масса груза: 100 кг.;
− количество линейных актуаторов: 3 шт.;
− скорость подъема: не нормирована;
− максимальная длина хода штока: 50 мм.
Исходя из необходимых данных можно рассчитать необходимое усилие толкания
для линейного актуатора [12]:
𝑃=
𝑀∙𝑔
100 ∙ 9,8
∙ 𝑘зап =
∙ 1,2 = 400(𝐻)
𝐵
3
В таблице 2.2 приведены необходимые данные для выбора приводов:
(2.13)
толкания (Н)
часа работы
Усилие
(А*ч)
батареи на 2
Емкость
(Ватт)
Мощность
(об/мин)
вращения
Скорость
(В)
питания
Напряжение
Вращающий
момент (Н*м)
Таблица 2.2 – Сводная таблица характеристик привода
Привод
перемещения
4,5
12
212
70
50
–
0,7575
12
160
13
7
–
–
12
–
–
~7
400
платформы
Привод
перемещения
груза
Привод
подъема груза
По рассчитанным данными мы можем провести выбор приводов. Так как на рынке
хорошо зарекомендовали себя две основные компании–производители прецизионных
приводов MAXON DRIVE SYSTEM и FAULHABBER MOTOR, то выберем основные
приводы у этих компаний. Так как в данной работе не стоит речь о цене комплектующих,
то можно выбрать моторы компании производителя MAXON DRIVE SYSTEM.
По заданным на сайте MAXON DRIVE SYSTEM параметрам были выбраны
следующие приводы:
Привод перемещения платформы
Для привода перемещения платформы – «EC– max Ø40 mm, brushless, 70 W, with Hall
sensors 283866», технические характеристики которого указаны на рисунке 2.11, а размеры
показаны на рисунке 2.10.
Рисунок 2.10 – Размеры мотора 283866
Рисунок 2.11 – Характеристики мотора 283866
Привод перемещения груза
Для привода перемещения груза– «EC–i 30 Ø30 mm, brushless, 30 W, with Hall sensors
539472», технические характеристики которого указаны на рисунке 2.13, а размеры
показаны на рисунке 2.12.
Рисунок 2.12 – Размеры мотора 539472
Рисунок 2.13 – Характеристики мотора 539472
Привод лифтовой системы
Привод подъёма груза был выбран у компании, ориентированной на производство
линейных актуаторов, «HydroWorks »
TM
Линейный актуатор «12V DC 2 in. Stroke 270 lb Linear Actuator» (рисунок 2.14).
Основные параметры привода представлены на рисунке 2.15.
Рисунок 2.14 – Общий вид линейного привода
Рисунок 2.15 – Характеристики линейного привода
2.3.6 Подбор редукторов
Для нормирования крутящего момента также требуются редукторы для приводов.
Данные комплектующие выбраны также на сайте MAXON DRIVE SYSTEM.
Для привода перемещения платформы был выбран планетарный редуктор «Planetary
Gearhead GP 42 C Ø42 mm 203120», общий вид редуктора представлен на рисунке 2.16.
Технические параметры редуктора 203120 указаны на рисунке 2.17.
Рисунок 2.16 – Общий вид редуктора 203120
Рисунок 2.17 – Характеристики редуктора 203120
Для привода перемещения груза был выбран планетарный редуктор «Planetary
Gearhead GP 42 C Ø42 mm 203120» общий вид редуктора представлен на рисунке 2.18.
Технические параметры редуктора 203120 указаны на рисунке 2.19.
Рисунок 2.18 – Общий вид редуктора 166164
Рисунок 2.19 – Характеристики редуктора 166164
2.3.7 Сборка колёсных узлов
Сборочный чертеж колёсного узла приведён в Приложении Е, спецификация к
чертежу в Приложении Ж. 3D модель узла представлена на рисунке 2.20.
Технологическая схема сборки колёсного узла представлена в Приложении И.
Рисунок 2.20 – 3D–модель колесного узла
2.4
Выбор элементной базы РТК
В настоящее время существуют различные микроконтроллеры, отвечающие разным
требованиям. Основными требованиями, предъявляемому к микроконтроллеру являются:
− наличие параллельных портов ввода–вывода в количестве, достаточном для
подключения всех элементов, входящих в структурную схему;
− низкое потребление напряжения;
− оперативная память, не превышающая 64 байт;
− наименьшая стоимость.
Проведем сравнительную характеристику микроконтроллеров фирмы ATmega
(таблица 2.3).
Таблица 2.3 – Сравнительный анализ микроконтроллеров ATmega
Название
Flash
ROM
Число
Число
Тактовая
аналоговых
цифровых
частота,
входов
входов
МГц
Стоимость,
руб
ATmega128
128
8
16
8
450
ATmega328P
32
6
14
16
150
ATmega2560
256
16
54
16
500
Рассмотрев данные таблицы, выбираем микроконтроллер ATmega2560 (рисунок
2.21), так как обладает достаточным количеством цифровых и аналоговых портов и не
сильно отличается по цене от других рассмотренных микроконтроллеров. Затем
разработаем печатаную плату с микроконтроллером ATmega2560.
Рисунок 2.21 – Микроконтроллер ATmega2560
Выберем основные датчики определения препятствий. Данные датчики нужны для
внештатных ситуаций, таких как возникновение на пути робота человека и т.п. Основные
требования к датчикам расстояния:
− Диапазон измеряемого расстояния: 15–150 см.
− Класс защиты: IP67
− Вид сигнала: аналоговый
− Тип датчика: миниатюрный
Также, ввиду обширного количества подобных датчиков и ввиду из разного
определения расстояния необходимо применить два различных метода определения
расстояния. Существующие методы определения расстояния:
− Оптический
− Ультразвуковой
− Энкодерный
− Резистивный
− Магнитные
Пройдемся по каждому из методов по отдельности.
Оптический
Оптические датчики расстояния имеют большой рабочий диапазон (до 130 м) и
высокое разрешение (1 мм). Управление осуществляется программным методом или в
режиме teach–in. Датчики излучают световой пучок на объект или специальный отражатель
и анализируют отраженный свет. Полученные результаты измерений преобразуются в
электрический сигнал.
Ультразвуковой
Почти не существует материалов, которые не могут быть обнаружены УЗ датчиками.
Поэтому ультразвуковые измерители – идеальное решение для определения положения и
удаленности объекта в трудных условиях эксплуатации с точностью до миллиметра. Но в
случае определения расстояния по пористых объектов такой тип датчиков во многом
проигрывает оптическим, в силу большого угла распространения УЗ.
Энкодерный
Энкодеры с тросовым выводом сочетают в себе энкодерное устройство и тросовый
механизм и используются для измерения линейных перемещений объектов. Линейное
перемещение троса, который закрепляется на измеряемом механизме, пропорционально
вращению измерительного барабана в энкодере. Количество оборотов конвертируется в
выходной сигнал требуемого типа.
Резистивные
Датчики
преобразовывают
линейные
механические
перемещения
в
соответствующее изменение сопротивления. Линейный потенциометр может выдавать на
выходе значение напряжения, пропорциональное перемещению движка, если на концы
резистора подавать напряжение питания, а выходное напряжение снимать с движка.
В условиях эксплуатации РТК перед роботом могут возникать такие предметы как:
коробки, пакеты, мешки, пенопласт. Подразумевается, что человек также может находиться
на пути движения робота. Поэтому были выбраны два основных типа датчика расстояния,
это датчики, основанные на ультразвуковом определении, и датчики, основанные на
оптическом инфракрасном поредении расстояния.
Выберем ультразвуковой дальномер и приведем таблицу со сравнительными
характеристиками (таблица 2.4).
Таблица 2.4 – Сравнительный анализ ультразвуковых датчиков
измерения
работы,
расстояния
В
Частота
звукового
Класс
излучения,
защиты
кГц
руб.
Напряжение
Стоимость,
Название
Диапазон
HY–SRF05
от 2 до 450 см.
5
20
IP24
250
DYP–ME007
от 3 см до 4 м.
5
40
IP24
600
JSN–SR04T
От 5 см. до 5 м.
3–5,5
40
IP67
2000
Выберем датчик JSN–SR04T (рисунок 2.22), он подходит нам по всем
характеристикам, для работы с этим датчиком необходим АЦП, плата–преобразователь
показаний в CAN сигнал. Приведем некоторые его характеристики в таблице 2.5:
Таблица 2.5 – Характеристики датчика JSN–SR04T
Характеристики ультразвукового дальномера
Рабочее напряжение
3,0 В ~ 5,5 В DC
Рабочий ток
< 30 мА
Продолжение таблицы 2.5
Ток ожидания
Частота ультразвукового
сигнала
Максимальная дальность до
объекта
5 мА
40 кГц
5м
Слепая зона
25 см
Точность
± 1 см
Разрешение
1 мм
Угол обзора
50°
5В–напряжение питания;
Контакты
Echo–выходной сигнал;
Trig–входной сигнал;
GND – общий контакт.
Общие характеристики
Рабочая температура
Габариты электронного
модуля
Длина провода от датчика до
платы
Комплектация
–10 ~ 60°C
41 мм x 28 мм
240 см
электронный модуль дальномера – 1 шт.
датчик с кабелем – 1 шт.
Рисунок 2.22 – JSN–SR04T УЗ датчик расстояния с платой–преобразователем
Выберем инфракрасный дальномер и приведем таблицу со сравнительными
характеристиками (таблица 2.6).
от 10 – 150
GP2Y0A21YK0F
GP2Y0A02YK0F
GP2Y0A60SZ
см.
от 20 до 150
см.
от 10 до 150
см.
Стоимость, руб.
защиты
Класс
Период
расстояния
В
измерения
работы,
Название
Напряжение
Диапазон
обновления, мс.
Таблица 2.6 – Характеристики ИК дальномеров
4,5 – 5,5
16.5 ± 4
IP67
350
4,5 – 5,5
16.5 ± 4
IP67
500
2,7 – 5,5
16.5 ± 4
–
650
Все приведенные в таблице датчики основаны на ИК сенсорах компании Sharp,
поэтому все имеют одинаковый период обновления информации о расстоянии. Поэтому,
рассмотрев таблицу, выбираем датчик, который соответствует нашим требованиям, а
именно датчик GP2Y0A21YK0F (рисунок 2.23). Также приведем полные характеристики
этого датчика:
− рабочее напряжение: 4,5 – 5,5 В;
− потребляемый ток: 30 мА;
− измеряемое расстояние: 10 – 150 см.;
− тип выходного сигнала: аналоговый;
− дифференциальное
напряжение,
расстояния: 1,9В;
− время отклика: 16.5 ± 4 мс.;
− размеры: 29,5 х 13,0 х 13,5 мм.;
− вес: 3,5 гр.
большее
диапазона
распознавания
Рисунок 2.23 – GP2Y0A21YK0F ИК датчик расстояния
Выберем камеры технического зрения для определения QR–меток. Для решения
этой задачи камеры, соответствующие требованиям:
− габаритные размеры: 80 х 60 х 120 мм;
− вес: 500 г;
− датчик камеры: CMOS затвор;
− разрешение: 752 х 480 пикселей;
− скорость срабатывания затвора: 100 мс;
− фокусное расстояние: 8 мм / 16 мм;
− расстояние до объекта: от 50 мм / от 75 мм;
− интерфейсы: RS–232, Ethernet;
− степень защиты корпуса: IP 65 / IP 67.
Проведем сравнительную характеристику камер для технического зрения (таблица
2.7).
Таблица 2.7 – Сравнительный анализ камер для технического зрения
Габаритные
размеры, мм
Вес, г
Датчик камеры
Разрешение,
пикселей
Sony VLXT–
Sony VLXT–
31M.I
123M.I
60 x 60 x 99.7
60 x 60 x 99.7
75 х 55 х 113
485
485
500
CMOS
CMOS
CMOS
2048 × 1536
4096 × 3000
752 х 480
LSIS 412i
Продолжение таблицы 2.7
Скорость
срабатывания
1
1
20
8
8
8
От 30
От 30
от 50
RS–232, Ethernet
RS–232, Ethernet
затвора, мс
Фокусное
расстояние, мм.
Расстояние до
объекта, мм.
Степень защиты
RS–232,
корпуса
Ethernet
Интерфейсы
IP 67
IP 67
IP 67
Стоимость
10000
12000
7000
Рассмотрев таблицу, выберем LSIS 412i (рисунок 2.24), она обладает всеми
необходимыми
параметрами.
Выбор
проводился
из
специализированных
камер,
предназначенных для систем технического зрения. Приведем полные характеристики этой
камеры:
− серия LSIS 412i;
− чип CMOS;
− разрешение камеры, горизонтальное 752 px;
− разрешение камеры, по вертикали 480 пикселей;
− размер чипа 1/3 дюйма;
− частота кадров (изображений в секунду), макс. 50 штук в секунду;
− скорость электронного затвора 0,054 ... 20 мс;
− тип камеры: монохромный;
− напряжение питания 18 В ... 30 В;
− потребляемая мощность, не более 8 Вт;
− температура окружающей среды, эксплуатация 0 ... 45 ° C;
− температура окружающей среды, хранение –20 ... 70 ° С;
− тип конфигурации через веб–браузер ;
Рисунок 2.24 – Камера СТЗ серии LSIS 412i
Выберем одноплатный компьютер для обработки данных с камеры и управления
системой. Проведем сравнительную характеристику одноплатных компьютеров (таблица
2.8).
SoC
Broadcom
Amlogic
BCM2837B0
S905
ARM Cortex–
CPU
A53 (64–
битный)
1,4 ГГц
четыре ядра
MICRO–4GB
A20–OLinuXino–
Rev. C
BeagleBone Black
ODROID–C2
B+
Характеристика
Raspberry Pi 3 Model
Таблица 2.8 – Сравнительная характеристика одноплатных компьютеров
Texas
Instruments
AllWinner A20
AM3358/9
ARM
ARM
Cortex–
Cortex–A8
ARM Cortex–A7
A53 (64–
(32–
(32–битный)
битный)
битный)
1,5 ГГц
четыре
ядра
1 ГГц одно
ядро
1 ГГц два ядра
Продолжение таблицы 2.8
GPU
Объем ОЗУ
Встроенная
память
PowerVR
VideoCore IV
Mali–450
1 Гбайт
2 Гбайт
512Мбайт
1 Гбайт
–
–
4 Гбайт
4 Гбайт
MicroSD
MicroSD
SGX530
Mali 400
8Гбайт
Внешняя память
MicroSD
MicroSD,
64 Гбайт
eMMC
USB host
4
4
1
2
USB OTG
+
+
+
+
Версия USB
2
2
2
2
Ethernet
1
1
1
1
Тип Ethernet
Gigabit
Gigabit
10/100
10/100
Wake–on–Lan
–
–
–
–
HDMI
+
+
+
+
VGA
–
–
–
+
CVBS
+
–
–
–
Интерфейс
дисплея
Интерфейс с
Совместим с
MIPI DSI
–
–
модулями
дисплеев Olimex
1
–
–
Аудио выход
+
–
–
Аудио разъем
3,5 мм jack
–
–
3,5 мjack
HDMI–аудио
+
+
+
+
камерой
–
Продолжение таблицы 2.8
SPDIF
–
–
–
–
I2S
+
+
–
+
Линейный вход
–
–
–
–
–
–
–
+
–
–
–
–
SATA
–
–
–
+
ИК–датчик
–
+
–
–
802.11b/g/n/ac
–
–
–
–
–
–
Микрофонный
вход
Встроенный
микрофон
WiFi
Bluetooth
Bluetooth
BLE 4.2
ШИМ
1
1
–
1
АЦП
–
+
+
–
I2C
1
2
2
2
SPI
1
1
1
3
UART
1
1
5
6
RS232
–
–
–
–
Сокет Arduino
–
–
–
–
Напряжение
4,8...5,2 В
5В
5В
6...16 В
Потребление
600мА – 2.4A
500мА –
600мА –
2A
1,4А
есть
есть
есть
Android 4.4
Android 4.2
–
–
Поддержка Linux
Поддержка
Android
Поддержка
Windows
есть
–
Windows 10
IoT Core
Android
5.1
–
800мА – 2,1A
Продолжение таблицы 2.8
Габариты, мм
85 x 56 x 17
Вес, мм
85 x 56 x
18
45
40
0...45 °C
н/д
$35
$46
Диапазон
рабочих
температур
Ориентировочная
цена
86,36х54,61
142 x 82
н/д
н/д
–40…+85
°C
$45
н/д
$89
По таблице, выберем одноплатный компьютер Raspberry Pi 3 Model B+ (рисунок
2.25), он хорошо зарекомендовал во многих проектах в силу хорошей поддержки ПО от
производителя и высокой вычислительной мощности.
Рисунок 2.25 – Одноплатный компьютер Raspberry Pi 3 Model B+
Выберем 2D Lidar для дополнительной системы позиционирования робота по
плоскости.
Из–за
конструктивных
особенностей
РТК,
необходимы
характеристики лидара:
− определение положения предметов на расстоянии до 5 м.;
− сектор сканирования: 180 град.;
− скорость сканирования: 25 мс.
Сравнительная характеристика 2D лидаров представлена в таблице 2.9.
следующие
Таблица 2.9 – Сравнительная характеристика 2D лидаров
Габаритные
размеры, мм
Вес, г
Питающее
напряжение
Частота
сканирования
Ток потребления
Протокол передачи
данных
Тип подключения
Максимальный
диапазон
сканирования
Интерфейсы
Стоимость
Hokuyo URG–
Hokuyo URG–
Hokuyo UBR–
04LX–UG01
04LX
04LX–F01
50x50x70
50x50x70
60x75x60
160
160
185
5В
5В
12В
10Hz(600rpm)
10Hz(600rpm)
36Hz(2160rpm)
0,5А
0,3А
0,4А
SCIP 2.0
SCIP 1.1/2.0
SCIP 2.0
USB1.1/2.0 или
USB1.1/2.0 или
RS–232C
RS–232C
От 0,02 м. до 5,6
От 0,02 м. до 5,6
От 0,02 м. до 5,6 м.
м. 240 градусов
м. 240 градусов
240 градусов
–
–
IP40
$2600
$1450
$2170
USB1.1/2.0
Оптимальным для использования в разрабатываемой системе будет сканирующий
2D лидар Hokuyo URG–04LX, его внешний вид представлен на рисунке 2.26.
Рисунок 2.26 – 2D лидар Hokuyo URG–04LX
Выберем аккумуляторную ячейку для функционирования всех элементов робота. По
расчетным данным общая емкость батарей робота должна быть не менее 50 А*ч при
напряжении 11,1 Вольт. Так как на рынке представлено малое количество аккумуляторов с
подобной емкостью, то прибегнем к использованию ячеек стандарта – 18650.
В таблице 2.10 приведено сравнение аккумуляторных батарей формата 18650.
Таблица 2.10 – Сравнение аккумуляторов стандарта 18650
Максимальный ток
Модель
Напряжение, В
Емкость, мА*ч
JOUYM DIY HG2
3,7
3000
30
INR18650–33E
3,7
3400
10
NCR18650B
3,7
3400
15
LG HE4 18650
3,7
2500
25
разряда, А
Оптимальным аккумулятором для применения в РТК будет ячейка JOUYM DIY
HG2, так как имеет высокий ток разряда и достаточно высокую емкость. Необходимо
посчитать количество ячеек для необходимой емкости и напряжения.
Количество ячеек будет рассчитываться исходя из напряжения ячейки и
необходимого напряжения всей батареи.
𝐽=
где
𝑉я
11,1
=
= 3 шт.
𝑉б
3,7
(2.14)
VЯ – напряжение ячейки 18650;
Vб – напряжение АКБ робота.
Для набора напряжения 11,1 вольт,
последовательном соединении ячеек
необходимо 3 ячейки 18650, при
емкость остается той же, а это 3000 мА*ч.
Чтобы рассчитать общее количество ячеек для конечной емкости аккумуляторной
батареи (АКБ) нам потребуется емкость ячейки, емкость АКБ и количество ячеек для
необходимого напряжения.
𝐽общ =
𝐶б
50000
∗𝐽 =
∗ 3 = 50 шт.
Ся
3000
(2.15)
где
СЯ – емкость ячейки 18650;
Сб – емкость АКБ робота.
Исходя из расчетов для достижения емкости 50 А*ч и напряжения 11,1 В нам
потребуется 50 аккумуляторных ячеек формата 18650.
Для оптимального использования пространства внутри робота АКБ была разделена
на 5 частей по 10 ячеек 18650 в каждом блоке. Разработанный блок АКБ представлен на
рисунке 2.27.
Рисунок 2.27 – 3D модель разработанной АКБ
2.5
Разработка контроллера БДПТ
Так как основными приводами РТК являются БДПТ Maxon с датчиками холла,
необходимо разработать контроллер, который будет переключать обмотки согласно
сигналам с датчиков Холла, а также будет отслеживать скорость вращения вала.
Для того, чтобы отслеживать сигналы с датчиков применяется микроконтроллер
Atmega 328P семейство микроконтроллеров AVR (рисунок 2.28).
Рисунок 2.28 – Внешний вид AVR микроконтроллеров
Для работы микроконтроллера необходима небольшая обвязка (рисунок 2.29),
основные компоненты которой представлены в таблице 2.11.
Таблица 2.11 – Обозначение электронных компонентов
Обозначение
Dd1
Dd2
Название
Номинал
Микроконтроллер
ATmega 2560P
Стабилизатор
LM7805EE
напряжения
Тактовая кнопка
SWT–20–5.0 SMD
R1, R3
Резистор
500 Ом 0805 smd 0,125Вт
R2
Резистор
10 кОм 0805 smd 0,125Вт
R4
Резистор
1 мОм 0805 smd 0,125Вт
Кварцевый резонатор
16.000 МГц имп. HC–49SM
Светодиод
BL–LS1206UHR
VD2
Диод шотки
CD1206–s011575
С1–С3
Конденсатор
CL10C220JB8NNNC 22пф NPO
Конденсатор
GRM188R61E104KA01D 0603 X5R
SB1
ZQ1
VD1, VD3
С4–С4
С5
100нФ
Конденсатор
MA1206XR103K501ERG 1206
0,01мкф X7R
Рисунок 2.29 – Обвязка микроконтроллера ATmega2560
Питание контроллера (Dd1) делится на цифровую часть (VCC, GND) и аналоговою
(AVCC, AGND), и для ATmega8, 168, 328, 2560 должно лежать в пределах 5 вольт. В нашем
случае можно смело объединить VCC с AVCC и GND c AGND.
В контроллере также присутствует вывод AREF. Напряжение, присутствующее на
данном выводе, будет задавать опорное для аналоговых входов. Если данный вывод ни к
чему не подключен, что мы и имеем на платах Arduino, то контроллер автоматом задает
значение опорного напряжения равное 5 вольтам.
Для фильтрации ВЧ помех рекомендуется установить конденсатор (C1) емкостью
0.1 мкФ между питанием контроллера и землей.
В контроллерах ATmega8, 168, 328 имеется внутренний кварцевый генератор,
работающий на частоте 8 МГЦ, т.е если нам не очень важна частота, то во внешнюю обвязку
можно внешний кварц и не включать. Однако при таком варианте, потребуется прошивать
соответствующий бутлоадер и добавлять новые платы в boards.txt.
Большинство плат Arduino работает на частоте 16 МГц, в связи с этим необходима
установка внешнего кварца. Кварц (Q1) ставится на ноги 9 и 10 (выводы XTAIL1/XTAIL2)
и далее через конденсаторы (C2, C3), нужного для работы кварца номинала (в нашем случае
18–22 пФ), кидаются на землю.
Для возможности осуществления перезагрузки контроллера предусмотрен вывод
RESET.
Когда на выводе присутствует положительный потенциал, для этого притягиваем
резистором (R1) к +5 вольтам, контроллер работает по заданной программе. Для
осуществления сброса МК вывод RESET необходимо замкнуть на землю, для этих целей
служит кнопка (S1).
Не всегда под рукой можно найти стабилизированные 5 вольт. Самым простым
способом решения данной проблемы является установка широко распространённого
стабилизатора 7805, в простонародье Кренка.
Для сглаживания входного и выходного напряжений в обвязку кренки необходимо
установить конденсаторы (C5, C6). Кренка будет работать и без них, однако напряжение
может подскакивать.
Связь с внешним миром в контроллерах ATmega8, 168, 328, 2560 представлена 3
видами интерфейсов.I2C (Inter–Integrated Circuit) – последовательная шина данных для
связи интегральных схем, использующая две двунаправленные линии связи (SDA и SCL).
Используется для соединения низкоскоростных периферийных компонентов с материнской
платой, встраиваемыми системами и мобильными телефонами.
UART (Universal Asynchronous Receiver–Transmitter) – узел вычислительных
устройств, предназначенный для связи с другими цифровыми устройствами. Преобразует
заданный набор данных в последовательный вид так, чтобы было возможно передать их по
однопроводной цифровой линии другому аналогичному устройству. Метод преобразования
хорошо стандартизован и широко применялся в компьютерной технике.
SPI (Serial Peripheral Interface, SPI bus) – последовательный периферийный
интерфейс, шина SPI) – последовательный синхронный стандарт передачи данных в
режиме полного дуплекса, разработанный компанией Motorola для обеспечения простого и
недорогого сопряжения микроконтроллеров и периферии. SPI также иногда называют
четырёхпроводным (англ. four–wire) интерфейсом.
Для определения положения ротора и регулировки скорости его вращения
используются данные, предоставленные производителем на рисунках 2.30 и 2.31.
Рисунок 2.30 – Показания датчиков при вращении по часовой стрелке
Рисунок 2.31 – Показания датчиков при вращении против часовой стрелки
Датчики холла подключаются к выводам внешних прерываний микроконтроллера,
что позволяет не пропустить положение. Тактирование осуществляется от внешнего кварца
частотой 8МГц.
За переключение обмоток двигателя отвечают шесть полевых транзисторов, которые
и осуществляют коммутацию.
В ситуации переключения полярности питания используется два ключа верхнего и
нижнего уровней, и чтобы с помощью микроконтроллера управлять затвором был
применен драйвер ключей верхнего и нижнего уровней, который защищает схему от
неправильной коммутации.
Регулировку частоты вращения вала двигателя сделаем при помощи широтно–
импульсной модуляции. Переключение обмоток двигателя происходит в обработчике
внешнего прерывания. При считывании датчиков их значения записываются в переменную,
исходя из этого происходит переключение выходов согласно таблицам.
В итоге подключив все компоненты мы получаем итоговую схему (Приложение П).
При разработке принципиальной схемы использовалась программа sPlan 7.0. Это
одна из самых простых и удобных программ и не потребует много времени на свое
освоение, но позволяет быстро рисовать электрические схемы и рисунки, практически
любой сложности.
Для создания схемы необходимо просто перетащить необходимые элементы
(спрайты) из библиотеки на лист и соединить их между собой. Все графические элементы
автоматически привязываются к сетке листа
Все элементы и компоненты из библиотеки могут быть свободно отредактированы
как необходимо, их все можно группировать, перемещать, вращать на заданный угол,
копировать, вырезать, вставлять, удалять и т. д.
По разработанной принципиальной схеме, представленной в Приложении П, была
разработана печатная плата контроллера в САПР DipTrace и представлена в Приложении Р.
Также на рисунке 2.32 показана 3D модель контроллера БДПТ приводов.
Рисунок 2.32 – 3D модель разработанной печатной платы контроллера
Плата управления БДПТ Maxon подключается к контроллеру нижнего уровня по
интерфейсу I2C.
После изготовления печатной платы была написана программа на языке Си для
управления скоростью вращения ротора и представлена в Приложении С.
2.6
Разработка внешнего вида мобильной платформы
Для разработки 3D модели проекта использовалось программное обеспечение
SolidWorks 2019 Student Edition, предоставленной компанией Dassault Systemes за успешное
участие в ряде проектов.
В SolidWorks можно одинаково удачно работать как с твердыми телами, так и с
поверхностями. Как правило, деталь представляет собой твердое тело, поверхность либо
сочетание твердого тела и набора поверхностей. Процесс построения 3D–модели
основывается на создании элементарных геометрических примитивов и выполнении
различных операций между ними. Подобно конструктору LEGO модель набирается из
стандартных элементов (блоков) и может быть отредактирована путем либо добавления
(удаления) этих элементов, либо изменения характерных параметров блоков.
3D – модель содержит наиболее полное описание физических свойств объекта
(объем, масса, моменты инерции) и дает проектанту возможность работы в виртуальном
3D–пространстве, что позволяет на самом высоком уровне приблизить компьютерную
модель к облику будущего изделия, исключая этап макетирования.
В течение последних нескольких лет разработчики SolidWorks уделяют пристальное
внимание работе с большими сборками, количество компонентов которых может
составлять десятки и сотни тысяч единиц. Безусловно, для работы с такими комплексными
моделями требуется использовать специальные методики управления отдельными
деталями и узлами сборки, рационально распоряжаться ресурсами процессора и
оперативной памяти.
В базовую конфигурацию SolidWorks входит модуль экспресс–анализа прочности –
COSMOSXpress,
являющийся
«облегченной»
версией
пакета
COSMOS/Works
и
предназначенный в первую очередь для инженеров–проектировщиков, не обладающих
глубокими познаниями в теории конечно–элементного анализа. Тем не менее
COSMOSXpress позволяет проектировщику определить, где расположены концентраторы
напряжений, оценить «перетяжеленные» элементы конструкции, из которых может быть
удален избыточный материал с целью снижения веса и соответственно стоимости будущего
изделия.
COSMOSXpress выполнен в виде программы–помощника, подсказывающей
пользователю последовательность действий, необходимых для подготовки расчетной
модели и проведения анализа. Пользовательский интерфейс COSMOSXpress, как и
SolidWorks, выполнен на русском языке, что по–своему уникально, поскольку этого нет ни
в одной импортной системе конечно–элементного анализа.
На современном этапе экономические потери при обмене CAD–моделями очень
существенны, именно поэтому в базовое решение SolidWorks включены все необходимые
трансляторы, обеспечивающие корректную передачу данных как в нейтральных, так и в
«родных» форматах большинства имеющихся сейчас на рынке САПР.
В 2000 году пакет SolidWorks был сертифицирован по стандарту STEP AP 203
(ISO/IEC 10303 Standard for the Exchange of Product Model Data) компанией U.S. Product Data
Association (US PRO, США). Полноценно поддерживая стандарт STEP, SolidWorks
гарантирует надежный обмен данными с различными конструкторско–технологическими
системами. Используя сертифицированное программное обеспечение, предприятие
получает дополнительные гарантии качества выпускаемой продукции, а также перспективы
в получении зарубежных заказов.
В состав базового решения SolidWorks входит специальный интерфейс для
разработки пользовательских подпрограмм – SolidWorks API (Application Programming
Interface). API–интерфейс содержит сотни функций, которые можно вызывать из программ
Microsoft Visual C++, Visual Basic, VBA (Excel, Word и т.д.) или файлов–макросов
SolidWorks. Эти функции предоставляют программисту прямой доступ к функциональным
возможностям САПР SolidWorks и позволяют автоматизировать и таким образом идеально
настроить систему на решение специфичных задач конкретного предприятия. В отличие от
ряда конкурирующих систем, API–интерфейс входит в базовую функциональность
SolidWorks и поставляется бесплатно.
3D модель грузового робототехнического комплекса, спроектированного в среде
SolidWorks представлена на рисунке 2.33. Сборочный чертеж грузового мобильного робота
представлен, и его спецификация представлены в Приложении М и Приложении Н.
Рисунок 2.33 – Разработанный макет РТК
3
ИССЛЕДОВАТЕЛЬСКАЯ ЧАСТЬ
В этом разделе рассматривается построение маршрута для группы роботов с
помощью алгоритма поиска и планирования пути, кинематика и динамика мобильной
платформы. Получены уравнения движения мобильной платформы, описывающие связь
между приложенными моментами к колёсам и скоростью движения платформы.
Синтезирован контур управления скоростью привода колеса. Заданы структуры
математических моделей стабилизации скорости и положения мобильной платформой с
учётом её динамических свойств.
3.1
Алгоритм поиска пути
Задача поиска пути была сведена к задаче поиска пути на графе из узла–старта до
узла–финиша [13, 14]. Пара (V ( G ) , E ( G ) ) называется графом, если V ( G ) – непустое
конечное множество элементов, называемых узлами, а E ( G ) – конечное множество
неупорядоченных пар различных элементов из V ( G ) , называемых рёбрами [15]. При этом
поиск
необходимо
осуществлять,
учитывая
проходимость
различных
опорных
поверхностей и радиус поворота робота.
Для задачи поиска пути роботом также необходимо учитывать длину пути, что
можно обозначить через вес рёбер. При этом, если робот может переместиться из точки A
в точку Б, то не обязательно, что он может и переместиться из точки Б в точку A. Например,
если точка A – это точка на открытой местности, а точка Б – точка у стены с азимутом,
направленным прямо в стену. Таким образом, для поставленной задачи подходит
использование взвешенного ориентированного графа.
Узел графа по определению представляет собой элемент графа, обозначающий
объект любой природы. В данной задаче узел графа обозначает область на местности, в
которую робот имеет возможность встать. Так как необходимо учитывать радиус поворота
робота, то необходимо и учитывать азимут робота при построении пути. Таким образом,
узел графа задается не только координатами x , y , но и азимутом.
Ребром графа обозначается траектория между узлами, которые она соединяет, по
которой может перемещаться робот. При этом траектория строится с учетом радиуса
.
поворота робота. Так как при поиске пути надо учитывать проходимость различных
опорных поверхностей, то вес ребра обозначим как средний коэффициент проходимости на
всём протяжении траектории данного ребра.
Путь робота проходит от узла к узлу. Но эти узлы не могут быть соединены ребрами,
являющимися прямыми траекториями, так как робот не имеет возможность мгновенно
развернуться в нужном направлении. Поэтому между узлами необходимо находить
траекторию с плавными поворотами, соответствующими радиусу поворота робота. При
этом необходимо проверять эти траектории на наличие препятствий на пути.
Учет радиуса поворота происходит при построении траектории от узла к узлу.
Соответственно, каждый узел, помимо координат, характеризовался еще и азимутом.
Итоговая траектория между двумя узлами состоит из трех сегментов – двух дуг и отрезка
прямой. При этом могут возникнуть два случая, различающиеся подсчетом основных точек:
когда обе окружности обходятся в одном направлении и наоборот. Выбирается та, которая
имеет наименьшую длину. Варианты обхода окружностей изображены на рисунках 3.1 и
3.2.
.
Рисунок 3.1 – Обход окружностей в одном направлении
Рисунок 3.2 – Обход окружностей в противоположных направлениях
Алгоритмы поиска пути ищут путь на графе из стартового узла в узел–финиш. При
этом, в зависимости от алгоритма, путь может быть кратчайшим. Кроме того, некоторые
алгоритмы позволяют учитывать вес узлов [13].
Алгоритм А* считается одним из лучших алгоритмов поиска пути [16]. Он
объединяет в себя достоинства двух алгоритмов: учет длины пути из алгоритма Дейкстры
и учет эвристической функции из алгоритма «лучший первый».
Алгоритм А* использует формулу эвристики, которой в общем случае имеет вид:
f (n) = g (n) + h (n)
где
(3.1)
f ( n ) – значение оценки для узла n ;
n, g ( n ) – стоимость пути из узла–старта в узел n ;
n, h ( n ) – эвристическое приближение стоимости пути из узла n в узел–финиш.
Функция h ( n ) должна быть допустимой эвристической оценкой, то есть не должна
переоценивать расстояние до узла–финиша. Одним из способов задания такой функции
является длина прямой, соединяющий узел n и узел–финиш.
Алгоритм работает аналогично алгоритму Дейкстры [14], где вместо длины пути
учитывается функция f ( n ) , а когда узлу n1 устанавливается родитель n2 , пересчитывается
функция g ( n ) следующим образом:
g ( n1 ) = g ( n2 ) + d ( n1 , n2 )
где
(3.2)
d ( n1 , n2 ) – расстояние между узлами n1 и n2 .
Так как подразумевается использование различных опорных поверхностей с
разными коэффициентами проходимости и учет радиуса поворота, то функции g ( n ) и
h ( n ) были изменены.
Функция g ( n ) должна учитывать не только длину ребра, но и его вес. При этом
желательно внести штраф к поворотам. При указании узлу n1 родителя n2 происходит
пересчет функции g ( n ) следующим образом:
g ( n ) = g ( n2 ) + d ( n1 , n2 ) * w ( n1 , n2 ) + r ( n1 , n2 ) * w ( n1 , n2 )
где
(3.3)
d ( n1 , n2 ) – длина пути от узла n1 до узла n2 ;
w ( n1 , n2 ) – вес ребра, соединяющего узлы n1 и n2 ;
r ( n1 , n2 ) – суммарный угол поворота в радианах ребра, соединяющего узлы n1 и n2
Оценка h ( n ) рассчитывается как длина пути от узла n до узла финиша с учетом
направлений узла n и узла финиша, умноженная на средний вес. Средний вес в данном
случае рассчитывается как среднее значение веса в точках узла n и узла финиша.
На рисунке 3.3 показана возможная начальная конфигурация и возможная целевая
конфигурация девяти роботов на графе 3×3. Согласно этим конфигурациям, алгоритм A*
отстраивает пути передвижения группы роботов. Каждый робот, согласно конфигурациям,
движется независимо от других в свою целевую точку, считая остальных роботов
препятствиями, которые надо объезжать. Общение между роботами происходит через
управляющую машину, которая уведомляется обо всех обнаруженных несоответствиях
карты местности и карты реальности. Далее, управляющая машина уведомляет всех
роботов о необходимости изменении карты проходимости, вследствие чего все роботы
имеют одинаковую и актуальную карту проходимости, позволяющую более точно
планировать маршрут.
Рисунок 3.3 – Пример начальной и конечной конфигурации роботов на графе 3×3
3.2
Кинематика мобильной платформы
Концепция омни–колеса была предложена шведской компанией «Mecanum» [17].
Омни–колесо главным образом составлено из управляемой мотором ступицы колеса и
нескольких роликов, которые равномерно распределены под определенным углом вдоль
внешнего края колеса. Ролики могут вращаться в перпендикулярном направлении к
вращению ступицы. Каждый ролик оснащен двумя латуниевыми подшипниками
скольжения, что придает колесам хорошую износостойкость, гибкость. Геометрические
параметры омни–колеса показаны на рисунке 3.4.
Рисунок 3.4 – Геометрические параметры омни–колеса
Платформа оснащена тремя двигателями, каждый двигатель используется для
управления одним омни–колесом. Оси этих трех двигателей соединяются в центре шасси,
а углы между соседними двумя двигателями одинаковы. На рисунке 3.5 показано
расположение колес на платформе.
Рисунок 3.5 – Расположение колес на платформе
Для робота каждое колесо имеет два параметра положения: положение относительно
центра платформы и соответствующий угол ориентации. Координаты омни–колеса
показаны на рисунке 3.6. На этом рисунке 𝑥𝑜𝑦 – система координат, с началом в центре
платформы робота, 𝑥`𝑜`𝑦` – система координат, с началом в центре омни–колеса, i – порядок
расположения колеса на платформе, 𝛼𝑖 – угол отклонения каждого ролика, 𝛽𝑖 – угол между
____
векторами oo` и ox , (lix , liy ,i ) – положение колеса в системе координат 𝑥𝑜𝑦.
____
lix и liy и
могут быть выражены как:
lix = li cos i , liy = li sin i
(3.4)
Рисунок 3.6 – Параметры омни–колеса в СК робота
Параметры омни–колеса показаны на рисунке 3.7. На этом рисунке r – радиус омни–
колеса, Vir –вектор скорости центра ролика, а 𝜔𝑖 – угловая скорость колеса. Есть три вектора
T
скорости. [ x y ] , которые описывают центральную скорость платформы относительно
глобальной системы координат (ГСК), [ixiyi ]T представляет скорость колес относительно
координаты xoy , а [ `ix `iy `i ] обозначает скорость колеса относительно координаты x`o`y`
T
. Кинематические модели всенаправленной платформы описываются следующим образом
[18]:
`ix
i
0 sin 1
` = Ki1 , Ki1 =
r cos 1
ir
iy
ix
`ix
i
cos i
= Ki 2 ` = Ki 2 Ki1 , Ki 2 =
ir
sin i
iy
iy
(3.5)
− sin i
cos i
x
ix
1 0 −liy
= Ki 3 x , Ki 3 =
0 1 lix
iy
(3.6)
(3.7)
Рисунок 3.7 – Пояснение к формуле (3.6)
На основе уравнений (3.6) и (3.7) обратное уравнение кинематики РТК может быть
получено в виде:
x
r
Ki 2 Ki1 = Ki 3 x , i = 1, 2,3
ir
где
Ki 2 Ki1 0
Если предположить, что:
(3.8)
Ki = [ Ki1 ]−1[ Ki 2 ]−1 Ki 3 , i = 1,2,3, = i − i
(3.9)
тогда обратное уравнение кинематики для каждого колеса выводится следующим образом:
x
x
i
−1
−1
= [ Ki1 ] [ Ki 2 ] Ki 3 x = Ki x
ir
(3.10)
где
Ki =
1
−r sin i
cos( i ) sin( i ) lix sin( i ) − liy cos( i )
r cos( ) −r sin( ) l r cos( ) − l r sin( )
i
i
iy
i
ix
i
(3.11)
Введем матрицу Е:
cos( 1 )
sin 1
cos( 2 )
E=
sin 2
cos( 3 )
sin 3
sin( 1 )
sin 1
sin( 2 )
sin 2
sin( 3 )
sin 3
l1 sin( 1 − 1 )
sin 1
l1 sin( 2 − 2 )
sin 2
l1 sin( 3 − 3 )
sin 3
(3.12)
Тогда скорость вращения омни–колес выражается как:
1
x
= − 1 E
x
2
−r
3
(3.13)
Исходя из соотношения = r , уравнение (3.13) можно преобразовать в следующее
соотношение:
x
1
= 2 = − E y
3
(3.14)
На самом деле Декартовы задачи управления движением являются основными
проблемами в исследованиях мобильных роботов [19]. Положение робота в декартовой
системе координат
xc oc yc обозначается как ( xc , yc ,c ) и подробнее показаны на рисунке 3.8.
Рисунок 3.8 – Параметры РТК в неподвижной СК
Согласно рисунку 3.8, получаем следующее:
xc cos c
yc = sin c
0
c
x
− sin c 0
cos c 0 y
0
1
(3.15)
Введем матрицу поворота H, следующего вида:
cos c
H = sin c
0
− sin c
cos c
0
0
0
1
(3.16)
Обратное кинематическое уравнение для платформы в ГСК может быть
преобразовано в следующий вид:
xc
1
= − EH −1 y
c
2
3
c
(3.17)
Якобиева матрица обратного кинематического уравнения имеет вид:
R = − EH −1
(3.18)
Матрица Якоби обратного уравнения кинематики определяет всенаправленность
робота [20]. Если матрица Якоби находится в состоянии неудовлетворенного ранга ( R 3
), то в структуре возникают некоторые неголономные ограничения и степень свободы
движения уменьшается, а это значит, что система не может достичь всенаправленного
движения [21]. На рисунке 3.9 указаны параметры расположения колес на роботе,
подставив которые в матрицы обратной (3.17) и прямой (3.13) кинематики был получен
ранг матрицы три ( R = 3 ), что говорит о том, что все направленность платформы
достигается.
Рисунок 3.9 – Геометрические параметры расположения омни–колес на платформе
3.3
Динамика мобильной платформы
Как показано на рисунке 3.10,
xwoyw – базовая система координат (БСК), xmoym –
система координат, связанная с платформой (ЛСК), имеет ту же начальную точку, что и у
БСК, но вращается вместе с роботом. Ось
xm устанавливается перпендикулярно
горизонтальной силе тяги T1, а 𝜑 определяется как угол поворота РТК относительно БСК.
Рисунок 3.10 – Расположение векторов сил и на РТК
Определим F = [T1 T2 T3 ]
t
T
как горизонтальные силы тяги на каждом колесе, как
m
T
показано на рисунке 3.10. Также определим F = [ Fmx Fmy Tz ] как силу и момент РТК при
движении, а геометрическую матрицу платформы B определим следующим образом:
0
B = 1
L
где
3
2
1
−
2
L
−
3
2
1
2
L
(3.19)
L – радиус колёсной базы.
Соотношение сил в движущимся роботе может быть выражено следующим образом:
m
F = B tF
(3.20)
Используя принцип виртуальной работы [22], мы получаем следующее:
•
m
где
w
F
T t
X= F
m
•
T m
X= F
t
•
T t
•
X = t F T r qL
(3.21)
F = [ Fx Fy Tz ]T – это силы, возникающие при движении платформы в ЛСК;
r – радиус омни–колеса;
•
w
t
•
•
•
X = [ xw yw w ]T и
•
•
•
•
•
m
•
•
•
X = [ xm ym m ]T – скорости робота в БСК и ЛСК;
X = r qL – скорости вращения колес;
•
•
qL = [qL1 qL 2 qL3 ]T –угловые скорости омни–колес.
Из (3.20) и (3.21) кинематические уравнения скорости РТК выражаются в БСК и ГСК
следующим образом:
•
m
•
X = ( BT )−1 r qL
(3.22)
•
w
где
w
m
•
•
X = R X = mw R( BT )−1 r qL
w
m
m
(3.23)
R – это матрица перехода от базиса БСК к базису ЛСК, она же матрица поворота
на угол и по определению равна (3.24):
cos − sin 0
w
cos 0
m R = sin
0
0
1
(3.24)
•
Принимая производную по времени от
w
X в уравнении (3.23) получаем следующее
(матрица B постоянна):
••
w
•
w
m
T −1
•
•
w
m
••
X = R( B ) r qL + R( BT )−1 r qL
Уравнение (3.25) является основным уравнением для
(3.25)
анализа динамики
трехколесного всенаправленного робота.
Из уравнения (3.20) и второго закона Ньютона получаем следующее соотношение:
••
w
где
F = M w X = mw RB t F
M – матрица массы робота:
m 0 0
M = 0 m 0
0 0 J
где
(3.26)
m – масса мобильного робота;
J – момент инерции платформы.
(3.27)
Из уравнений (3.25), (3.26) с использованием ортонормированного базиса [23]
получаем:
( mw R)−1 = mw RT
(3.28)
тогда горизонтальная сила тяги робота примет вид:
t
•
••
•
F = ( B) −1 mw RT M mw R( BT ) −1 r qL + mw R( BT ) −1 r qL
(3.29)
Чтобы смоделировать динамику вращения каждого омни–колеса, отражая инерцию
нагрузки (колеса) на вал двигателя, применяются следующие выражения [24]:
••
где
•
•
•
•
L = J L qL + cL qL + t Fr
(3.30)
••
•
1
m = J m qm + cm qm + L
n
(3.31)
1•
qL = q m
n
(3.32)
•
qm = [qm1 qm2 qm3 ]T – угловые скорости колес;
τ – крутящий момент на валу;
c – коэффициент демпфирования вращения;
J – момент инерции;
n –передаточное отношение редуктора двигателя.
Тогда выражение динамики, основанное на параметрах привода и омни–колеса, примет
следующий вид:
1 0 0
0 1 1
1 0 0
0 1 −1
••
••
•
•
•
m = k1 0 1 0 qm + k2 1 0 1 qm + k3 0 1 0 qm + k4 −1 0 1 qm
0 0 1
1 1 0
0 0 1
1 −1 0
(3.33)
где:
k1 = J m +
k2 =
J L (4mL2 + J )r 2
+
n2
9 L2 n2
(3.34)
(−2mL2 + J )r 2
9 L2 n2
(3.35)
cL
n2
(3.36)
2 3mr 2
9n 2
(3.37)
k3 = cm +
k4 =
•
•
•
•
•
•
r (q1 + q2 + q3 ) r (qm1 + qm 2 + qm3 )
=
=
L
3nL
•
(3.38)
Уравнение (3.38) получается из кинематической зависимости (3.23). Решение
уравнения (3.33) для
динамическим
qm приводит к уравнению (3.39), связанным нелинейным
уравнениям
движения,
которые
будут
использоваться
далее
моделировании:
•
(k1 + k2 )k3
(k1 + 2k2 )k4 − k2 k3
••
•
1
qm +
−(k1 + 2k2 )k4 − k2 k3
(k1 + k2 )k3
(k1 − k2 )(k1 + 2k2 )
•
•
(k1 + 2k2 )k4 − k2 k3 −(k1 + 2k2 )k4 − k2 k3
−k2
−k2
k1 + k2
1
=
−k2
k1 + k2
−k2
(k1 − k2 )(k1 + 2k2 )
−k2
− k2
k1 + k2
•
−(k1 + 2k2 )k4 − k2 k3
•
•
(k1 + 2k2 )k4 − k2 k3 qm
(k1 + k2 )k3
Из (3.33), (3.38) и (3.39) известно:
−
m
и
qm находятся в отношении с параметрами каждого привода;
(3.39)
в
− отклик
qm зависит от других двух приводов через коэффициент k2 .
Уменьшение
k2 может уменьшить связь с другими приводами;
− установившееся значение
qm связано с другими двумя приводами через k4 ;
− в случае отсутствия декартового вращения робота сумма угловых скоростей
колес равна нулю и установившиеся значения угловых скоростей в этом
случае будут различны.
В следующих разделах рассмотрим особенности динамики всенаправленного робота
путем моделирования.
3.4
Выбор регулятора
В этом разделе будет рассмотрена конструкция регулятора обратной связи,
используемого для управления угловыми скоростями колес. ПИ – регулятор был выбран,
потому что он обеспечивает хорошую стабильность, имеет хорошее время нарастания и
уменьшает стационарную ошибку в системе. Было проверено несколько других типов
регуляторов, но оказалось, что лучше всего работает ПИ–регулятор. Первоначально
выигрыш регулятора определялся методом проб и ошибок, так что желаемый ответ был
достигнут. Поскольку это не является правильным инженерным подходом к решению
проблемы, был реализован метод проектирования регулятора – корневой годограф [25].
Метод корневого годографа – это графический метод, который дает расположение полюсов
замкнутого контура на основе параметров привода из спецификаций. Желаемые
характеристики
регулятора:
время
установления
–
0,5
секунды,
коэффициент
перерегулирования – 5%. Этот метод проектирования позволяет найти пропорциональный
и интегральный коэффициенты усиления ( K P и K I ). Изменение расположения полюсов
позволяет максимально повысить производительность системы с одним входом и одним
выходом. Хотя робот имеет три входа и три выхода, для каждого двигателя использовался
один линеаризованный независимый контроллер. Обобщенная передаточная функция (ПФ)
для ДПТ выглядит следующим образом [26]:
(3.40)
где
KT – номинальный момент,
LA – индуктивность обмотки якоря,
R – сопротивление обмотки якоря,
J – момент инерции ротора, а
KE – коэффициент ЭДС.
Введя соответствующие значения параметров двигателя в уравнение (3.40), ПФ
будет выглядеть следующим образом:
(3.41)
Затем эта ПФ была построена в MATLAB, и был построен корневой годограф. Был
добавлен дополнительный полюс и ноль, так что для контроллера была построена
передаточная функция первого порядка. Полюса и нуль были отрегулированы до тех пор,
пока не было достигнуто желаемое переходное поведение для робота. Схема корневого
годографа для этой системы представлена на рисунке 3.11.
Рисунок 3.11 – Корневой годограф ПИ регулятора
На графике корневого годографа была получена передаточная функция для
контроллера, из которой был получен уникальный набор пропорциональных и
интегральных констант. Значения констант, которые будут использоваться для каждого из
отдельных контроллеров, следующие:
K P = 2.78
K I = 56
Поскольку Sirnulink имеет только ПИД–регулятор, то значения
введены, как указано выше, а
K P и K I были
K D был установлен равным нулю.
График переходного процесса при установочном значении 5 рад/с показан на
рисунке 3.12, блок–схема представлена в Приложении Б.
Рисунок 3.12 – График переходного процесса контура управления скоростью
Время установления равно 0,008 с, перерегулирование составляет 4,3 %. Что
соответствует желаемым характеристикам.
3.5
Моделирование
Для того, чтобы провести моделирование РТК, необходимо разработать модель блок
схемы. Упрощенную версию динамической модели можно увидеть на рисунке 3.13, а
детальную модель, разработанную в среде MATLAB Simulink в Приложении Г. Из этой
модели видно, что желаемое положение и ориентация робота задаются в БСК. Затем берется
производная от этих значений таким образом, чтобы можно было управлять скоростью
платформы в ЛСК. После этого обратная кинематическая задача используется для
преобразования скорости робота в угловые скорости для трех колес. Эти угловые скорости
затем подаются на вход в независимый для каждого привода ПИ–регулятор. Динамика
системы, полученная в предыдущем разделе, представляет собой РТК для моделирования
и представлена в Приложении Д. Исходя из динамики системы, фактические угловые
скорости достигаются и затем проходят через контур обратной связи, а также прямую
кинематическую задачу, затем эти значения интегрируются для получения положения и
ориентации робота в БСК.
Рисунок 3.13 – Упрощенная версия динамической модели РТК
Как частный случай движения робота по складу был промоделирован маршрут,
который характеризует движение робота по складу с объездом стеллажа. Данный маршрут
генерируется с помощью алгоритма А*. Функция построения маршрута в среде Simulink
представлена в Приложении В.
В результате моделирования движения платформы без применения динамической
модели был получен результат движения робота по маршруту и представлен на рисунке
3.14.
Рисунок 3.14 – Результат визуализации движения робота по маршруту
Данный маршрут получился в результате работы блока обратной кинематической
задачи.
Затем была задействована динамическая модель РТК и смоделирована. Результаты
моделирования рассмотрим на примере визуализатора РТК, моделирующего движение
робота. График приведен на рисунке 3.15.
Рисунок 3.15 – Результаты работы динамической модели
Траектория соответствует апериодическому закону, что обеспечивает плавность
движения.
Скорости на каждом моторе, полученные в результате моделирования представлены
на рисунке 3.16.
Рисунок 3.16 – Угловые скорости на колесах робота, до и после прохождения блока
динамики РТК соответственно
Как видим, реальная траектория отклоняется от необходимой, но время
установления необходимой траектории не превышает критичного.
Продемонстрированная модель позволяет понять принцип работы группы роботов в
пределах складского помещения.
ЗАКЛЮЧЕНИЕ
В рамках настоящей работы была предложена конфигурация шасси мобильной
грузовой платформы, которая обеспечивает абсолютную мобильность передвижений. Она
оснащена роликонесущими колёсами (омни–колёса). Исходя из особой конструкции колёса
и конфигурации шасси были выведены кинематические и динамические уравнения
движения мобильной платформы. Приведены результаты математического моделирования
движения мобильной платформы с учётом её динамических свойств и свойств
электропривода, выраженная его динамической моделью.
Спроектирован колёсный узел, как основной компонент платформы, приводящей её
в движение. Выбраны основные комплектующие РТК и составлена 3D модель концепта
мобильной грузовой платформы с помощью САПР SolidWorks. Также в среде была
проверена устойчивость платформы к нагрузкам до 100 кг., которые окончились хорошим
результатом.
Был разработан контроллер БДПТ c датчиками Холла Maxon и написана программа
переключения обмоток. Печатная плата проектировалась с помощью программного
обеспечения
DipTrace.
Изготовление
осуществлялось
механическим
способом
с
использованием станка с числовым программным управлением.
В перспективе предполагается разработка базовых мультиагентных [27] и
централизованных алгоритмов управления коллективом мобильных роботов. Это
алгоритмы разбиения коллектива роботов на группы, алгоритмы распределения задач в
коллективе роботов и алгоритмы планирования траекторий движения роботов. Также
планируется разработать всю необходимую электронику мобильной платформы,
спроектировать систему управления верхнего уровня. В дальнейшем планируется
добавление системы QR навигации, которая позволит разгрузить процессор верхнего
уровня и позволит организовать систему автоматизированного учета, что позволит
отказаться от дополнительных информационных систем подобного функционала
.
СПИСОК ИСПОЛЬЗОВАННЫХ ИСТОЧНИКОВ
1) Тимофеев A.B. Методы высококачественного управления, интеллектуализации и
функциональной
диагностики
динамических
систем
/
Тимофеев
A.B.
//
Мехатроника, автоматизация, управление. 2003. №5. С. 13-17.
2) Иванов, А. Н. Выставка "Склад. Транспорт. Логистика - 2004" / А. Н. Иванов //
Вестник машиностроения, 2005. - № 3. - С. 92-94
3) Гигиенические требования к срокам годности и условиям хранения пищевых
продуктов. СанПиН 2.3.2.1324-03. - М.: ДЕАН, 2012. - 922 c.
4) Spyros G. Tzafestas, Introduction to Mobile Robot Control / Spyros G. Tzafestas // –
Elsevier, 2014, – 750 p.
5) Кинематическое управление движением шестиколесного меканум-робота / Е.
Ю.Колесниченко [и др.] // Препринты ИПМ им. М.В.Келдыша. 2016. № 127. 26 с.
6) Doroftei I. Grosu V. Spinu V. Omnidirectional Mobile Robot – Design andImplementation
// Bioinspiration and Robotics: Walking and Climbing Robots. – 2007, P.511-528
7) Pushpendra K., Lakhal O., Rochdi M. Bond Graph Modeling of a Holonomic Mobile
Platform with Four Mecanum Wheels // International Conference on Bond Graph
Modeling and Simulation – 2018, P.105-115
8) Z. Hendzel, Ł. Rykała. Modelling of Dynamics of a Wheeled Mobile Robot with Mecanum
Wheels with the use of Lagrange Equations of the Second Kind // Applied Mechanics and
Engineering. – 2017. – V.22. – No.1. – P. 81-99
9) Lih-Chang Lin, Hao-Yin Shih. Modeling and Adaptive Control of an Omni-MecanumWheeled Robot // Intelligent Control and Automation. – 2013. – V. 4. – P. 166-179
10) Boyang Hu, Yash Shrivastava, Swamidoss Sathiakumar. A Sensorless Drive System of
BLDC Motor. // Ref. Libr. 2012. Vol. 3. № 58. – P. 55–89
11) Курсовое проектирование деталей машин: Учебное пособие / С. А. Чернавский,К. Н.
Бобков, И. М. Чернин, Г. М. Ицкович, В. П. Козинцов. – 3-е изд.,стереотипное.
Перепечатка с издания 1987 г. – М.: ООО ТИД «Альянс», 2005. – 416 с.
12) Clarence W. de Silva. Sensors and Actuators: Engineering System Instrumentation. // Ref.
Libr. 2012. Vol.2. – P. 59–122
.
13) Кормен Томас Х. Алгоритмы. Построение и анализ 3-е изд. : Пер. с англ. – М. : ООО
«И.Д. Вильямс», 2013. – С. 623–807: ил. – Парал тит.англ
14) Caihua Xiong, Yongan Huang, Youlun Xiong. Intelligent Robotics and Applications: //
First International Conference, ICIRA – 2008. – P. 711–725
15) Charikar M., Jansen K., Reingold O. Approximation, Randomization, and Combinatorial
Optimization.// 10th international Workshop, APPROX – 2007. – No.1. – P. 44–68
16) Иванов О.А. Фридман Г.М. Дискретная математика. Учеб. для втузов. – 5-е изд.,
перераб. и доп. – М.: Питер., 2019. – 352 с
17) Колесо Илона
//
Wikipedia [Электронный ресурс].
–
Режим доступа:
https://r ru.wikipedia.org/wiki/Колесо_Илона
18) A. Gfrerrer. Geometry and Kinematics of the Mecanum Wheel // Computer Aided
Geometric Design. – 2008. – Vol. 25. – P. 784-791
19) Зенкевич, С.Л. Управление роботами. / С.Л. Зенкевич, А.С Ющенко. - М.:
Издательство МГТУ им. Н.Э. Баумана, 2000, - 400 c.
20) Lambert M. Surhone. Jacobian Matrix and Determinant: Vector Calculus, Partial
Derivative, Vector Space. / Lambert M. Surhone, Miriam T. Timpledon, Susan F.
Marseken // – 2010. – Vol.2 P.4 – 104
21) А.Г. Булгаков, В.А. Воробьев. Промышленные роботы. Кинематика, динамика,
контроль и управление – М.: СОЛОН–ПРЕСС, 2011. – с. 150-175.
22) Мирошник И.В. Нелинейное и адаптивное управление сложными динамическими
системами / И.В.Мирошник В.О. Никифоров А.Л. Фрадков – СПБ.: Наука 2000. –
202 с.
23) Christopher Heil. A Basis Theory Primer: Expanded Edition – BIRKHAUSER BOSTON
INC 2011. – V.24. – 537 р.
24) Фролова, Е.И. Воробьева. Кн. 1: Кинематика и динамика / Е.И. Воробьев, С.А.
Попов, Г.И. Шевелева. – М.: Высш. шк., 1998.–304 с.
25) Э.Г. Удерман. Метод корневого годографа в теории автоматического управления: –
Вып. 88 – М.: ГЭИ., 1963. – 111 с.
26) Narciso F. Macia, George Julius Thaler. Modeling and Control of Dynamic Systems. //
Ref. Libr. 2007. – Vol.22. – №.1. – P. 123–169.
27) Городецкий В.И., Карсаев О.В. Прикладные многоагентные системы группового
управления // Искусственный интеллект и принятие решений. – 2009. – №2 . – 24 с.
ПРИЛОЖЕНИЕ А
Перечень приятых сокращений
АКБ – аккумуляторная батарея.
БДПТ – бесколлекторный двигатель постоянного тока.
БСК – базовая система координат.
ГСК – глобальная система координат.
ИИ – искусственный интеллект.
КУ – коэффициент усиления.
ЛСК – локальная система координат.
ПФ – передаточная функция.
РТС – робототехническая система.
РТК – робототехнический комплекс.
СК – система координат.
УЗ – ультразвук.
ШИМ – широтно–импульсная модуляция.
ЭП – электропривод.
.
ПРИЛОЖЕНИЕ Б
Блок–схема ПИ–регулятора стабилизации скорости
.
ПРИЛОЖЕНИЕ В
Блок–схема планирования пути движения по складу
.
ПРИЛОЖЕНИЕ Г
Блок–схема стабилизации положения мобильной платформы
.
ПРИЛОЖЕНИЕ Д
Блок–схема динамической модели РТК
.
ПРИЛОЖЕНИЕ Е
Сборочный чертеж колесного узла
.
13
2
3
12 6
15
14
M6
4 >B2
.
7
Ç10
7
9
10
11
15.03.06.08.2020.01.00 !
:
:>=B@>
4
5
24
8
80
8
132
40
16
57
196
!?@02
. !
Ç90
14 +0,02
5@2
. ?@8<5=
.
P9
4h9
H7
K7
-
P9
3h9
Ç5h6
1
-
(2:1)
10
20
40
=2
. !?>4;
.
>4?
. 8
40B0. 8=2
. !
70<
=2
. !4C1;
.
>4?
. 8
40B0
Ç12m6
H7
Ç12m6
15.03.06.08.2020.01.00 !
Êîëåñíûé
óçåë
7<
. 8AB
!4>:C<
. >4?
. 0B0
.
.
07@01
. "0<:>2
K10:>2
.
.
@>2
.
.
.
"
.:>=B@
. K10:>2
.
.
.:>=B@
. >7;>20
#B2
.
;NG0@52
.. .
8B
. 0AA0
1,59
8AB
>?8@>20;
1:1
8
1
#
, -41
"
$>@<0B
A2
ПРИЛОЖЕНИЕ Ж
Спецификация на сборочный чертеж колесного узла
.
>
.
$>@
>
>
.
5@2
. ?@8<5
.
!?@02
. !
=2
. !?>4;
.
>4?
. 8
40B0. 8=2
. !
70<
=2
. !4C1;
.
>4?
. 8
40B0
@8
-
1>7=0G5=85
G0=
>:C<5=B0
15.03.06.08.2020.01.02.00.00!
!1>@>G=K9
G5@B56
!1>@>G=K5
548=8FK
>;8:
1
10
15.03.06.08.2020.01.02.01.00!
2
3
4
5
6
7
15.03.06.08.2020.02.00.01
15.03.06.08.2020.02.00.02
15.03.06.08.2020.02.00.03
15.03.06.08.2020.02.00.04
15.03.06.08.2020.02.00.05
15.03.06.08.2020.02.00.05
8
9
10
11
12
13
5B0;8
;0AB8=0
:@5?;5=8O
20;>2
1 2
;0AB8=0
:@5?;5=8O
20;>2
2 2
BC;:0 1
1
CDB0
1
@5?;5=85
?@82>40
0;
>?>@=K9
1
!B0=40@B=K
8745;8
8=B
ISO 7380
5 E
10 10
8=B
DIN 6912
5 E
40 4
4
09:0
ISO 4032
5
(0910
ISO 7380
5
4
(?>=:0
3E
3E
20 !"
29175-91 1
(?>=:0
4E
4E
10 !"
29175-91 1
>:C?=K5
8745;8O
2830B5;L
"
A40BG8:0<8
%>;;0
1
Maxom EC-Max 283866 70W
54C:B>@
?;0=5B0@
1
Maxon 203115 GP42C-2st
14
15
15.03.06.08.2020.01.00 !
8B
. 8AB
1
Êîëåñíûé
#
, -41
"
óçåë
7<
. 8AB
!4>:C<
. >4?
. 0B0
07@01
. "0<:>2
.
.
@>2
.
K10:>2
.
.
.:>=B@
. >7;>20
.
.
#B2
.
;NG0@52
.. .
>?8@>20;
$>@<0B
A4
ПРИЛОЖЕНИЕ И
Технологическая схема сборки колёсного узла
.
4
10
0
9
:
0
5
11
9
8
=
B
5
(
0
9
1
0
5
4
4
1
5
8
C
D
B
0
8
=
B
5
5
1
2
;
0
A
B
8
=
0
:
@
5
?
;
5
=
8
O
1
!
1
.1
>
;
8
:
5
1
3
1
;
0
A
B
8
=
0
:
@
5
?
;
5
=
8
O
2
8
4
8
=
B
5
B
C
;
:
0
5
1
3
;
0
A
B
8
=
0
:
@
5
?
;
5
=
8
O
2
5
!
1
.1
>
;
8
:
;
0
A
B
8
=
0
:
@
5
?
;
5
=
8
O
1
1
!
1
.4
&
5
=
B
@
>
2
0
B
L
!
2
8
=
B
8
B
L
&
5
=
B
@
>
2
0
B
L
(
?
>
=
:
0
3E
3E
20
12
1
0
?
@
5
A
>
2
0
B
L
1
5
4
C
:
B
>
@
?
;
0
=
5
B
0
@
=
K
9
1
!
2
8
=
B
8
B
L
"
Maxon EC-Max
14
1
1
7
9
K
=
@
>
?
>
;
0
15
=
2
. !?
>
4
;
.
>
4
?
. 8
4
0
B
0
7
0
<
. 8
=
2
. !
=
2
. !4
C
1
;
.
>
4
?
. 8
4
0
B
0
0
?
@
5
A
>
2
0
B
L
0
?
@
5
A
>
2
0
B
L
10
4E
4E
0
:
=
>
?
(
13
1
1
1
0
?
@
5
A
>
2
0
B
L
!
1
.3
!
2
8
=
B
8
B
L
&
5
=
B
@
>
2
0
B
L
!
1
.2
&
5
=
B
@
>
2
0
B
L
0
;
2
A
1
>
@
5
!
2
8
=
B
8
B
L
@
8
2
>
4
2
A
1
>
@
5
2
>
;
5
A
=
K
9
C
7
5
;
2
A
1
>
@
5
15.03.06.08.2020.01
7
<
.
8
A
B !4
>
:
C
<
.
>
4
?
.
0
B
0
0
7
@
0
1
. "
0
<
:
>
2
.
.
@
>
2
.
K
1
0
:
>
2
.
.
"
.:
>
=
B
@
. K
1
0
:
>
2
.
.
.:
>
=
B
@
. K
1
0
:
>
2
.
.
#
B
2
.
;
N
G
0
@
5
2
..
"
5
E
=
>
;
>
3
8
G
5
A
:
0
O
A
E
5
<
0
A
1
>
@
:
8
:
>
;
5
A
=
>
3
>
C
7
;
0
8
B
.
0
A
A
0
0
A
H
B
0
1
8
A
B
8
A
B
>
2 1
#
, "
-41
ПРИЛОЖЕНИЕ К
Чертеж пластины крепления валов ролика
.
5
@
2
. ?
@
8
<
5
=
.
15.03.06.08.2020.01.00.02
Rz 160
30
-
50Å
Ç5
10 >
B
2
.
Ç5
4
4,5
11 >
B
2
.
Ç90
Ç72
=
2
. !?
>
4
;
.
>
4
?
. 8
4
0
B
0
7
0
<
. 8
=
2
. !
=
2
. !4
C
1
;
.
>
4
?
. 8
4
0
B
0
8
Ç31
Ç12
Ç42
23
40
!
?
@
0
2
. !
R3
5
0,1
0,1
0,1
0,1
1
15.03.06.08.2020.01.00.02
8
B
.
0
A
A
0
0
A
H
B
0
1
7
<
.
8
A
B !4
>
:
C
<
.
>
4
?
.
0
B
0
;
0
A
B
8
=
0
:
@
5
?
;
5
=
8
O 0,2 2:1
0
7
@
0
1
. "
0
<
:
>
2
.
.
@
>
2
.
K
1
0
:
>
2
.
.
2
0
;
>
2
@
>
;
8
:
0
1 8AB 8AB>2 1
"
.:
>
=
B
@
. K
1
0
:
>
2
.
.
.:
>
=
B
@
.
>
7
;
>
2
0
.
.
!
B
0
;
L
45
!
"
1050-88
#
, "
-41
#
B
2
.
;
N
G
0
@
5
2
.. .
>
?
8
@
>
2
0
;
$
@
>
<
0
B A3
ПРИЛОЖЕНИЕ Л
Чертеж несущей плиты РТК
.
466
32
R1*
Ç
3
14 >
B
2
.
24
21 >
B
2
.
17
22
Ç2
45
-
-
2 45"Å
48 D
0
A
>
:
9
3 >
B
2
.
6 >
B
2
.
-
Ç22
!
?
@
0
2
. !
Ç2
Ç3
24 >
B
2
.
4 >
B
2
.
60
5
116
37
12
3
29
63
20
32
12
21
8
R25
1 * 0
7
<
5
@
4
;
O
A
?
@
0
2
>
:
15.03.06.08.2020.05.00.12
60
5
8
B
.
0
A
A
0
0
A
H
B
0
1
7
<
.
8
A
B !4
>
:
C
<
.
>
4
?
.
0
B
0
0
7
@
0
1
. "
0
<
:
>
2
.
.
@
>
2
.
K
1
0
:
>
2
.
.
"
.:
>
=
B
@
. K
1
0
:
>
2
.
.
;
8
B
0
=
5
A
C
I
0
O
25
15
43
42
3
>B. 2
14
41
=
2
. !?
>
4
;
.
>
4
?
. 8
4
0
B
0
7
0
<
. 8
=
2
. !
=
2
. !4
C
1
;
.
>
4
?
. 8
4
0
B
0
R1*
2
7 >
B
2
.
42
5 6"
1
29
37
36
5
@
2
. ?
@
8
<
5
=
.
15.03.06.08.2020.05.00.12
Rz 200 ( )
522
.:
>
=
B
@
.
>
7
;
>
2
0
.
.
#
B
2
.
;
N
G
0
@
5
2
.. .
4,86
8
A
B
1:2
8
A
B
>
2 1
!
B
0
;
L
45
!
"
1050-88
#
, "
-41
>
?
8
@
>
2
0
;
$
@
>
<
0
B A3
ПРИЛОЖЕНИЕ М
Сборочный чертеж мобильного складского робота
.
15.03.06.08.2020.05.00.00 !
165,,,175
150,,,160
18,,,118
106
24
86
8
42
64
4
5
14
110
6
18
=
2
. !?
>
4
;
.
>
4
?
. 8
4
0
B
0
7
0
<
. 8
=
2
. !
=
2
. !4
C
1
;
.
>
4
?
. 8
4
0
B
0
!
?
@
0
2
. !
5
@
2
. ?
@
8
<
5
=
.
466
2
1
3
521
15.03.06.08.2020.05.00.00 !
8
B
.
0
A
A
0
0
A
H
B
0
1
7
<
.
8
A
B !4
>
:
C
<
.
>
4
?
.
0
B
0
>
1
8
;
L
=
K
9
0
7
@
0
1
. "
0
<
:
>
2
.
.
28
1:1
@
>
2
.
K
1
0
:
>
2
.
.
A
:
;
0
4
A
:
>
9
@
>
1
>
B 8AB 8AB>2 1
"
.:
>
=
B
@
. K
1
0
:
>
2
.
.
.:
>
=
B
@
.
>
7
;
>
2
0
.
.
#
, "
-41
#
B
2
.
;
N
G
0
@
5
2
.. .
>
?
8
@
>
2
0
;
$
@
>
<
0
B A1
ПРИЛОЖЕНИЕ Н
Спецификация на сборочный чертеж мобильного складского робота
.
0
8
<
5
=
>
2
0
=
8
5
>
;
.
$
@
>
<
0
B
>
=
0
>
7
.
5
@
2
. ?
@
8
<
5
=
.
1
>
7
=
0
G
5
=
8
5
@
8
<
5
G
0
=
8
5
>
:
C
<
5
=
B
0
F
8
O
15.03.06.08.2020.01.00.00.00!
!
1
>
@
>
G
=
K
9
G
5
@
B
5
6
1
=
2
. !?
>
4
;
.
>
4
?
. 8
4
0
B
0
7
0
<
. 8
=
2
. !
=
2
. !4
C
1
;
.
>
4
?
. 8
4
0
B
0
!
?
@
0
2
. !
!
1
>
@
>
G
=
K
5
5
4
8
=
8
F
K
' 1
15.03.06.08.2020.01.01.00.00!
>
1
8
;
L
=
K
9
A
:
;
0
4
A
:
>
9
@
>
1
>
B1
2 2
15.03.06.08.2020.01.02.00.00!
>
;
5
A
=
K
9
C
7
5
;
3
5
B
0
;
8
' 3
15.03.06.08.2020.01.00.01
;
8
B
0
=
5
A
C
I
0
O
1
3 4
15.03.06.08.2020.01.00.02
@
C
7
>
2
0
O
?
;
8
B
0
2
5
6
7
<
.
8
A
B !4
>
:
C
<
.
>
4
?
.
0
B
0
0
7
@
0
1
. "
0
<
:
>
2
.
.
@
>
2
.
K
1
0
:
>
2
.
.
.:
>
=
B
@
.
>
7
;
>
2
0
.
.
#
B
2
.
;
N
G
0
@
5
2
.. .
1
1
!
B
0
=
4
0
@
B
=
K
5
8
7
4
5
;
8
O
8
=
B
ISO 10642 -
3 E
20 12
8
=
B
ISO 10642 -
5 E
16 12
15.03.06.08.2020.05.00.00 !
8
B
.
8
A
B
8
A
B
>
2
1
>
1
8
;
L
=
K
9
A
:
;
0
4
A
:
>
9
@
>
1
>
B
#
, "
-41
>
?
8
@
>
2
0
;
$
@
>
<
0
B A4
ПРИЛОЖЕНИЕ П
Схема электрическая принципиальная контроллера БДПТ
.
>
;
.
$
@
>
<
0
B
>
=
0
>
7
.
15.03.06.08.2020.01
1
>
7
=
0
G
5
=
8
5
0
8
<
5
=
>
2
0
=
8
5
@
8
<
5
G
0
=
8
5
>
:
C
<
5
=
B
0
F
8
O
.15.03.06.08.2020.
-!
.1 !E5<0M;5:B@8G5A:0O?@8=F8?80;L=0O
5
B
0
;
8
15.03.03.08.2020.02.02.01.001
;
0
B
0
?
5
G
0
B
=
0
O
1
=
2
. !?
>
4
;
.
>
4
?
. 8
4
0
B
0
7
0
<
. 8
=
2
. !
=
2
. !4
C
1
;
.
>
4
?
. 8
4
0
B
0
!
?
@
0
2
. !
5
@
2
. ?
@
8
<
5
=
.
@
>
G
8
5
8
7
4
5
;
8
O
R4-R7
R1-R3
R8-R10
R11-R16
5
7
8
A
B
>
@
K
Yageo-0.125-CR1206-4,7:
<±1%
Yageo-0.125-CR1206-100
<±1%
Yageo-0.125-CR1206-220
<±1%
Yageo-0.125-CR1206-10
<
±1%
4
3
3
6
!
4-!
5
C1-C3
C6
!
7,!
8
!
9
!
10-!
12
!
13-!
15
>
=
4
5
=
A
0
B
>
@
K
NPO-50B-CR1206-22 <
:
$±5%
NPO-50B-CR1206-470 <
:
$±5%
50-35 1000 <
:
$E
50
±20%
NPO-50B-CR1206-100 <
:
$±5%
50-35 10 <
:
$E
50
±20%
NPO-50B-CR2611-10 <
:
$±5%
NPO-50B-CR1510-2,2 <
:
$±5%
2
3
1
2
1
3
3
HL1-HL3
VD1-VD9
8
>
4
K
8
A
2
5
B
>
4
8
>
4
K
C2
5
B
>
4
8
>
4
GNL-3012ED 7
5
;
5
=
K
93
8
>
4
(
>
B
B
:
8
1N4148 1A-20 9
T1-T6
"
@
0
=
7
8
A
B
>
@
K
IRF640S
6
DD2
DA1-DA3
DD1
DA5
=
B
5
3
@
0
;
L
=
K
5
A
E
5
<
K
Atmega328P-PU
IR2101S
LT1117-5V
LM393
1
3
1
1
ZQ1
XP1
XP2-XP4
XP5, XP6
@
>
G
5
5
2
0
@
F
5
2
K
9
@
5
7
>
=
0
B
>
@
8
F1
;
5
<
<
=
K
9@
0
7
J
5
<MKDSO 2,5/ 2-L RD 1
;
5
<
<
=
K
9@
0
7
J
5
<MKDSO 2,5/ 3-L RD 3
PLS @
0
7
J
Q
<
2
8
;
:
0
1
15.03.06.08.2020.01
8
B
.
0
A
A
0
0
A
H
B
0
1
E
5
<
0
M
;
5
:
B
@
8
G
5
A
:
0
O
7
<
.
8
A
B !4
>
:
C
<
.
>
4
?
.
0
B
0 !
0
7
@
0
1
. "
0
<
:
>
2
.
.
?
@
8
=
F
8
?
8
0
;
L
=
0
O
:
>
=
B
@
>
;
;
5
@
0
/
@
>
2
.
K
1
0
:
>
2
.
..
"
Maxon
"
.:
>
=
B
@
. K
1
0
:
>
2
.
.
8
A
B
8
A
B
>
2 1
#
,"
-41
.:
>
=
B
@
. K
1
0
:
>
2
.
.
#
B
2
.
;
N
G
0
@
5
2
.. .
>
?
8
@
>
2
0
;
$
@
>
<
0
B A1
ПРИЛОЖЕНИЕ Р
Плата печатная контроллера БДПТ
.
15.03.06.08.2020.01
'
38
36
34
32
30
28
26
24
22
20
18
16
14
12
10
8
6
4
2
R5
R6
38
36
34
32
30
28
26
24
22
20
18
16
14
12
10
8
6
4
2
R4
R2
R1
C1
C4
C12
C8
C5
C10 R17
D3
R16
R18
R19
R20
D6
R3 R10
C2 C3
D7 R11
DA1
C15
R7
C14
R9
DD1
R13
T3
DA3
D9 D10 R14
C17
D5
C7
T4
DA2
D4
T1
D8
R12
C16
C13
T2
T6
T5
D11
R15
2 4 6 8 10 12 14 16 18 20 22 24 26 28 30 32 34 36 38 40 42 44 46 48 50 52 54 56 58
2 4 6 8 10 12 14 16 18 20 22 24 26 28 30 32 34 36 38 40 42 44 46 48 50 52 54 56 58
(2:1)
1,5
2
XP6
HL4
C6
(1:1)
HL2
1
XP3
1,8
6,15
2 4 6 8 10 12 14 16 18 20 22 24 26 28 30 32 34 36 38 40 42 44 46 48 50 52 54 56 58
(1:1)
5
DD2
1,75
(1:1)
XP4
3,6
ZQ1
XP5
(2:1)
1,6
HL3
XP2
0,8
1,5
51
1
2
11
3
-
4
2,8
HL1
C9
8
0
<
5
B
@
:
>
=
B
0
:
B
=
>
9
>
;
8
G
5
A
B
2
>
8
0
<
5
B
@
, <
<
?
;
>
I
0
4
:
8
, <
<
>
B
2
5
@
A
B
8
9
0,5
1,5
14
7,4
5,55
XP1
4,56
38
36
34
32
30
28
26
24
22
20
18
16
14
12
10
8
6
4
2
2,35
=
2
. !?
>
4
;
.
>
4
?
. 8
4
0
B
0
7
0
<
. 8
=
2
. !
=
2
. !4
C
1
;
.
>
4
?
. 8
4
0
B
0
!
?
@
0
2
. !
0,6
1,27
3,81
5
@
2
. ?
@
8
<
5
=
.
1
>
7
=
0
G
5
=
8
5
3,1
2,9
1
;
0
B
C8
7
3
>
B
>
2
8
B
L
=
0
D
@
5
7
5
@
=
>
<
A
B
0
=
:
5
.
2
;
0
B
0
4
>
;
6
=
0
A
>
>
B
2
5
B
A
2
>
2
0
B
L
!
"
10316-78.
3 (
0
3
:
>
>
@
4
8
=
0
B
=
>
9
A
5
B
:
8
1,27 <
<
.
4
8
=
8
<
0
;
L
=
0
O
H
8
@
8
=
0
@
?
>
2
>
4
=
8
:
0
0,5 <
<
.
5
8
=
8
<
0
;
L
=
>
5
@
0
A
A
B
>
O
=
8
5
<
5
6
4
C
?
@
>
2
>
4
=
8
:
0
<
8
0,3 <
<
.
6
>
;
8
G
5
A
B
2
>
?
5
@
5
<
K
G
5
:
7.
7 J1,J2 - PLC @
0
7
L
5
<
2
8
;
:
0
.
8
5
@
5
<
K
G
8
:
2
K
?
>
;
=
8
B
L
?
>
!
"
61192-4-2010; 4
8
0
<
5
B
@
?
@
>
2
>
4
0
0,5 <
<
.
15.03.06.08.2020.01
'
8
B
.
0
A
A
0
0
A
H
B
0
1
7
<
.
8
A
B !4
>
:
C
<
.
>
4
?
.
0
B
0
;
0
B
0
?
5
G
0
B
=
0
O
0
7
@
0
1
. "
0
<
:
>
2
.
.
4:1
@
>
2
.
K
1
0
:
>
2
.
.
:
>
=
B
@
>
;
;
5
@
0
"
Maxon 8AB 8AB>2 1
"
.:
>
=
B
@
. K
1
0
:
>
2
.
.
!
B
5
:
;
>
B
5
:
A
B
>
;
8
B
.:
>
=
B
@
. K
1
0
:
>
2
.
.
#
, "
-41
!
"
!
-1,5
!
"
12652-74
#
B
2
.
;
N
G
0
@
5
2
.. .
>
?
8
@
>
2
0
;
$
@
>
<
0
B A1
ПРИЛОЖЕНИЕ С
Листинг программы контроллера БДПТ
#include <avr/io.h>
#include <avr/interrupt.h>
// Фаза U(Верхнее плечо)
#define UH_ON
TCCR0A |=
(1 << COM0A1);
#define UH_OFF
TCCR0A &= ~(1 << COM0A1);
// Фаза U(Нижнее плечо)
#define UL_ON
PORTD |=
(1 << PD7);
#define UL_OFF
PORTD &= ~(1 << PD7);
// Фаза V(Верхнее плечо)
#define VH_ON
TCCR0A |=
(1 << COM0B1);
#define VH_OFF
TCCR0A &= ~(1 << COM0B1);
// Фаза V(Нижнее плечо)
#define VL_ON
PORTD |=
(1 << PD4);
#define VL_OFF
PORTD &= ~(1 << PD4);
// Фаза W(Верхнее плечо)
#define WH_ON
TCCR2A |=
(1 << COM2B1);
#define WH_OFF
TCCR2A &= ~(1 << COM2B1);
// Фаза W(Нижнее плечо)
#define WL_ON
PORTD |=
(1 << PD2);
#define WL_OFF
PORTD &= ~(1 << PD2);
unsigned char speed;
// Обработчик внешнего прерывания
ISR(PCINT0_vect)
{
unsigned char position;
.
// Считываем значения датчиков
position = (PINB & ((1 << PB2) | (1 << PB1) | (1 << PB0)));
switch (position) // Переключаем обмотки
{
case 5: UH_ON; UL_OFF; VH_OFF; VL_ON; WH_OFF; WL_OFF; break;
case 1: UH_ON; UL_OFF; VH_OFF; VL_OFF; WH_OFF; WL_ON; break;
case 3: UH_OFF; UL_OFF; VH_ON; VL_OFF; WH_OFF; WL_ON; break;
case 2: UH_OFF; UL_ON; VH_ON; VL_OFF; WH_OFF; WL_OFF; break;
case 6: UH_OFF; UL_ON; VH_OFF; VL_OFF; WH_ON; WL_OFF; break;
case 4: UH_OFF; UL_OFF; VH_OFF; VL_ON; WH_ON; WL_OFF; break;
}
PORTC = position;
}
// Функция изменения скорости
static void set_speed(unsigned char speed)
{
TIFR0 = TIFR0;
// Очищаем флаг прерывания TC0
while ( !(TIFR0 & (1 << TOV0))); // Ждем переполнения таймера
cli();
OCR0A = speed; // Изменяем ШИМ
OCR0B = speed;
OCR2B = speed;
sei();
}
int main( void )
{
TCCR0A |= (1 << COM0A1) | (0 << COM0A0) | // Сброс вывода OC0A при совпадении
(1 << COM0B1) | (0 << COM0B0) | // Сброс вывода OC0B при совпадении
(1 << WGM01) | (1 << WGM00); // Режим Fast PWM
TCCR0B |= (1 << CS00); // Предделитель CLK/1
TCCR2A |= (1 << COM2B1) | (0 << COM2B0) | // Сброс вывода OC2B при совпадении
(1 << WGM01) | (1 << WGM00); // Режим Fast PWM
TCCR2B |= (1 << CS20); // // Предделитель CLK/1
PCMSK0 |= (1 << PCINT2) | (1 << PCINT1) | (1 << PCINT0); // Активируем входы
внешних прерываний
PCICR |= (1 << PCIE0);
// Разрешаем прерывание по изменению состояния
порта B
ADMUX |= (1 << MUX1) | (1 << MUX0); // Вход ADC3
ADCSRA |= (1 << ADEN) | (1 << ADPS1); // Разрешаем АЦП, предделитель на 4
DDRC |= (1 << PC2) | (1 << PC1) | (1 << PC0); // Порт С - выход(светодиоды)
PORTC &= ~(1 << PC2) | (1 << PC1) | (1 << PC0);
DDRB |= (1 << PB2) | (1 << PB1) | (1 << PB0); // Кратковреммено подаем лог.1
на входы датчиков
PORTB |= (1 << PB2) | (1 << PB1) | (1 << PB0); // для первоначального запуска
двигателя
PORTB &= ~(1 << PB2) | (1 << PB1) | (1 << PB0);
DDRB = 0x00; // Порт B - вход
sei(); // Глобально разрешаем прерывания
DDRD = 0xFF; // Порт D - выход
while (1)
{
ADCSRA |= (1 << ADSC); // Запускаем преобразование АЦП
while ( ADCSRA & (1 << ADSC) ); // Ждем окончания преобразования
speed = ADC / 4; // Считываем АЦП
set_speed(speed); // Изменяем скорость
}
}
ПРИЛОЖЕНИЕ Т
Материалы на электронном носителе
.
Отчет о проверке на заимствования №1
Автор: Тамков Павел ptamkov@ya.ru / ID: 4855260
Проверяющий: Тамков Павел (ptamkov@ya.ru / ID: 4855260)
Отчет предоставлен сервисом «Антиплагиат» - https://users.antiplagiat.ru
ИНФОРМАЦИЯ О ДОКУМЕНТЕ
ИНФОРМАЦИЯ ОБ ОТЧЕТЕ
№ документа: 2
Начало загрузки: 09.06.2020 00:18:40
Длительность загрузки: 00:00:31
Имя исходного файла: ПЗ Тамков с
приложениями .pdf
Название документа: ВКР ТАМКОВ П.И.
"РАЗРАБОТКА СИСТЕМЫ УПРАВЛЕНИЯ
ГРУЗОВЫХ МОБИЛЬНЫХ РОБОТОВ"
Размер текста: 1 кБ
Cимволов в тексте: 107227
Слов в тексте: 13335
Число предложений: 1386
Последний готовый отчет (ред.)
Начало проверки: 09.06.2020 00:19:12
Длительность проверки: 00:00:05
Комментарии: не указано
Модули поиска: Цитирование, Модуль поиска Интернет
ЗАИМСТВОВАНИЯ
САМОЦИТИРОВАНИЯ
ЦИТИРОВАНИЯ
ОРИГИНАЛЬНОСТЬ
12,64%
0%
0%
87,36%
Заимствования — доля всех найденных текстовых пересечений, за исключением тех, которые система отнесла к цитированиям, по отношению к общему объему документа.
Самоцитирования — доля фрагментов текста проверяемого документа, совпадающий или почти совпадающий с фрагментом текста источника, автором или соавтором которого является
автор проверяемого документа, по отношению к общему объему документа.
Цитирования — доля текстовых пересечений, которые не являются авторскими, но система посчитала их использование корректным, по отношению к общему объему документа. Сюда
относятся оформленные по ГОСТу цитаты; общеупотребительные выражения; фрагменты текста, найденные в источниках из коллекций нормативно-правовой документации.
Текстовое пересечение — фрагмент текста проверяемого документа, совпадающий или почти совпадающий с фрагментом текста источника.
Источник — документ, проиндексированный в системе и содержащийся в модуле поиска, по которому проводится проверка.
Оригинальность — доля фрагментов текста проверяемого документа, не обнаруженных ни в одном источнике, по которым шла проверка, по отношению к общему объему документа.
Заимствования, самоцитирования, цитирования и оригинальность являются отдельными показателями и в сумме дают 100%, что соответствует всему тексту проверяемого документа.
Обращаем Ваше внимание, что система находит текстовые пересечения проверяемого документа с проиндексированными в системе текстовыми источниками. При этом система является
вспомогательным инструментом, определение корректности и правомерности заимствований или цитирований, а также авторства текстовых фрагментов проверяемого документа
остается в компетенции проверяющего.
№
Доля
в отчете
Доля
в тексте
Источник
Ссылка
Актуален на
Модуль поиска
Блоков
в отчете
Блоков
в тексте
[01]
3,44%
4,25%
Реализация алгоритмов группового у… http://ceur-ws.org
14 Июл 2017
Модуль поиска
Интернет
32
39
[02]
0,88%
4,18%
Реализация алгоритмов группового у… https://cyberleninka.ru
04 Мая 2020
Модуль поиска
Интернет
5
34
[03]
3,39%
3,39%
SolidWorks — стандарт трехмерного п… https://sapr.ru
08 Окт 2019
Модуль поиска
Интернет
6
6
[04]
0%
3,39%
SolidWorks — стандарт трехмерного п… https://sapr.ru
30 Мар 2020
Модуль поиска
Интернет
0
6
[05]
0%
3,34%
4. SolidWorks - стандарт трехмерного п… http://lib.qrz.ru
06 Апр 2020
Модуль поиска
Интернет
0
13
[06]
1,17%
2,13%
2017_ФЗО_ИСТ_ИСТ_БР_Билярская_Св… https://psuti.ru
10 Авг 2018
Модуль поиска
Интернет
2
6
[07]
0,7%
2,12%
не указано
08 Ноя 2018
Модуль поиска
Интернет
2
7
[08]
0%
1,23%
Конструктор Lego | Virtual Laboratory W http://ru.vlab.wikia.com
15 Авг 2017
Модуль поиска
Интернет
0
10
[09]
0%
1,01%
Разработка информационно-поисково… https://knowledge.allbest.ru
16 Апр 2020
Модуль поиска
Интернет
0
7
[10]
0,42%
0,86%
не указано
08 Ноя 2018
Модуль поиска
Интернет
3
7
[11]
0,8%
0,8%
Датчики / Измерительные преобразов… http://e-memory.ru
05 Янв 2016
Модуль поиска
Интернет
5
5
[12]
0,27%
0,68%
Расчет озонометра
https://knowledge.allbest.ru
03 Мар 2020
Модуль поиска
Интернет
1
4
[13]
0%
0,55%
2010 Том 2
http://portal.tpu.ru:7777
28 Июл 2017
Модуль поиска
Интернет
0
4
[14]
0,54%
0,54%
sPlan 7.0. Подробное руководство. - На… http://vprl.ru
16 Июн 2019
Модуль поиска
Интернет
2
2
[15]
0%
0,54%
sPlan 7.0. Подробное руководство. - На… http://vprl.ru
16 Июн 2019
Модуль поиска
Интернет
0
2
[16]
0,52%
0,52%
Управление движением группы мобил… http://195.19.40.226
02 Окт 2018
Модуль поиска
Интернет
2
2
http://dspace.susu.ru
http://dspace.susu.ru
[17]
0,07%
0,48%
Разработка библиотек 3-D моделей эл… http://elib2.altstu.ru
08 Сен 2017
Модуль поиска
Интернет
1
4
[18]
0,43%
0,43%
Готовая курсовая работа по теме «Циф… https://author24.ru
11 Апр 2019
Модуль поиска
Интернет
4
4
[19]
0%
0,27%
Будиба Уиссам. Модели малогабаритн… https://khai.edu
16 Мая 2018
Модуль поиска
Интернет
0
3
[20]
0%
0,25%
не указано
12 Апр 2014
Модуль поиска
Интернет
0
3
http://wucheba.ru
Отзывы:
Авторизуйтесь, чтобы оставить отзыв