Научная статья на тему 'Синтез разностных алгоритмов управления цифровыми следящими электроприводами мобильных роботов Е-операторным методом'

Синтез разностных алгоритмов управления цифровыми следящими электроприводами мобильных роботов Е-операторным методом Текст научной статьи по специальности «Математика»

CC BY
236
61
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
УПРАВЛЕНИЕ / СЛЕДЯЩИЙ ЭЛЕКТРОПРИВОД / ПАРАЛЛЕЛЬНЫЙ И ПОСЛЕДОВАТЕЛЬНЫЙ АЛГОРИТМ / ДИФФЕРЕНЦИАЛЬНЫЕ УРАВНЕНИЯ / ПЕРЕДАТОЧНЫЕ ФУНКЦИИ / ИНТЕГРАТОРЫ / РЕГИСТРЫ СДВИГА / РЕАЛЬНОЕ ВРЕМЯ / CONTROL / WITNESS OF THE ELECTRIC DRIVE / PARALLEL AND SERIAL ALGORITHM / DIFFERENTIAL EQUATIONS / TRANSFER FUNCTIONS / INTEGRATORS / SHIFT REGISTERS / REAL TIME

Аннотация научной статьи по математике, автор научной работы — Сафронов Виктор Валентинович

Предложен математический Е-операторный метод для преобразования системы дифференциальных уравнений в систему разностных уравнений математической модели следящего электропривода. В отличие от традиционно используемых громоздких способов численного интегрирования, например, в пакете Matlab-Simulink, он позволяет синтезировать из передаточных функций следящих электроприводов как последовательные, так и параллельные разностные алгоритмы, работающие в реальном времени на основе как программных, так и аппаратных регистров сдвига. Важно отметить, что эти алгоритмы невозможно реализовать средствами пакета Matlab-Simulink. Параллельный алгоритм обеспечивает большее быстродействие чем последовательный и может быть реализован «конвейерным» способом с помощью нескольких сопроцессоров одновременно. Изложенный метод представляет реальную альтернативу имеющимся средствам в пакете Matlab-Simulink для описания и анализа параметров моделей следящих электроприводов. В первой части статьи описан синтез алгоритма управления с использованием традиционных средств дифференциального исчисления и преобразования Лапласа. Во второй части статьи эта же задача решается с применением предложенного Е-операторного метода. Полученные результаты могут быть использованы в мехатронике, робототехнике, в теории управления и автоматического регулирования, в практике построения следящих электроприводов.

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

Похожие темы научных работ по математике , автор научной работы — Сафронов Виктор Валентинович

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

The mathematical Е-operating method is intended for transformation of the of differential equations system to the tracking electric drive mathematical model equations system. In contrast to the known algorithms for numerical integration, for example, in the Matlab-Simulink, E-method allows to synthesize of the transfer function of tracking electric drives for both sequential and parallel differential algorithms for working in real time on the basis of both software and hardware shifting registers. It is important to note that these algorithms cannot be implemented using Matlab-Simulink. Parallel algorithm provides greater performance than serial algorithm. Parallel algorithm can be implemented “conveyor” method of using multiple coprocessors at the same time. Method is an alternative of the means available in Matlab-Simulink programme for description and analysis of the tracking electric drive model. In the first part of the article the synthesis algorithm using traditional means of differential calculus and Laplace transforms describes. In the second part of the article a solution of the same problem with the use of the Е-operating method presents. The results obtained can be used in mechatronics, robotics, automatic control theory, in the practice of building looking for tracking electric drive.

Текст научной работы на тему «Синтез разностных алгоритмов управления цифровыми следящими электроприводами мобильных роботов Е-операторным методом»

УДК 681.5.58

DOI: 10.14529/ctcr150205

СИНТЕЗ РАЗНОСТНЫХ АЛГОРИТМОВ УПРАВЛЕНИЯ ЦИФРОВЫМИ СЛЕДЯЩИМИ ЭЛЕКТРОПРИВОДАМИ МОБИЛЬНЫХ РОБОТОВ Е-ОПЕРАТОРНЫМ МЕТОДОМ

В.В. Сафронов

ФГУП «Центральный научно-исследовательский институт машиностроения» (Роскосмос), г. Королёв

Предложен математический Е-операторный метод для преобразования системы дифференциальных уравнений в систему разностных уравнений математической модели следящего электропривода. В отличие от традиционно используемых громоздких способов численного интегрирования, например, в пакете МайаЬ^тиИпк, он позволяет синтезировать из передаточных функций следящих электроприводов как последовательные, так и параллельные разностные алгоритмы, работающие в реальном времени на основе как программных, так и аппаратных регистров сдвига. Важно отметить, что эти алгоритмы невозможно реализовать средствами пакета МайаЬ^тиИпк. Параллельный алгоритм обеспечивает большее быстродействие чем последовательный и может быть реализован «конвейерным» способом с помощью нескольких сопроцессоров одновременно.

Изложенный метод представляет реальную альтернативу имеющимся средствам в пакете МаНаЬ^тиИпк для описания и анализа параметров моделей следящих электроприводов. В первой части статьи описан синтез алгоритма управления с использованием традиционных средств дифференциального исчисления и преобразования Лапласа. Во второй части статьи эта же задача решается с применением предложенного Е-операторного метода. Полученные результаты могут быть использованы в мехатронике, робототехнике, в теории управления и автоматического регулирования, в практике построения следящих электроприводов.

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

Введение

Обычно процедура синтеза следящего электропривода состоит из четырех главных этапов [1, 2]:

- выбор его структуры в виде набора подчиненных контуров управления;

- определение вида функций передачи каждого из контуров управления по результатам анализа логарифмических амплитудно- и фазочастотных характеристик на устойчивость в нужном диапазоне частот;

- преобразование функций передачи всех контуров в систему дифференциальных уравнений;

- построение алгоритмов решения системы дифференциальных уравнений и выбор программно-технических средств реализации проекта.

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

В данной статье обращено внимание только на последние два этапа, носящих, наоборот, чисто математический, детерминированный характер.

Последнее время многие разработчики следящих систем применяют специальные компьютерные программные пакеты, например, МаАаЬ^тиНпк [3]. Между тем предложенный математический метод позволяет преобразовывать системы дифференциальных уравнений, строить последовательные и параллельные алгоритмы управления, способные работать в реальном времени.

1. Построение системы уравнений математической модели следящего электропривода

Сначала рассмотрим пример адаптивного следящего электропривода (рис. 1), считая, что первые два этапа уже выполнены, т. е. структура и передаточные функции контуров адаптивного следящего электропривода определены.

Сафронов В.В.

Рис. 1. Структура адаптивного следящего электропривода

На рис. 1 обозначено:

Вход целеуказания(ЦУ) - текущий угол входного воздействия, представляющий собой выбранное из массива данных ЦУ расчетное значение углаповорота;

- вход синапсического сигнала для реализации принципа адаптивного управления второго рода;

Уж, Foc, Сос - выходы сигналов датчиков: скорости, угла и тока;

Ш, и2, и3, и4, и5, и6, и7 - математические модели внутренних сигналов;

Ж1(р), Ж2(р), Ж3(р), Ж4(р), К/, Ку, Кс - математические модели передаточных функций звеньев в структуре электропривода.

Синапсический вход 5 представлен передаточной функцией с адаптацией второго рода, т. е. возможностью перенастройки значений «полюсов» полинома в знаменателе передаточной функции Ж1 (что уже ново для пользователей пакета Simulink). Сигналы синапсического входа формируются традиционно, силомоментными и тактильными датчиками очувствления.

Вход ЦУ - задания, т. е. расчетные траекторные углы позиционирования, хранящиеся в виде массива данных целеуказания (ЦУ).

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

Контур слежения за скоростью вращения выходного вала электродвигателя, называемый далее контуром скорости, сформирован тахогенератором Т. Однако функцию тахогенератора можно выполнить и с помощью многокомпонентных микроэлектронных вторичных преобразователей «угол - параметр - код» [4, 5] или программно, используя вычислительные ресурсы микроконтроллера, управляющего электроприводом. Контур слежения за током электродвигателя, называемый далее контуром тока, замкнут датчиком тока.

Сформированный выходной логический сигнал Ц7 управления модулятором преобразуется в ШИМ-последовательность цифровых сигналов и поступает в мостовой усилитель мощности класса <Ю», а затем в электродвигатель (см. рис. 1).

Передаточные функции звеньев имеют следующие изображения по Лапласу:

- на синапсическом входе:

К

Щ( р) =

(1+р • / (ТО) • (1+р • / (Т2))

(1)

- в позиционном контуре:

w2( p) = ; (2)

1 + p • Т- в контурах скорости и тока:

W3(p) = K •(1 + P'Ti) ; (3)

(1 + p• T,)(1 + p• T,) v '

W4(p) = ^ + p-T-> . (4)

4W (1 + pT,)(1 + pT,) v '

Запишем систему уравнений математической модели следящего электропривода по рис. 1, где все преобразования Лапласа будут выполнены с «нулевыми» начальными условиями: 'Fs (p) = s(p)Wx (p); U (p) = Fs (p) + КцУ • ЦУ(p);

U2 (p) = U (p) - Kf • F^ (p); U (p) = U2 (p) • W (p); (5)

U4 (p) = U3 (p) - Kv • Vдaт (p); U5 (p) = U4 (p) • W3 (p); U6 (p) = U5 (p) - Kc • Сдат (p); Uу (p) = U6 (p) • W4 (p).

2. Синтез математической модели синапсического входа

Из первого уравнения системы (5) с учетом вида передаточной функции W1(p) (1) и принятых упрощений f (Т1) = Т1; f (Т2) = Т2 , получим изображение Лапласа:

Fs (p) =-SM-. (6)

(1 + p^)(1 + p • Т2)

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

F's (t) • Т1 • Т2 + FS (t) • Т + Т2) + Fs (t) = K • s(t). (7)

Выразим из (7) в явном виде высшую производную и получим математическую модель си-напсического входа в аналоговом формате:

F"(t) = K •sfr) - F's(t У(Т + Т2) - Fs (t) . (8)

s Т1 • Т2

3. Синтез математической модели позиционного контура

Из четвертого уравнения системы (5), с учетом вида передаточной функции W2(p) (2), получим изображение Лапласа:

U,(p) = U 2 (p) • V-K4F. (9)

1 + p^1

Этому изображению соответствует линейное дифференциальное уравнение первого порядка с постоянными коэффициентами и правой частью:

U,(t) Т + U,(t) = U2(t) • K1. (10)

Выразим из (9) высшую производную и получим математическую модель позиционного контура для решения в аналоговом формате:

U3(t) = (и 2 (t )• K - U,(t) )• Т1-1. (11)

Синтез математической модели контура скорости

Из пятого уравнения системы (5) определим U4 (p) :

U4 (p) = U 3( p) - ^-^(p). (12)

Из шестого уравнения системы (5) с учетом вида передаточной функции W3(p) (3) получим изображение Лапласа:

U5(p) = U4(p)—K1-(1 +p71) . (13)

^ (1 + p^ + p^3) V 7

Ему соответствует пара связанных линейных дифференциальных уравнений второго и первого порядков с постоянными коэффициентами:

и 5 а) Т Т + и5 ^) • (Т + Тз)+и 5 (t) = ^), ^) = к • (и 4 (t) • Т + и 4 ^)) . (14)

Выразим из (14) высшую производную ) и получим математическую модель контура скорости в виде двух уравнений в аналоговой среде:

^ = ,(,)2и5(,)_(7Т±7з)2и5(,), ^ = + U4(t)). (15)

4. Синтез математической модели контура тока

Из седьмого уравнения системы (5) имеем: иб (р) = и5 (р) - Кс • Сдат (р).

Из восьмого уравнения системы (5) с учетом вида передаточной функции Ж4(р) (4) получим изображение Лапласа:

и ;( р) = и.. + К- « + (16)

(1+р.Т2).(1+р.?3)

Ему соответствуют линейные дифференциальные уравнения второго и первого порядков с постоянными коэффициентами:

и; (t) • Т • Тз + и; ^) • (Т + Т3)+и7 ^) = Ра), P(t) = К1 • (и6 (t) • Т1 + и6 (t)). (17)

Выразим из (17) высшую производную для ) и получим математическую модель «контура тока» в виде двух уравнений в аналоговом формате:

и 7 ^) ==т-тттТ+Т}=и(1, Р(0 = к.-^о-т, + и6(0). (18)

Полная математическая модель электропривода, синтезированная на основе предложенного Е-метода, показана на рис. 2. Естественно, может оказаться, что она схожа с моделью, синтезированной средствами пакета Simulink, так как в ней тоже использованы классические структурные элементы: «сумматоры», «интеграторы» и «масштабные усилители».

Теперь, используя результаты приведенного примера, перейдем к изложению предлагаемого Е-операторного метода преобразования алгоритмов.

5. Е-операторный метод преобразования дифференциальных уравнений

в разностном виде

Из курса высшей математики известны понятия «правых» и «левых» разностей функции:

- «правая» разность, представляет разность между будущим значением функции в момент времени ^+Л) и ее значением в текущий момент времени;

- «левая» разность представляет собой разность между значением функции в текущий момент времени (0 и ее прошлым значением в момент времени ^ - й^.

В отличие от «правых» разностей, играющих важную роль в математическом анализе, «левые» разности в статье предложено использовать для синтеза решающих сред, т. е. электронных цифровых фильтров (ЦФ), работающих в «реальном масштабе времени» и на бортовых цифровых вычислительных машинах. Далее будут использоваться только понятия «левых» разностей.

Пусть задана функция /(^ . Запишем ее значение в предыдущий момент времени следующим (необычным!) образом: /^ - Л) = /)• Е . Здесь Е - формальный оператор сдвига. Читается это выражение так: применить один раз (что символизирует знак умножения) оператор Е к функции /^) . Таким образом, примененный к функции в текущий момент времени, такой оператор позволяет записать (формально) значение функции в предыдущий (прошлый) момент времени.

^

0

н

ф

1

ш

о

ф *

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

о

ф CL

о со о

X

о о

к го

го со о

CL S п о н

X S

о

<в d о со

S CL

с

о

CL

£ ф

ц

о

.0 ц

ф

4 о

к

2

о ф

У

5

н

го ф

н

го

к го X

q

о с

о

S 0_

6. Свойства Е-оператора сдвига

На множестве действительных чисел Е-оператор «по умножению» и «по сложению» образует алгебру - коммутативную (Абелеву) группу, обладая следующими свойствами:

I) с ■ Е = с, т. е. константа инвариантна к сдвигам во времени;

2а) f ^) = f ^) ■ Е0, откуда 1 ■ Е0 = 1, т. е. единичный элемент по умножению;

2б) f ^ - dt) = (f ^) + 0) ■ Е = f ^) ■ Е + 0 ■ Е , откуда 0 ■ Е = 0 , т. е. нулевой элемент по сложению.

Коммутативные законы:

3) (f ^) + ф^)) ■ Е = (ф(0 + f ^)) ■ Е , «по сложению»;

4) (f ^) ■ ф^)) ■ Е = (ф^) ■ f ^)) ■ Е , «по умножению».

Дистрибутивные законы:

5. (f ^) + ф(t)) ■ Е = f ^) ■ Е + ф(t) ■ Е, «по сложению»;

6. (f ^) ■ ф^)) ■ Е = (f ^) ■ Е) ■ (ф(t) ■ Е), «по умножению».

Прочтение этих же выражений «справа налево» тоже верно и дает ассоциативные законы «по сложению» и «по умножению».

И еще:

А-кратное применение оператора к функции:

7) f ^ - Л) = f ^) ■ Е;

8) f ^ - 2Л) = f ^ - Л) ■ Е = f (t) ■ Е2 ;

9) f ^ -п^) = f ^ - (п - 1)Л) ■ Е = f ^ - (п - 2)Л) ■ Е ■ Е =... = f ^) ■ Еп.

Правила дифференцирования:

10) ^¿к ) = limAt^0( / (t) - /^ -АО)/ At = /^) ■ (1 - Е)/ dt. Здесь Л - «квант времени» (он достаточно мал);

Лп / (t)

II) —= /(t) ■ (1 - Е)п / , где (1 - Е)п - полином, может быть разложен в ряд Макло-

Ап

рена или по формуле бинома Ньютона.

Введенное понятие (Л) - «квант времени» связано с необходимостью квантования непрерывной функции для представления ее в дискретном (табличном) виде. Величина кванта выбирается существенно меньшей по сравнению с любой из постоянных времени исследуемого процесса.

7. Способ реализации разностных последовательных алгоритмов

на основе регистров сдвига и УВХ

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

Для программной реализации Е-оператора понадобится организовать в оперативной памяти ЭВМ стек нужного размера, чтобы при реализации не терять время на перемещения чисел в массиве, а перемещать только указатель стека.

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

7.1. Методологический прием для построения экономичного алгоритма

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

Пусть задано некоторое неоднородное линейное дифференциальное уравнение 2-го порядка (для простоты) с постоянными коэффициентами: а2 ■ / ) + а1 ■ /'(/) + а0 ■ /(/) = д^).

Используя предложенный выше оператор Е-сдвига, преобразуем это уравнение в разностный вид:

(1 - Е)2 (1 - Е)

«2 • f (() • --+ а1 • f (}) • ^-тт1 + ао • f (О = Я(().

сИ2 С}

Не следует забывать, что здесь & является не дифференциалом аргумента, а конечной алгебраической величиной - квантом времени.

Раскрывая скобки и используя свойства Е-оператора, получим:

«г • (f (}) - 2 • f (}) • Е + f (}) • Е2) + § • (f (О - f (}) • Е) + «о • f (}) = д(Г).

Ж1 С}

Теперь решим это уравнение относительно У}):

^) + (^ - «) • f « • Е - «2 • f с) • Е2

у-=_С}2 С}_Ст._

а2 а, '

+«+«о

Полученная формула показывает, что решением УО является линейная комбинация текущего значения функции со своими же значениями в соседние «прошлые» моменты времени и возмущения д(0. Очевидно, что это свойство линейной комбинации справедливо для линейного дифференциального уравнения любого порядка. Тогда в общем виде можно получить:

У(}) = а, • у(}) • Е + «2 • У(}) • Е2 + р • д(})).

Вынесем за скобки коэффициент К, такой, чтобы оставшиеся коэффициенты слагаемых удовлетворяли условиям: |а, / К| < 1, |а2 / К| < 1, р / К| < 1. Для этого достаточно выбрать значение для К больше самого большого из всех коэффициентов уравнения. Тогда получим:

У (0 = К • (К • У (}) • Е + «2 • у (}) • Е2 + д(Г)).

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

Аппаратно значения функции У} - С), У} - 2С) легко получить с помощью регистров сдвига, роль которых выполняют аналоговые линии задержки с соответствующим количеством отводов (в данном случае - с двумя). Еще лучше нетрадиционно использовать УВХ в микросхемном исполнении.

В программном же исполнении значения функции У} - С), У} - 2С) следует получить с помощью последовательного массива-стека, перемещая только указатель текущей позиций действительных чисел, а не сами числа.

7.2. Синтез разностных последовательной и параллельной

математических моделей синапсического входа

Преобразуя дифференциальное уравнение (7) с помощью Е-оператора сдвига к разностному виду

р* (}) • ^Т"• Т • Т2 + (}) • • (Т + т2) + (}) = К • 8(г) Л}2 Л}

и разрешая его относительно (}) , получим разностную последовательную математическую модель синапсического входа

s(t) • К, - Fs(t) • E2 • (^)+ Fs(t) • E • + ^)

At2 At2 At

F (t)=-r, T r, + r2 ,-— • (19)

1 2 + —-2 + 1

At2 At

где At - интервал времени квантования процесса.

Разностный параллельный алгоритм синапсического входа позволяет декомпозицией понизить порядок линейных дифференциальных уравнений. Для синтеза разностной параллельной математической модели представим уравнение (6) в виде суммы простых рациональных дробей:

Ъ (р) = • (- ^^). (20)

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

' Т1 - Т2 1 + рТ1 1 + рТ2

_ . , ч '(р) • Т , , '(р) • Т2

Обозначим изображения слагаемых: Л1 (р) =-- и Л2 (р) =--.

1 + рТ1 1 + Т2

Тогда, с учетом введенных обозначений, получим систему дифференциальных уравнений:

Л1(г )Т +ВД = Т • );

+ ) = Т2 • ); (21)

Ъ (/) = -К- • (Л^)-Л 2^)).

Т1 - Т2

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

Т •' (t ) + Л1 (t )• Е Т •А/)

Л (/ ) = ■

Т •А/+1

. М Т2 ^ ' ) + Л2 )• Е (Т2 ^-1)

Л2 ) =---Т-^-; (22)

Т2 •АГ1 +1

Ъ (/)=-К^~ • (МО-Л2(/)).

Т1 - Т2

7.5. Синтез разностной математической модели позиционного контура

Преобразуя дифференциальное уравнение (10) к разностному виду с помощью Е-оператора сдвига:

из (/) • (1 - Е ) • Т1 • А/+ из (/) = и2 (/) • К1, получим уравнение математической модели позиционного контура:

из (/) = (и2 (/) • К1 - и3(/) • Е • Т1 • А/_1) (т1 • А/+1)-1. (23)

7.4. Синтез разностных последовательной и параллельной

математических моделей контура скорости

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

) = К • (-Т • А/-1 • и А(Г) • Е + (Т1 • А/-1 +1) и (/));

ц-и5(/) • Е2 • Т2 • Т3 •А/"2 + и5(/) • Е •( 2 • Т2 • Т3 •А/"2 +(Т2 + Т3 ^АГ1) (24)

и (/) =_-_-

5 Т2 • Т3 •А/"2 +(Т2 + Т3)А/_1 +1

Разностный параллельный алгоритм контура скорости позволяет декомпозицией понизить порядок линейных дифференциальных уравнений. Для синтеза разностной параллельной математической модели контура скорости представим уравнение (13) в виде суммы простых рациональных дробей:

V р) =

и 4 (р) • (Т - Т1).

(1+рТ2) ;

Л2(р) = и 4((р+ (Т - Т1); (25)

(1 + рТ3)

и5( р) = 7^^ • (-V р) + Л 2 (р)).

Т3 -Т2

Уравнениям (25) соответствуют два дифференциальных уравнения первого порядка с постоянными коэффициентами и правой частью и одно линейное уравнение:

^(0 ■ 72 + ВД = и4(0■ (72 -Т); Х7(0 ■Тз + ^(0 = U4(t) ■ (73 -71); ВД = -К— ■ (-^(0 + ^(0),

73 - 72

преобразуя которые с помощью Е-оператора сдвига, получим уравнения параллельной разностной математической модели контура скорости:

и4 (t )(7 - 71 ) + (t )■ Е ■ 72А

X (t) = -

T2At_1 +1

/ч U4 (t)(T3 -?1) + X7 (t)• E • T3At"

X 2 (t) = -U 2W-3-; (26)

2W T3At+1

U5 (t) = Ki (T3 - T2 )^(-Xi (t) + X2 (t)) .

7.5. Синтез разностной математической модели контура тока

Преобразуя дифференциальные уравнения (17) к разностному виду с помощью Е-оператора сдвига, получим математическую модель «контура тока»:

ß(t) = K1 • (-T1A-1 • U6 (t) • E + (T1At-1 +1) • U6 (t));

^(t)-U 5 (t> E2 • T2 • T3 •At"2 + U5 (t> E • (2 • T2 • T3 •At"2 +(T2 + T3 )At"1) (27)

U5 (t) = -----:-- .

T2 • T3 •At"2 +(T2 + T3)At_1 +1

Разностный параллельный алгоритм контура тока позволяет декомпозицией понизить порядок линейных дифференциальных уравнений. Для синтеза разностной параллельной математической модели контура тока представим уравнение (16) в виде суммы простых рациональных дробей: T - T T - T

U7 (p) = K1 • (U6 •tT-tL- + U6 • T-Hf"). (28)

1 + P • T2 1 + P • T3

Обозначим изображения слагаемых:

M P) = U6(P) ^ -2) и X 2( p) = U6(P)-<T3--1) .

1 + p • T1 1 + p • T3

Тогда, с учетом введенных обозначений, получим систему дифференциальных уравнений:

X1(t) • -1 + X1 (t) = U6(t) • (T1 - -2);

X'2 (t) • T3 + X2 (t) = U6 (t) • (T3 - -1); (29)

U7 (t) = K1 • (X1 (t) + X2(t)).

Преобразуем два уравнения из (29) к разностному виду с помощью Е-оператора сдвига: X1 (t) = (1 - E ) • At-1 • -1 + X1 (t) = U6 (t) • (-1 - T2 ); X2 (t) = (1 - E ) • At-1 • T3 + X2 (t) = U6 (t) • (-2 - -1).

И, окончательно, получим систему уравнений разностной параллельной математической модели контура тока:

X (t) = U6(t)•(- --2) + X1 (t)• E-1 •At-1; ^ ' T1 •At"1 +1 ;

/4 U6 (t )•(- - - ) + X2 (t )• ET3 •At"1

X2(t)= 6W V 3-^-^-3-; (30)

T3 •At"1 +1

U7 (t) = K1 • (X1 (t) + X 2 (t)).

Полный последовательный разностный алгоритм управления следящим приводом показан на рис. 3. Параллельный алгоритм показан на рис. 4. Он менее громоздкий, обеспечивает большее быстродействие и может быть реализован даже «конвеерным» способом с помощью нескольких сопроцессоров одновременно.

Сафронов В.В.

со С1

о т

о

к

4 о с;

о

5

С1 О

>5

О ^

О

о

Т

о н (С 2

СР

о

с;

н

о о

X

со (С СР

.0 с; о н

ш о

С1

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

о с; о о

т о а

СО О

н

О со (3 0_

^

о со

ш В

а

ш ц

о

ц

ф

d о

>S

о *

о ф

т S

н

го ф

н

го

н

S CL

о

I-

е;

го >s

X

н

о о

X

со го

CL

.0

с; ф

q ц

го а го

го со о а

S

со

12 X S

о

Сафронов В.В.

Заключение

1. Предложенный метод удобен для синтеза последовательных и параллельных алгоритмов следящих систем, реализуемых программно.

2. Аппаратную реализацию алгоритмов можно выполнить на основе нетрадиционно используемых УВХ [6].

3. Полученные результаты могут быть использованы в мехатронике [5], робототехнике, в теории управления [1] и автоматического регулирования [2], в практике построения следящих электроприводов.

Литература

1. Попов, Е.П. Теория линейных систем автоматического регулирования и управления / Е.П. Попов. - М.: Наука, 1989. - 733 с.

2. Усынин, Ю.С. Теория автоматического управления: учеб. пособие для вузов / Ю.С. Усы-нин. - Челябинск: Издат. центр ЮУрГУ, 2010. - 176 с.

3. Дьяконов, В. Математические пакеты расширения МАТЬЛВ. Специальный справочник / В. Дьяконов, В. Круглов. - СПб.: Питер, 2001. - 488 с.

4. Домрачев, В.Г. Схемотехника цифровых преобразователей перемещений / В.Г. Домрачев, В.Р. Матвеевский, Ю.С. Смирнов. -М.: Энергоатомиздат, 1987. - 392 с.

5. Смирнов, Ю.С. Электромехатронные преобразователи /Ю.С. Смирнов; под ред. А.Л. Шес-такова. - Челябинск: Издат. центр ЮУрГУ, 2013 - 361 с.

6. Сафронов, В.В. Теория и практика применения датчиков угла поворота на основе СКВТ / В.В. Сафронов //Компоненты и технологии. - 2014. - № 4 (апрель). - С. 58-62.

Сафронов Виктор Валентинович, канд. техн. наук, старший научный сотрудник, ведущий научный сотрудник, ФГУП «Центральный научно-исследовательский институт машиностроения» (Роскосмос), г. Королёв; [email protected].

Поступила в редакцию 20 марта 2015 г.

DOI: 10.14529/ctcr150205

SYNTHESIS OF DIFFERENTIAL CONTROL ALGORITHM OF THE DIGITAL TRACKING ELECTRIC DRIVES OF MOBILE ROBOTSM BY E-OPERATOR METHOD

V.V. Safronov, Federal State Unitary Enterprise Central Research Institute of Mechanical Engineering (Roskosmos), Korolev, Russian Federation, [email protected]

The mathematical E-operating method is intended for transformation of the of differential equations system to the tracking electric drive mathematical model equations system. In contrast to the known algorithms for numerical integration, for example, in the Matlab-Simulink, ^-method allows to synthesize of the transfer function of tracking electric drives for both sequential and parallel differential algorithms for working in real time on the basis of both software and hardware shifting registers. It is important to note that these algorithms cannot be implemented using Matlab-Simulink. Parallel algorithm provides greater performance than serial algorithm. Parallel algorithm can be implemented "conveyor" method of using multiple coprocessors at the same time.

Method is an alternative of the means available in Matlab-Simulink programme for description and analysis of the tracking electric drive model. In the first part of the article the synthesis algorithm using traditional means of differential calculus and Laplace transforms describes. In the second part of the article a solution of the same problem with the use of the E-operating method presents.

The results obtained can be used in mechatronics, robotics, automatic control theory, in the practice of building looking for tracking electric drive.

Keywords: control, witness of the electric drive, parallel and serial algorithm, differential equations, transfer functions, integrators, shift registers, real time.

References

1. Popov E.P. Teoriya lineynykh sistem avtomaticheskogo regulirovaniya i upravleniya [The Theory of the Linear Systems of the Automatic Regulation and Control]. Moscow, Science Publ., 1989. 733 p.

2. Usynin Yu.S. Teoriya avtomaticheskogo upravleniya: uchebnoe posobie dlya vuzov [Theory of Automatic Control: Tutorial for Students]. Chelyabinsk, SUSU Publ., 2010, 176 p.

3. D'yakonov V., Kruglov V. Matematicheskie pakety rasshireniya MATLAB. Spetsial'nyy spra-vochnik [Mathematical MATLAB Expansion Packs. A Special Handbook]. St. Petersburg, Piter Publ., 2001. 488 p.

4. Domrachev V.G., Matveevskiy V.R., Smirnov Yu.S. Skhemotekhnika tsifrovykh preobrazovate-ley peremeshcheniy [Circuit Design of Digital Converters Displacements]. Moscow, Energoatomizdat Publ., 1987. 392 p.

5. Smirnov Yu.S. Elektromekhatronnye preobrazovateli [Ectromechatronics Converters]. Chelyabinsk, South Ural St. Univ. Publ., 2013. 361 p.

6. Safronov V.V. [Theory and Practice Using of the Encoders Based on Sine-Cosine Rotary Transformer]. Components and Technologies, 2014, no.4, pp. 58-62. (in Russ.)

Received 20 March 2015

БИБЛИОГРАФИЧЕСКОЕ ОПИСАНИЕ СТАТЬИ

Сафронов, В.В. Синтез разностных алгоритмов управления цифровыми следящими электроприводами мобильных роботов Е-операторным методом / В.В. Сафронов // Вестник ЮУрГУ. Серия «Компьютерные технологии, управление, радиоэлектроника». -2015. - Т. 15, № 2. - С. 42-54. Ш1: 10.14529/Ссг150205

REFERENCE TO ARTICLE

Safronov V.V. Synthesis of Differential Control Algorithm of the Digital Tracking Electric Drives of Mobile Robots by (E)-Operator Method. Bulletin of the South Ural State University. Ser. Computer Technologies, Automatic Control, Radio Electronics, 2015, vol. 15, no. 2, pp. 42-54. (in Russ.) DOI: 10.14529/ctcr150205

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