- •Кафедра теоретической механики и мехатроники курсовой проект
- •Содержание
- •Введение
- •Анализ существующих конструкций
- •1.1 Прыгающие роботы, отличающиеся видом механизма позиционирования до прыжка
- •1.2 Прыгающие роботы, отличающиеся видом механизма прыжка
- •1.3 Прыгающие роботы, отличающиеся видом механизма позиционирования после прыжка
- •1.4 Технико-экономическое обоснование
- •2 Исследовательский раздел
- •2.1 Описание разрабатываемой конструкции
- •2.1 Кинематика системы
- •2.3 Модель взаимодействия робота с опорной поверхностью
- •2.4 Уравнения движения прыгающего робота
- •2.4.1 Статическое положение при двух точках опоры
- •2.4.2 Статическое положение при одной точке опоры
- •2.4.3 Прямолинейное движение робота с двумя точками опоры по шероховатой поверхности
- •2.4.4 Прямолинейное движение робота с одной точкой опоры по шероховатой поверхности
- •2.4.5 Поворот относительно точки а
- •2.4.6 Плоскопараллельное движение без отрыва от поверхности
- •2.4.7 Плоскопараллельное движение при отрыве от поверхности
- •2.5 Алгоритм моделирования одного прыжка робота
- •2.6 Исследование движения робота
- •3 Расчетно-конструкторский раздел
- •3.1 Энергетический расчёт электроприводов
- •3.2 Расчет электропривода поворота корпуса относительно ноги
- •3.2 Расчет пружины
- •3.3 Трехмерные модели разработанной конструкции
- •4 Система автоматического управления
- •4.1 Структурная схема сау
- •4.2 Определение передаточных функций
- •4.3 Исследование непрерывной сау
- •4.3 Настройка пид - регулятора
- •4.4 Определение передаточных функций разомкнутой и замкнутой системы.
- •5.1 Система управления роботом.
- •5.2 Функциональная схема цсау
- •5.3 Структурная схема устройства
- •5.4 Выбор электронных компонентов
- •5.4.1 Микроконтроллер
- •5.4.2 Драйвер двигателей.
- •5.4.3 Энкодеры.
- •5.4.4 Модуль беспроводной передачи данных
- •5.5 Принципиальная схема устройства
- •5.6 Алгоритмы управления
- •5.7. Исследование цифровой сау
- •5.7.1 Моделирование цифровой системы
- •5.7.2 Исследование цифровой системы на устойчивость
- •Заключение
- •Библиографический список
5.4.2 Драйвер двигателей.
Для управления приводами необходим усилитель мощности, так как:
1) Уровень тока, поступающий из порта микроконтроллера (около 200 мА), слишком мал для работы приводов;
2) Напряжение питания электроприводов намного больше того, которое может обеспечить микроконтроллер;
3) Электропривод представляет собой индуктивную нагрузку, следовательно, напрямую подключать микроконтроллер к приводу нельзя из-за возможных индуктивных выбросов.
В качестве усилителя мощности будем использовать двунаправленный драйвер двигателей постоянного тока MoviPower Lite компании Movicom (рис. 21). Основными достоинствами драйвера являются:
Рабочее напряжение: 5.5 ÷ 36 В
Рабочий ток: до 8 A
Пиковый ток: до 30 A
Частота ШИМ (макс.): 20 кГц
Реверсивное управление
Защита от перегрузки по току и от перегрева
Спящий режим
Рис. 22 Распиновка разъемов подключения драйвера
Рис. 23 Сигналы управления, питания и выходные сигналы драйвера
Рис. 24 Таблица истинности работы драйвера (В - низкий сигнал, Н- высокий сигнал)
Рис. 25 Драйвер двигателей постоянного тока MoviPower
5.4.3 Энкодеры.
Для определения положения звеньев ноги прыгающего робота используются 2 вида энкодеров. Для поворотов ноги относительно ступни и корпуса относительно ноги используется 1 вид:
внешний вид энкодера из каталога привести или найти трехмерку в интернете
Рис. 26 Энкодер МR, тип ML, 128-1000 имп/0б., с драйвером линий
Рис. 27 Технические характеристики энкодера
Рис. 28 Назначение контактов энкодера
Для определения угла поворота кулачка используется Энкодер МR, тип ML, 256-1024 имп/0б., с драйвером линий
Рис. 29 Технические характеристики энкодера
Назначение контактов энкодера для обоих видов идентично.
5.4.4 Модуль беспроводной передачи данных
Модули беспроводной передачи данных R-Cat (USB и OEM) позволяют организовать беспроводную связь на частоте 433 MГц на расстоянии до одного километра с другими USB или OEM – модулями (OEM-радиомодуль предназначен для интеграции в уже существующие контроллеры). Подходят для беспроводного сбора информации с датчиков, радиоуправления, работы в охранных и пожарных системах.
.В качестве данного модуля выберем RCAT 433 MHZ:
Рис. 30 Модуль беспроводной передачи данных RCAT
Технические данные OEM-радиомодуля:
Рабочее напряжение (макс.): 3.6÷5.5 В
Ток потребления (макс): 40 мА
Радиус действия: 150 м
Скорость передачи по радиоканалу: 9600 бит/с
5.5 Принципиальная схема устройства
С учетом выбранных компонентов спроектируем принципиальную схему ЦСАУ ногой прыгающего робота (рисунок ).
Рис. 31 Принципиальная схема ЦСАУ ногой прыгающего робота
Список компонентов:
D1 – разъемы питания на 24 и 5 В;
DD1 – микроконтроллер ATmega16;
Х1,X3, X4 –драйверные схемы MoviPower Lite;
X2- vодуль беспроводной передачи данных RCAT 433 MHZ;
X5, X6, X7– энкодеры;
M1, M2, М3 – электродвигатели;
Z1 – кварцевый резонатор на 10МГц;
С1, С2 – конденсаторы по 22 пФ;
C4 – конденсатор на 0, 1 мкФ;
C3, C5, С6– конденсаторы по 33 мкФ;
HL1, HL2, HL3 – светодиоды.