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

Федеральное агентство по образованию

Государственное образовательное учреждение

высшего профессионального образования

Дальневосточный государственный технический университет

(ДВПИ  им. В.В. Куйбышева) 
 
 
 
 
 
 
 
 
 

Курсовая  работа по дисциплине

«Роботы и их системы управления»

на тему

«Синтез оптимального регулятора для электропривода, управляющего поступательной степенью подвижности трехзвенного манипулятора» 
 
 
 

                                                       Выполнила: студентка 

                                                       группы 

                                                       Проверил:  
 
 
 
 
 
 
 
 
 
 
 
 
 

Владивосток.

2010 г.

1. Цель курсовой работы

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

2. Исходные данные

3. Вывод обобщенного момента  для степени подвижности 

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

       - уравнение Лагранжа  в общем виде

       - уравнение Лагранжа  для 

Где – обобщенный момент для первого звена, Т – кинетическая энергия, П- потенциальная энергия манипулятора, - поступательное перемещение первого звена, - скорость перемещения первого звена.

      3.1 Расчет  потенциальной энергии для трехзвенного  манипулятора 

   Где - потенциальная энергия всего манипулятора, - потениальная энергия 1го звена, - потенциальная энергия 2го звена, - потенциальная энергия груза.

;

;

;

    тогда потенциальная энергия всего манипулятора имеет вид:

.

     3.2 Расчет кинетической энергии  для трехзвенного манипулятора

,

    где -  кинетическая энергия вращательного звена, -  кинетическая энергия поступательного звена.

   т. к. манипулятор движется плоскопараллельно.

  ,

    где - кинетическая энергия поступательного движения 1го и 2го звена, - кинетическая энергия вращательного движения 2го звена, - кинетическая энергия вращательного движения груза.

      (т.к. груз был принят за материальную точку, а момент инерции материальной точки   то )

;

,

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

    Найдем  скорость движения, взяв производную от координат: 
 

    По  теореме Пифагора найдем скорость при  плоскопараллельном движении:

  ,  тогда

.

;

,

    где скорость движения груза при плоскопараллельном движении. Находится аналогично, как и в случае плоскопараллельного движения 2го звена: 
 

; 
 
 

    Тогда общая кинетическая энергия манипулятора имеет вид: 
 

    3.2 Расчет общего  момента для  
 

    Тогда обобщенный момент имеет вид:

    где  – инерционная составляющая

    -  внешнее моментное воздействие.

4. Обобщенная схема электропривода с учетом взаимовлияния

Рис. 2 Обобщенная структурная схема следящего  электропривода

Рассматриваемый электропривод имеет следующие  параметры и обозначения:

- напряжение на якорной обмотке двигателя;

- вращающий момент электродвигателя,

- символ дифференцирования;

 - угол поворота выходного вала редуктора;

- желаемый угол поворота выходного вала редуктора;

=0,005 - индуктивное сопротивление якорной цепи электродвигателя;

=0,8 - активное сопротивление якорной цепи электродвигателя;

ip=200 - передаточное отношение редуктора;

 - коэффициент противо-ЭДС;

- моментный коэффициент электродвигателя;

- момент инерции ротора электродвигателя;

=25 - коэффициент усиления по напряжению усилителя мощности;

М_стр=0.003sign() Н×м - момент сухого трения;

к_в=0.005 - коэффициент вязкого трения;

- – инерционная составляющая;

- внешнее моментное воздействие 

    С учетом всех данных смоделируем электропривод  в MATLAB:

    

    Рис.3 Обобщенная схема электропривода с учетом взаимовлияния 

    

    Рис.4 Схема блока Мvn (Моментное воздействие)

    На  рисунке 5 показаны графики входных сигналов. Цифрой 1 обозначен входной сигнал системы (, 2 – закон изменения фазовой координаты q₂ , 3 - закон изменения фазовой координаты q₃

    

Рис.5 График входных сигналов          Рис.6 График выходного сигнала  

    

5. Синтез  самонастраивающегося КУ, стабилизирующего параметры ДУ электропривода

    Данное СКУ необходимо для стабилизации динамических свойств и качественных показателей электроприводов роботов в условиях существенного изменения приведенного момента инерции. Оно осуществляет точную стабилизацию динамических свойств привода в течение всего рабочего цикла.

    Исходя  из ДУ электрической цепи якоря и  уравнения момента: 
 
 

    Можно получить описание электропривода следующим образом: 
 

         

    Полагая, что в процессе движения модель- сonst (тогда ), и К_в  (изменяется достаточно медленно), то полученное описание электропривода можно переписать: 

               (5.1) 

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

                                                       (5.2)

 нагруженного электропривода.

    Далее выразим из (5.2) : 

    и подставив в (5.1) получим закон управления, обеспечивающий стабилизацию динамических и качественных показателей электроприводов: 
 

    

    Рис.7 Схема самонастраивающегося электропривода 

    

    Рис.8 Содержимое блока SKY

    

    Рис.9 Графики сигналов самонастраивающегося электропривода 

    На  рисунке 9 показаны графики входных и выходных сигналов самонастраивающегося СКУ. Цифрой 1 обозначен желаемый угол поворота вала редуктора, 2- полученный угол поворота вала редуктора, 3 – динамическая ошибка.

6. Синтез оптимального регулятора при заданных фазовых координатах:

x₁=н

x₂=

x₃=

     Пусть объект управления описывается системой стационарных линейных дифференциальных уравнений следующего вида:

    ,

    где Х – вектор фазовых координат, U – вектор управляющих воздействий, А – матрица динамических  свойств системы, В – матрица коэффициентов при управляющих воздействиях, W – некоторое внешнее воздействие на объект управления.

    Данную  систему можно переписать относительно вектора ошибок:

                   

,

         где

вектор желаемых значений соответствующих фазовых координат.

    Тогда производная ошибок будет иметь вид

    ,                                            (6.1)

    где   .                              

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

                                    (6.2)

где Ф - положительная полуопределенная матрица весовых коэффициентов, положительно определенная матрица, начальное и конечное время интегрирования соответственно, К - решение дифференциального уравнения Риккати (6.3).