- •Кафедра теоретической механики и мехатроники курсовой проект
- •Содержание
- •Введение
- •Анализ существующих конструкций
- •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.6 Алгоритмы управления
С учетом всех аппаратных особенностей проектируемой цифровой системы автоматического управления, напишем алгоритм функционирования управляющей программы для нее (рис. 32).
Рис. 32 Алгоритм функционирования управляющей программы кулачка
Для прыжка необходимо при помощи пульта задать требуемую высоту прыжка, которая через радиомодуль попадет в микроконтроллер. Далее происходит взвод кулачка. После этого будет произведен расчет углов между звеньями ноги робота. Далее будет проведена проверка, соответствуют ли полученные углы установленным, если не соответствуют, то производится их выставление на требуемое значение. После чего производится 1 оборот кулачка и, соответственно, происходит прыжок.
5.7. Исследование цифровой сау
5.7.1 Моделирование цифровой системы
Для исследования ЦСАУ необходимо провести z-преобразование передаточной функции непрерывной системы. Для этого воспользуемся средствами математического пакета VisSim (рис. 16).
Рис. 16 Переход в Z-пространство средствами VisSim
Смоделируем схему цифровой системы автоматического управления в Simulink (рис. 17).
Рис.17 Структурная схема ЦСАУ
Рис. 18 Отработка ЦСАУ заданного закона подписать графики
5.7.2 Исследование цифровой системы на устойчивость
Как известно, непрерывная система устойчива, если все корни ее характеристического уравнения лежат в левой полуплоскости. При исследовании дискретных систем вместо р используется новая переменная z = . Конформное преобразование z = отображает левую полуплоскость плоскости р в область, ограниченную окружностью единичного радиуса на плоскости z, при этом мнимая ось отражается в саму эту окружность. Следовательно, для того чтобы системы была устойчива необходимо и достаточно, чтобы корни характеристического уравнения лежали внутри единичной окружности.
Рис. 19 Проверка устойчивости ЦСАУ
Как видно из рис. 19, все корни характеристического уравнения лежат внутри единичной окружности, следовательно, проектируемая цифровая система устойчива.
Заключение
В данной выпускной квалификационной работе была спроектирована конструкция ноги двуногого прыгающего робота. Для этого был проведен анализ существующих конструкций, выявлены их недостатки, предложена новая конструкция. Был произведен энергетический расчет электроприводов, а также рассчитаны некоторые детали конструкции.
выводы из КУМСа
Нужно указать опубликованные статьи и участие в конференциях
Библиографический список
Подураев, Ю. В. Мехатроника : основы, методы, применение: уч. пос. / Ю. В. Подураев. - М.: Машиностроение, 2006.
Егоров, О. Д. Мехатронные модули. Расчет и конструирование [Текст]: уч.пос. / О. Д. Егоров, Ю. В. - М.: ИЦ МГТУ «СТАНКИН», 2004.
Артоболевский И.И. Механизмы в современной технике. В 5 томах. Том 4. Кулачковые и фрикционные механизмы. Механизмы с гибкими звеньями: пособие для инженеров, конструкторов и изобретателей / И.И. Артоболевский. – М.: Наука. Главная редакция физико-математической литературы, 1975.
литературы 20-25 источников