- •Основы робототехники. Устройство роботов План лекции.
- •Лекция 1 Введение
- •Классификация роботов по назначению
- •Лекция 2 Кинематика манипулятора
- •Матрицы сложных поворотов
- •Лекция 3 Матрица поворота вокруг произвольной оси
- •Представление матриц поворота через углы Эйлера
- •Лекция 4 Геометрический смысл матриц поворота
- •Свойства матриц поворота
- •Однородные координаты и матрицы преобразований
- •Лекция 5 Звенья, сочленения и их параметры
- •Представление Денавита – Хартенберга
- •Алгоритм формирования систем координат звеньев
- •Для манипулятора Пума
- •Лекция 6 Уравнения кинематики манипулятора
- •Классификация манипуляторов
- •Обратная задача кинематики
- •Метод обратных преобразований
- •Лекция 7 Геометрический подход
- •Определение различных конфигураций манипулятора
- •Решение обратной задачи кинематики для первых трех сочленений
- •Решение для первого сочленения
- •Решение для второго сочленения
- •Лекция 8 Решение для третьего сочленения
- •Решение обратной задачи кинематики для последних трех сочленений
- •Решение для четвертого сочленения
- •Решение для пятого сочленения
- •Решение для шестого сочленения
- •Лекция 9 Уравнения вида конфигурации для определения индикаторов конфигурации манипулятора
- •Машинное моделирование
- •Динамика манипулятора
- •Метод Лагранжа-Эйлера
- •Скорость произвольной точки звена манипулятора
- •Лекция 10 Кинематическая энергия манипулятора
- •Потенциальная энергия манипулятора
- •Уравнение движения манипулятора
- •Уравнения движения манипулятора с вращательными сочленениями
- •Пример: двухзвенный манипулятор
- •Лекция 11 Уравнения Ньютона-Эйлера
- •Вращающиеся системы координат
- •Лекция 12 Подвижные системы координат
- •Кинематика звеньев
- •Лекция 13 Рекуррентные уравнения динамики манипулятора
- •Лекция 14 Планирование траекторий манипулятора
- •Сглаженные траектории в пространстве присоединенных переменных
- •Расчет 4-3-4 - траектории
- •Лекция 15 Граничные условия для 4-3-4-траекторий
- •Лекция 16 Управление манипуляторами промышленного робота
- •Метод вычисления управляющих моментов
- •Передаточная функция одного сочленения робота
- •Лекция 17 Устройство позиционирования для одного сочленения манипулятора
- •Критерии работоспособности и устойчивости
- •Лекция 18 Компенсация в системах с цифровым управлением
- •Зависимость момента от напряжения
- •Управление манипулятором с переменной структурой
- •Адаптивное управление
- •Адаптивное управление по заданной модели
- •Адаптивное управление с авторегрессивной моделью
- •Лекция 19 Адаптивное управление по возмущению
- •Независимое адаптивное управление движением
- •Лекция 20 очувствление Введение
- •Датчики измерения в дальней зоне
- •Триангуляция
- •Метод подсветки
- •Лекция 21 Измерение расстояния по времени прохождения сигнала
- •Очувствление в ближней зоне
- •Индуктивные датчики
- •Датчики Холла
- •Лекция 22 Емкостные датчики
- •Ультразвуковые датчики
- •Оптические датчики измерения в ближней зоне
- •Лекция 23 Тактильные датчики
- •Дискретные пороговые датчики
- •Аналоговые датчики
- •Силомоментное очувствление
- •Элементы датчика схвата, встроенного в запястье
- •Выделение сил и моментов
- •Лекция 24 Системы технического зрения
- •Получение изображения
- •Лекция 25 Методы освещения
- •Стереоизображение
- •Системы технического зрения высокого уровня
- •Сегментация
- •Проведение контуров и определение границ
Лекция 18 Компенсация в системах с цифровым управлением
В дискретных системах управления время характеризуется периодом дискретизации , при этом скорость выражается не в радианах в секунду, а в радианах за период . Это определяет изменение инерции звена на величину , где - частота дискретизации .
Обычно используется частота дискретизации 60 Гц с периодом дискретизации 16 мс. Это объясняется ее распространенностью и тем, что большинство манипуляторов имеет механическую резонансную частоту в диапазоне 5-10 Гц. Хотя из дискретной теоремы Найквиста следует, что отношение частоты дискретизации к частоте среза системы для возможности воспроизведения сигнала должно быть по крайней мере не меньше двух, для систем непрерывного времени это отношение увеличивается. Для того чтобы улучшить работу системы при дискретизации, частота дискретизации должна быть много больше собственной частоты манипулятора, и наоборот, период дискретизации должен быть много меньше наименьшей постоянной времени манипулятора.
Таким образом, для минимизации погрешностей от дискретизации обычно выбирается частота дискретизации, в 20 раз превышающая частоту среза системы, т.е.:
. (18-1)
Зависимость момента от напряжения
Теоретически момент в двигателе постоянного тока с управлением в цепи якоря является линейной функцией напряжения якоря. В действительности зависимость момента от напряжения нелинейна из-за влияния трения при малых моментах и из-за явлений насыщения при больших моментах. По этим причинам численное преобразование вычисленного момента в требуемое входное напряжение обычно уточняется с помощью табличных значений или вычислений по приближенным формулам. Выходное напряжение реализуется, как правило, в виде сигналов постоянной величины или в виде импульсов различной ширины.
Типичная кривая преобразования напряжения в момент показана на рис. 18.1, где - управление двигателем, при котором сочленение перемещается с постоянной скоростью, не вызывая усилий в направлении движения, а - сила или момент, которые сочленение развивает при управлении с отрицательной скоростью. Величины наклонов и их приращения получены из экспериментальных кривых.
Рисунок 18.1. График зависимости «напряжение-вращающий момент»
Управление манипулятором с переменной структурой
Системы с переменой структурой (СПС) относятся к классу систем с дискретным управлением по обратной связи. Основной особенностью СПС является наличие «скользящего режима» на поверхности переключения.
-
Справка. Оптимальное по быстродействию управление представляет собой кусочно-постоянную функцию времени. Интерес представляют те области пространства состояний, в которых управление постоянно. Эти области разделяются линиями в двухмерном пространстве, поверхностями – в трехмерном пространстве и гиперповерхностями – в n-мерном пространстве. Такие разделяющие границы называют соответственно линиями переключения, поверхностями переключения и гиперповерхностями переключения.
В скользящем режиме система не реагирует на изменение параметров и на возмущающие воздействия, а ее траектории проходят по поверхности переключения. Система управления в этом режиме нечувствительна к изменению параметров.
Пусть требуется найти управление переменной структурой для шестизвенного манипулятора. Вектор состояния:
. (18-2)
Вводя вектор ошибки позиционирования и вектор ошибки по скорости , сведем задачу слежения к задаче стабилизации. Уравнения ошибки системы:
и , (18-3)
где - вектор-функция размерностью n×1; b - матрица возмущения D.
Для системы стабилизации управление переменной структурой может быть записано в виде
(18-4)
где - поверхности переключения, удовлетворяющие условиям:
. (18-5)
После этого синтез управления сводится к выбору управления с обратной связью в соответствии с уравнением (18-4) так, чтобы скользящий режим происходил на пересечении с поверхностями переключения.
Решая алгебраические уравнения поверхностей переключения
(18-6)
можно отыскать единственно существующее управление
, (18-7)
где . После этого скользящий режим получается из уравнения (18-5) в виде:
. (18-8)
Это уравнение в явном виде описывает движение шести линейных систем первого порядка, каждое из которых представляет одну степень свободы манипулятора при нахождении системы в скользящем режиме. Как видно из уравнения (18-4), устройство управления переводит манипулятор в скользящий режим, при этом влияние сил взаимодействия между сочленениями полностью исключается. Для управления манипулятором в скользящем режиме используется устройство управления, реализующее управление в соответствии с уравнением (18-7). Динамика манипулятора в скользящем режиме зависит только от конструктивных параметров .