Научная статья на тему 'Программируемый формирователь траектории движения следящего электропривода'

Программируемый формирователь траектории движения следящего электропривода Текст научной статьи по специальности «Электротехника, электронная техника, информационные технологии»

CC BY
216
39
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
ТРАЕКТОРИЯ ДВИЖЕНИЯ / TRAJECTORY SHAPER / ФОРМИРОВАТЕЛЬ ТРАЕКТОРИИ / ЗАДАТЧИК ИНТЕНСИВНОСТИ / INTENSITY SHAPER / ОГРАНИЧЕНИЕ СКОРОСТИ / ОГРАНИЧЕНИЕ УСКОРЕНИЯ / ACCELERATION LIMITATION / MOTION PATH / VELOCITY LIMITATION

Аннотация научной статьи по электротехнике, электронной технике, информационным технологиям, автор научной работы — Ловлин Сергей Юрьевич, Цветкова Мадина Хасановна, Жданов Иван Николаевич

ускорения. Особенность поставленной задачи заранее неизвестна траектория задания, формирователь траектории (ФТ) реализуется в цифровом виде.

i Надоели баннеры? Вы всегда можете отключить рекламу.

Похожие темы научных работ по электротехнике, электронной технике, информационным технологиям , автор научной работы — Ловлин Сергей Юрьевич, Цветкова Мадина Хасановна, Жданов Иван Николаевич

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.
i Надоели баннеры? Вы всегда можете отключить рекламу.

PROGRAMMED SERVO DRIVE TRAJECTORY SHAPER

The article describes digital trajectory shaping algorithm used for servo drive directing. There are velocity and acceleration limitation included in this algorithm. The algorithm is intended for working in advance unknown input signal conditions; trajectory shaper is realized in the digital form

Текст научной работы на тему «Программируемый формирователь траектории движения следящего электропривода»

Решение проблем, возникающих при анализе СВЗИ ошибок и неопределенностей в силу высокого уровня шума, возможно с помощью взаимодействия мировой сети ионосферных станций, глобального радиозатменного мониторинга ионосферы и атмосферы Земли. Перспективным направлением зондирования ионосферы являются современные методы частотно-углового зондирования, позволяющие на стадии аппаратного анализа производить разложение отраженного сигнала на составляющие его компоненты, например, как это реализовано в Digisonde™ Portable Sounder (DPS) [6].

Литература

1. Гинзбург В.Л., Рухадзе А. А. Волны в магнитоактивной плазме. - 2-е изд. - М.: Наука, 1975. - 256 с.

2. Яковлев О.И., Павельев А.Г., Матюгов С.С. Спутниковый мониторинг Земли: Радиозатменный мониторинг атмосферы и ионосферы. - М.: Либроком, 2010. - 208 с.

3. Piggott W.R., K. Rawer. URSI handbook of Ionogram Interpritation and Reduction // INAG (Ionospheric Network Advisory Group) WORLD DATA CENTER A. National Academy of Sciences. - 2-d edition. -1972. - 145 p.

4. Яковлев О.И., Якубов В.П., Урядов В.П., Павельев А.Г. Распространение радиоволн. - М.: ЛЕНАНД, 2009. - 496 с.

5. Демидович Б.П., Марон И.А. Основы вычислительной математики. - М.: Наука, 1970. - 664 с.

6. Background to Ionospheric Sounding [Электронный ресурс]. - Режим доступа: http://ulcar.uml.edu/DPS.htm, свободный. Яз. англ.

Гришенцев Алексей Юрьевич - Санкт-Петербургский государственный университет информацион-

ных технологий, механики и оптики, кандидат технических наук, доцент, tigerpost@ya.ru

Коробейников Анатолий Григорьевич - Санкт-Петербургский филиал учреждения Российской академии наук

«Институт Земного магнетизма, ионосферы и распространения радиоволн им. Н.В. Пушкова РАН», доктор технических наук, профессор, зам. директора, Korobeynikov_A_G@mail.ru

УДК 681.5.11

ПРОГРАММИРУЕМЫЙ ФОРМИРОВАТЕЛЬ ТРАЕКТОРИИ ДВИЖЕНИЯ СЛЕДЯЩЕГО ЭЛЕКТРОПРИВОДА

С.Ю. Ловлин, М.Х. Цветкова, И.Н. Жданов

Рассматривается методика построения траектории движения следящего электропривода с ограничением скорости и ускорения. Особенность поставленной задачи - заранее неизвестна траектория задания, формирователь траектории (ФТ) реализуется в цифровом виде.

Ключевые слова: траектория движения, формирователь траектории, задатчик интенсивности, ограничение скорости, ограничение ускорения.

Введение

В системах регулирования положения важную роль играют законы управления движением, обеспечивающие оптимальное протекание процесса позиционирования. В ряде случаев классические законы управления следящими электроприводами, как, например, в установках лазерного раскроя листовых материалов или гравировки, не позволяют достичь требуемых динамических характеристик электромеханических систем - минимальной ошибки отработки заданной траектории движения при максимальном быстродействии, минимальном перерегулировании и ограничениях скорости и ускорения [1].

Данная проблема может быть решена посредством введения задатчика интенсивности (ЗИ) или ФТ на выходе канала задания. В общем случае задача формирования траектории решается при условии, что задание описывается кусочно-постоянной функцией и время между двумя скачкообразными изменениями задающего сигнала больше времени переходного процесса ФТ [2] (или ЗИ [1]). Другими словами, заранее рассчитывается траектория перехода из точки А в точку В, причем за все время переходного процесса точка В не меняется.

Такие ФТ удовлетворяют широкому кругу задач, но не могут быть использованы, например, в задачах слежения телескопов за небесными объектами. За время перехода телескопа от одного спутника к другому последний успевает изменить свое положение, причем его траектория заранее неизвестна. Отсюда возникает необходимость планирования траектории в реальном времени.

Постановка задачи

Задача состоит в разработке ФТ, обладающего следующими качествами: минимальное время переходного процесса, простота реализации, адаптация под изменяющиеся условия задания. Под простотой реализации понимается использование только таких функций, как сложение, умножение, деление. Это

ПРОГРАММИРУЕМЫЙ ФОРМИРОВАТЕЛЬ ТРАЕКТОРИИ ДВИЖЕНИЯ

необходимо для высокого быстродействия алгоритма ФТ. Также немаловажным является и цифровое исполнение ФТ.

В качестве входных данных ФТ использует:

2п, гп_1, гп_2 - текущее и два предыдущих значения задания; ап-1, ап_2, ап_з - три предыдущих значения ФТ;

wmax - максимальный прирост угла (произведение максимальной скорости на период дискретизации);

етах - максимальное дискретное ускорение (произведение максимального ускорения на период дискретизации в квадрате).

В расчетах, приведенных ниже, потребуются также следующие значения: е = хп - ап_1 - разница между заданием и предыдущим значением ЗТ; м>а = ап_1 _ ап_2 - прирост выходного сигнала ЗТ;

= 2п _ ^п_1 - прирост сигнала задания; еа = ап_1 _ 2 • ап_2 + ап_з - дискретное ускорение выходного сигнала ЗТ;

= 2п _ 2 • 2п_1 + гп_2 - дискретное ускорение сигнала задания; Aw = wz _ wa - относительный прирост; Ае = е2 _ еа - относительное ускорение.

Все вышеприведенные величины измеряются в радианах (это не является обязательным, но необходимо для облегчения понимания нижеприведенных графиков).

Ограничение скорости и ускорения при скачке задания

Данная задача является упрощенной, так как задающий сигнал считается постоянным.

С

начало

W = £

е = emax■sign(e)

Л

w = Wmax•sign(w) 1

нет

2 1,8 1,6 1,4 1,2 1

а, рад

нет

выходн- ой сигнал <1 >Т

\ Л ■л -

задание 1 \ У ^

/

/

7

/

С

конец

6 с

б

Рис. 1. Алгоритм ограничения скорости и ускорения (а) и результат его применения (б)

На рис. 1 изображен результат решения путем обычного ограничения скорости и ускорения. Анализируя этот график, видим, что переходный процесс носит колебательный характер, а это недопустимо. Причина такой реакции на скачок - ненулевое значение скорости сигнала ФТ при пересечении траектории задания.

Таким образом, необходимо добавить функцию торможения в ФТ, т. е. переходный процесс надо разделить на три этапа - разгон, движение с максимальной скоростью и торможение. Сложность заключается в поиске точки, в которой необходимо начать торможение. Сначала определим текущие значения угла и скорости через предыдущие:

М>п = ^>п_1 + е , (1)

ап = ап_1 + м'п . (2)

а

Проанализировав (1) и (2), получим расчеты для вычисления скорости и угла в любой момент времени через начальные значения:

^п - + п ■ е ; (3)

an = а0 + n ■ Wq +1 n(n +1) • e .

(4)

В конце торможения скорость изменения сигнала ФТ м>п - 0, а само значение ФТ ап должно

быть равно значению задания. Отсюда и вытекает условие начала торможения:

wn

n = —

а = а +—

w,

(5)

-wn

где wо - скорость в данный момент времени; ао - предыдущее значение ЗТ; ап - значение задания; е -тормозное ускорение; п - количество тактов вычислений, через которое скорость станет равной нулю.

Результат моделирования данного алгоритма ФТ изображен на рис. 2 (задание и выходной сигнал ФТ на участке от 0 до 2 с). Форма траектории напоминает латинскую букву 5, откуда и название - З1-образный ФТ.

а, рад

\вых одной :игнал ФТ

— зада

/

10 t ,с

Рис. 2. Результат работы ФТ

Ограничение скорости и ускорения при любом виде задания

Выберем систему отсчета, в которой будет проводиться решение поставленной задачи. Совместим начало координат с текущим значением задания. Скорость и ускорение выбранной системы отсчета в абсолютной системе координат соответственно равны текущим скорости и ускорению задания. Таким образом, траектория задания преобразуется в ось абсцисс относительной системы координат. Нетрудно заметить, что решение такой задачи аналогично предыдущему, т.е. необходимо привести выходной сигнал ФТ из любой точки относительной системы отсчета в начало координат. Проведем следующие замены: а„ - а - е;

w0 = Aw;

(6)

e = Ae.

Подставим (6) в (5):

n = —

1

8 = — 2

Aw

Ae;

Aw2

Ae

-Aw

(7)

Выражение (7) дает нам полное решение поставленной задачи о поиске точки начала торможения. Алгоритм цифрового ФТ приведен на рис. 3. Особенность цифрового исполнения ФТ заключается в том, что вычисления производятся в дискретные моменты времени. Таким образом, маловероятно, что тормозное ускорение будет приложено в точке начала торможения. Поэтому система прогнозирует ситуацию на следующем периоде дискретизации (переменные Awl, Ae1max, n1), и если выполняется условие начала торможения, то ФТ формирует тормозное ускорение уже на текущем такте.

e

ПРОГРАММИРУЕМЫЙ ФОРМИРОВАТЕЛЬ ТРАЕКТОРИИ ДВИЖЕНИЯ ...

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

Рис. 3. Алгоритм формирователя траектории

В алгоритме используются следующие функции: sign() - вычисление знака аргумента; ееИ() - округление аргумента вверх.

Выход на заданную траекторию должен быть выполнен за целое число тактов. Используя функцию округления се/7(), система ФТ вычисляет, с каким ускорением (близким к максимальному) необходимо проводить торможение.

В результате формирования траектории сложного задания (рис. з) были получены скорости и ускорения, лежащие в пределах ограничения (рис. 4).

Д.С. Бирюков, А.В. Ушаков

0,6 0,4 0,2 0

V, рад

е, рад х10

-0,6-

Чограничение скорости

гтиоос т сигна па ФТ

л

ог эаниче ние ско рости

Г \ограничение ускорения

1скретн ое уско ала ФТ рение

сигн

огр аничен ие уско эения

7

Ю t,<¡ о

1

10 Г,с

'0 1 2 3 4 5 6

а б

Рис. 4. Скорость (а) и ускорение (б) ФТ

Заключение

Разработанный алгоритм цифрового ФТ позволяет решать задачу ограничения скорости и ускорения в реальном времени при изменяющихся условиях задания с максимальными быстродействием и эффективностью. Данное решение, к примеру, подходит для следящих систем телескопов траекторных измерений. Но есть и один недостаток этого алгоритма - в некоторые моменты времени происходит скачкообразное изменение ускорения. Это требует скачкообразного изменения момента двигателя и приводит к перегрузке механической трансмиссии. При этом в нагрузке с упругой связью неизбежно будут возникать колебания. В некоторых случаях это недопустимо, и появляется необходимость повышения порядка гладкости траектории. В ближайшем будущем планируется решение данной проблемы.

Литература

1. Оптимальное управление движением при позиционировании и его моделирование в среде МаШ-1аЬ/81шиИпк / А.Г. Ильина, Д.В. Лукичев, А.А. Усольцев // Изв. вузов. Приборостроение. - 2008. -Т. 51. - № 6. - С. 63-67.

2. Использование параметрической аппроксимации при планировании траекторий движения аппаратов / Г.М. Довгоброд, Л.М. Клячко, А.В. Рогожников // Изв. вузов. Приборостроение. - 2009. - Т. 52. -№ 9. - С. 11-17.

Ловлин Сергей Юрьевич - Санкт-Петербургский государственный университет информационных тех-

нологий, механики и оптики, студент, seri-1@yandex.ru Цветкова Мадина Хасановна - Санкт-Петербургский государственный университет информационных технологий, механики и оптики, студент, madina1986@bk.ru Жданов Иван Николаевич - Санкт-Петербургский государственный университет информационных тех-

нологий, механики и оптики, ассистент, zhdanov@ets.ifmo.ru

УДК 62.50

КОНТРОЛЬ ЗАТРАТ НА УПРАВЛЕНИЕ ПРИ ВОСПРОИЗВЕДЕНИИ ГАРМОНИЧЕСКИХ ЭКЗОГЕННЫХ ВОЗДЕЙСТВИЙ: ГРАМИАННЫЙ

ПОДХОД

Д.С. Бирюков, А.В. Ушаков

Ставится задача контроля затрат управления при воспроизведении синтезируемой системой гармонических экзогенных воздействий с использованием грамианного подхода. Грамианный подход сформировался в рамках современной теории управления, опирающейся на векторно-матричный формализм метода пространства состояния. Подход аналитически устанавливает прямую связь установившейся составляющей движения технического объекта (ТО) в составе синтезируемой системы по выходу с вектором начального состояния источника гармонических экзогенных воздействий, причем эта связь осуществляется через матрицу подобия, являющуюся решением матричного уравнения Сильвестра. Задача получает прозрачное решение на сфере начальных состояний источника гармонических экзогенных воздействий в виде мажоранты и миноранты затрат управления как функции распределения мод, которое доставляется системе, образованной ТО и регулятором, при синтезе системы.

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

Введение. Постановка задачи

Грамианные структуры в настоящее время активно используются отечественными и зарубежными специалистами для решения задач оптимального размещения управляющих органов и датчиков [1], оценки

i Надоели баннеры? Вы всегда можете отключить рекламу.