Следящая система

 

СЛЕДЯЩАЯ СИСТЕМА, содержащая последовательно соединенные блок задания программа я триггер, последовательно соединенные задатчик, блок сравнения, пороговый блок и i первый логический блок, последовательно соединенные коммутатор и шаговый двигатель, механически соединенный выходом с входами датчика шагов и объекта регулирования, выход последнего механически соединен с ;входом датчика регулируемой координаты , соединенного выходом с вторым входом блока сравнения, первый выход датчика шагов соединен с входом блока задания программы и вторым входом триггера, отличающаяс я тем, что, с целью повышения точности , быстродействия и помехоустойчивости систекы, в ней дополнительно установленй второй и третий логические блоки,, широтно-импульсный модулятор и блок выделения модуля, входом соединенный с выходом блока . сравнения, а выходом через широтнримпульсный модулятор - с первым входом коммутатора, второй вход которого подключен к выходу порогового блока, а третий и четвертый входы к выходам соответственно второго и третьего логических блоков, котоЕие § первыми входами подключены к выходу (Л триггера, вторыми входами - соответственно к первому и второму выхрдеш первого логического блока, а третьими входами - соответственно к треть ему и четвертому выходам датчика ша- S гов, первый и второй выходы которого соединены соответственно 1с вторым и третьим входами первого логического блока. 00 05 S

СОЮЗ СОВЕТСКИХ

СОЦИАЛИСТИЧЕСКИХ

РЕСПУБЛИК

3(51) 05 В 11 14!

ОПИСАНИЕ ИЗОБРЕТЕНИЯ,/

К АВТОРСКОМУ СВИДЕТЕЛЬСТВУ

/,, t r

ГОСУДАРСТВЕННЫЙ НОМИТЕТ СССР

ПО ДЕЛАМ ИЗОБРЕТЕНИЙ И ОТКРЫТИЙ (21) 3476445/18-24 (22) 28.07.82 (46) 23.03.84. Бюл. 9 11 (72)Б.A.Êóäðÿøîâ, С.П.Пащук и Ю.С.Смирнов (53) 62-50(088.8) (56) 1, Авторское свидетельство СССР

Р 237228, кл. Gj 05 В 11/14,,1968.

2..Авторское свидетельство СССР

9 547726, кл. Q 05 В 11/01, 1975 .

3. Авторское свидетельство СССР

9 585474, кл. С 05 В 11/14, .1975 (прототип ) . (54)(57) СЛЕДЯЩАЯ СИСТЕМА, содержащая последовательно соединенные блок задания программы и триггер, последовательно соединенные задатчик, блок сравнения, пороговый блок и первый логический блок,.последовательно соединенные коммутатор и шаговый двигатель, механически соединенный выходом с входами датчика шагов и объекта регулирования, выход последнего механически соединен с входом датчика регулируемой коорди- наты, соединенного выходом с вторым входом блока сравнения, первый выход

„„SU„„1081622 A датчика шагов соединен с входом блока задания программы и вторым входом триггера, о т л и ч а ю щ а яс я тем, что, с целью повышения точности, быстродействия и помехоустойчивости система, в ней дополнительно установлены второй и третий логические блоки,.широтно-импульсный модулятор и блок выделения модуля, входом соединенный с выходом блока сравнения, а выходом через широтноимпульсный модулятор — с первым входом коммутатора, второй вход которого подключен к выходу порогового блока, а третий и четвертый входы— к выходам соответственно второго и третьего логических блоков, которые Е

O первыми входами подключены к выходу триггера, вторыми входами - соответственно к первому и второму выходам первого логического блока, а треть- . ими входами - соответствейно к третьему и четвертому выходам датчика ша- Я гов, первый и второй выходы которо- . го соединены соответственноlc вторым и третьим входами первого логического блока.

1081637

Изобретение относится к системам автоматического управления и может быть использовано в автоматических измерительных приборах, автоматизированном электроприводе при измерении, контроле и регулировании различных параметров, в станках с программным управлением, робототехнических комплексах и т.д.

Известна следящая система, содержащая последовательно соединенные 10 блок сравнения, усилитель, блок управления и шаговый двигатель, а также блок управления скоростью, вход которого соединен с выходом усилителя. а выход — с входом блока сравнения (11.

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

Известна также следящая система, содержащая измеритель рассогласования, выход которого соединен с входом порогового устройства, триггер, первый и второй элементы И,первый элемент ИЛИ, распределитель импульсов, ключ, усилитель мощности, выход которого соединен с входом шагового двигателя, который через исполнительный механизм соединен с входом измерителя рассогласования и через датчик шагов с первым входом двоичного счетчика, второй вход которого через третий элемент И соединен с выходом генератора импульсов, четвертый элемент И, второй и третий элементы ИЛИ, первый и второй зле 40 менты НЕ н логический блок, входы которого соединены соответственно с выходами распределителя импульсов, второго и третьего элементов

ИЛИ и четвертого элемента И, а вы- 45 ход — с входом усилителя, выходы порогового устройства соединены с соответствующими входами первого элемента ИЛИ и триггера, выходы которого соединены с соответствующими 50 входами распределителя импульсов, первый вход. первого элемента И соединен с первым выходом триггера, а выход — с первым входом третьего элемента ИЛИ, второй вход которого соединен с первым выходом порогового устройства, первый вход второго элемента И соединен с вт -рым входом триггера, а выход — с первым входом второго элемента ИЛИ, второй вход которого ccrc 60 динен с вторым выходом порогового устройства, вход первого элемента

НЕ соединен с выходом первого элемента ИЛИ, первый выход — с вторыми входами первого и второго элементов g5

И и первым входом четвертого элемента И, второй вход которого соединен с входом второго элемента НЕ и выходом двоичного счетчика, а выход — с управляющим входом ключа, вход которого соединен с выходом дат чика шагов, а выход — c входом распределителя импульсов, выход второго элемента НЕ соединен с третьими входами первого и второго элементов И и втсуым входом третьего элемента И (21.

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

Наиболее близкой по технической сущности является следящая система, содержащая блок сравнения, к первому и второму входам которого подключены соответственно задатчик и датчик регулируемой величины, блок усилителей, выходы которого соединены соответственно с входами блока определения знака скорости и с обмотка- ми управления шагового двигателя, который механически соединен с датчиком шагов и через объект регулирования с датчиком регулируемой величины, коммутатор, один из входов которого подключен соответственно к выходам датчика шагов и входам бло ка усилителей, блок задания программы и логический блок, первые входы которых подключены к выходу блока сравнения, первый, второй и третий выходы блока задания программы соединены соответственно с вторым, третьим и четвертым входами логического блока, к пятому и шестому входам которого подключены соответст» венно выходы блока определения знака скорости, первый, второй и третий выходы логического блока соединены соответственно с другими входами коммутатора, четвертый выход логического блока подключен к второму входу блока задания программы, к другим входам которого подключены соответственно выходы датчика шагов, причем логический блок содержит пороговый элемент, вход которого подключен к первому входу логического блока, первый и второй выходы порого вого элемента соединены соответственно с первым и вторыми входами первого элемента ИЛИ и триггера, первый выход соединен с первыми входами четвертого, пятого и шестого эле1081622 ментов И, второй вход логического блока соединен с вторыми входами третьего и пятого элементов И, третий вход — с вторыми входами второгс и шестого элементов И, четвертый вход — с первым входом седьмого элемента И, пятый вход — с вторым входом четвертого и с третьими входами второго и третьего элементов И, и шестой вход — с вторым входом первого и с третьими входами пятого и !О шестого элементов И, выход первого элемента ИЛИ соединен с четвертым выходом логического блока и через первый элемент HE с вторым входом седьмого элемента И, выход которого !5 подключен к третьему выходу логического блока и через второй элемент.НЕ к третьим входам первого и четвертого и к четвертым входам второго, третьего, пятого и шестого элементов И, выходы первого, второго и пятого элементов И через, второй элемент ИЛИ подключены к первому выходу логического блока, к второму выходу которого через третий элемент ИЛИ подключены выходы третьего, четвертого и шестого элементов

И, а блок задания программы содержит нуль-орган, первый вход которого через. усилитель соединен с первым входом блока задания. программы, второй вход которого через дифференцирующую цепь подключен к первому входу первого элемента И, выход которого соединен с первыми входами первого и второго элементов ИЛИ, к З5 второму входу первого из которых через элемент задержки подкЛючен вы. ход третьего элемента ИЛИ, выход первого элемента ИЛИ соединен с пер. вым входом счетчика и через первый 40 генератор развертки с входами первого и второго пороговых элементов, первый и второй ВЫходы первого поро гового элемента подключены соответственно к пеРвым входам второго и 45 третьего элементов И, выходы которых соединены соответственно с вторым входом второго элемента ИЛИ и с первым входом триггера, к второму ВхОду кОтОРОГО пОдключен Выход второго элемента ИЛИ, выход нуль-органа соединен с выходом формирователя импульсов, выход которого подключен к второму входу. счетчика и через второй генератор развертки к второму входу нуль-органа, выход счетчика через преобразователь коданалог соединен с вторым входом пЕРвого порогового элемента, другие вхс ды блока задания программы подключены соответственно к входам треть- 60 его элемента ИЛИ, выход которого сое динен с вторыми и третьими входами

Второго и третьего элементов И, а первые и вторые выходы триггера и вторОго порогового элемента соединены соответственно с первым, вторым, третьим выходами блока задания программы и с вторым входом первого элемента И С37.

Недостатками известной системы являются ее низкие точность, помехоустойчивость и быстродействие.

Целью изобретения является повышение точности, помехоустойчивости и быстродействия следящей системы.

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

На фиг. 1 представлена функциональная схема системы; на фиг ° 2 принципиальная электрическая схема шагового двигателя с Датчиком шагов; на фиг. 3 и 4 — временные диаграммы, поясняющие работу бесконтактного привода постоянного тока; на фиг. 5 и 6 — механические и регулировочные характеристики бесконтактного привода постоянного тока; на фиг. 7 — временная диаграмма, поясняющая работу следяющей системы в целом.

Система включает блок 1 сравнения, блок 2 выделения модуля, широт но-импульсный модулятор 3, пороговый блок 4, бесконтактный привод 5 постоянного тока, логический элемент б, первый и второй элементы

1081622."! 7 и 8, первый, второй, третий и етвертый элементы И 9-12, усилитель 13 мощности, шаговый двигатель l4 с ротором 15 и обмотками 16 управления, датчик 17 шагов с кодо вым диском 18 и чувствительными эле. ментами 19-22, объект 23 регулировавания, датчик 24 регулируемой координаты, первый, второй и третий логические блоки 25-27, блок 28 задания программы, высокочастотный ге- 10 нератор 29 импульсов, элемент. ЗАПРЕТ

30, двоичный счетчик 31, триггер 32, задатчик 33, коммутатор 34.

На фиг. 2-7 обозначено задающее воздействие 03ä, угол 6 поворота 15 ротора 15, регулируемая координата

Q на выходе объекта 23 регулировь(к вания, скорость Я и вращающий момент в шагового двигателя 14 в абсолютных единицах, угол V коммутации скорость ш и вращающий момент » шагового двигателя 14, в относительных единицах, сигнал UI на 1-м выходе

j-го функционального блока, текущее время . Коэффициент Е заполнения 25 при широтно-импульсной модуляции.

Блок 1 сравнения определяет разность между задающим воздействием

0 с, и значением регулируемой коордййаты Я „,, измеряемым датчиком 24 регулируемой координаты, и формирует эту разность в виде напряжения постоянного тока. Блок 2 выделения модуля имеет характеристику

U npu U О, 02 = к

35 т.е. OZ =Щ .

Блок 28 задания программы имеет релейную характеристику

Широтно-импуль сный модулятор 3 преобразует сигнал в последовательность положительных прямоугольных им- 40 пульсов, коэффициент заполнения Е которой прямой пропорционален величине напряжения 02 . Пороговый блок 4 имеет два устойчивых состояния и формирует логический сигнал в соот- 45 ветствии с выражением:

0 I1, при U„ >„ О, 4 0, при 0„ с О.

Бесконтактный привод постоянного тока 5 содержит в своем составе ком-, мутатор 34, шаговый двигатель 14, датчик 17 шагов, первый, второй, третий логические блоки 25-27 и триггер 32. В свою очередь коммута- тор 34 состоит из логического элеЪ мента 6, элементов НЕ 7 и 8 и элементов И 9-12 и усилителя 13 мощности. Причем логический элемент 6 коммутатора 34 преобразует выходные сигналы второго и третьего логических блоков 26 и 27 в зависимости от 60 значения выходного сигнала U поро. гового блока 4 по следующим переклю ,чательным функциям

0 =00 ч0 О, Ô 2 . 42ò 65

Полученные на выходе логического элемента 6 сигналы U и U с помощью элементов НЕ 7 и 8 и элементов И 9-12 преобразуются в широт. но-импульсно-модулированные сигналы управления, который после усиления их усилителем мощности 13 переключают обмотки 16 управления шагового двигателя 14. Для простоты изложения в качестве примера рассматривается шаговый двигатель 14, имеющий на роторе 15 одну пару полюсов и на статоре четыре обмотки 16 управления. Если шаговый двигатель 14 имеет ротор 15 с несколькими парами полюсов, то изменяется соответствующим образом конфигурация кодового диска 18, причем количество выступов на нем делается равным числу пар полюсов ротора 15. Датчик 17 шагов состоит из подвижного кодового диска 18, жестко связанного с ротором

15, и неподвижных чувствительных эле ментов 19-22, например, фотоэлектрического типа.

Если:кодовый диск 18 перекрывает световой поток данного чувствительного элемента 19 (или 20, или 21,, или 22 ), то его выходной сигнал 0„„ равен нулю, в противном случаеединице.

Расположение чувствительных элементов 19-22 относительно обмоток 16 управления и кодового диска 18 относительно ротора 15 должно быть та- ким, как показано на фиг, 3. При таком расположении сигналы O„„„ U,„ чувствительных элементов 19 и 20 мож но непосредственно использовать для управления шаговым двигателем. 14 в режиме нейтральной коммутации. Для создания сигналов управления в режиме опережающей коммутации сигналы 0, э

U4„ чувствительных элементов 21 и 22 нуждаются в предварительном преобразовании. При этом в первом логическом блоке 25 они преобразуются в соответствии с переключательными функциями и 040 Ои40 0uu„=00„v„4

-Э - 4 2= 4чдОЗ

В зависимости от выходного сигнала U триггера 32 второй и третий логические элементы 26 и 27 подключают к входам логического элемента 6 коммутатора 34 либо выходные сигналы чувствительных элементов 19 и 20, ли. бо выходные сигналы первого логического элемента 25 в соответствии с переключающими функциями ч0 0";0 =U 0 чО 02

26 Э2 al Э2 25 2 Э2 1т 32 25

1081622 — (Й- ) (10

15 (и=f (w f1

11у при )Я(п $0, при )Я1 где д — некоторое, пороговое значение скорости шагового двигателя 14, построен на основе принципа заполнения временного интервала импульсами высокой частоты и по своему конструктивному составу он аналоги чен блоку измерения скорости известной следящей системы.

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

Следящая система работает сле. дующим образом.

Вначале рассмотрим работу бесконтактного привода постоянного тока 5 при отсутствии широтно-импульсноймодуляции, т.е. при (U3 =1).

Работа бесконтактного привода 5 постоянного тока в режиме нейтральной коммутации (т.е. при М =01 и в режиме опережающей коммутации (т.е, при-. М =45 ) поясняется временными диаграммами, приведенными на фиг.3 и 4 соответственно. Угол коммутации о

9=у О« — 90, где у — угол поворота вектора поля статора; 6 — среднее эа период коммутации значение угла поворота ротора 15. Пусковой момент шагового двигателя 14 про порционален 5(п(7 -g).

Как видно из диаграмм (фиг. 3 и 4} среднее значение пускового момента при ч =О больше, чем при =45, но по мере увеличения скорости шагового двигателя 14 это соотношение изменяется на противоположное за счет постоянной времени обмоток 16 управления шагового двигателя 14. Это подтверждается уравнением механической характеристики шагового двигателя 14 в режиме бесконтактного двигателя постоянного .тока, которое в относительных единицах может быть записано в виде

COS4 + (Z(q ) 54пЧ -.и>

Q=М

2 2

1+ ы (м ./ () где $ - внутреннее демпфирование шагового двигателя 14;

F- - -безразмерная постоянная времени обмоток 16 управления; безразмерный коэффициент;

Ю вЂ” угол коммутации;

w - скорость шагового двигателя

14 в относительных единицах.

Пользуясь этим уравнением, можно построить механические характеристики бесконтактного привода постоянного тока 5 при угле коммутации М=О и V =45 (фиг.5 ). Таким образом, если в укаэанном приводе осуществлять переключение угла коммутации при достижении относительной скорости

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

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

Регулировочные характеристики системы в этом случае имеют вид, указанный на фиг.6 °

Поскольку в данной системе подключение выходных сигналов логических элементов 25-27 к входам коммутатора 34 определяется программой, заданной в блоке 28 задания программы, то рассмотрим более подробно работу этого блока. На вход блока 28 .задания программы поступает сигнал

30 с выхода чувствительного элемента 22 датчика 17шагов в виде последовательности прямоугольных импульсов.

При поступлении очередного импульса двоичный счетчик 31 устанавлива35 ется в нулевое положение. В паузе между импульсами сигнал установки двоичного счетчика 31 снят и производится счет импульсов генератора

29, поступающий на счетный вход дво40 ичного счетчика 31 через элемент

ЗАПРЕТ 30. Счет импульсов происходит до тех пор, пока на выходе двоич ного счетчика 31 не возникнеТ..сигнал переноса и не запретит дальнейшее

45 прохождение импульсов через элемент

ЗАПРЕТ 30.либо до прихода следующе.го импульса на вход блока 28 задания программы. В первом случае передним фронтом этого импульса в триггер

32 запишется потенциал логической единицы, свидетельствующий о том, что пауза между импульсами велика, т.е. )Я1 4 Q„, во втором случае запишется потенциал логического нуля.

Работа следящей системы при синусоидальном и скачкообразном задающих воздействиях V д поясняется временной диаграммой, приведенной на фиг.7. Система при скачкообразном задающем воздействии работает следующим образом. В первом временном интервале 11- С2 блок 1 сравнения вырабатывает большой положительный сигнал рассогласования Vz который через блок 2 выделения модуля поступает на вход широтно-импульсного мо1081622

10 дулятора 3 и вводит его в насыщение (Ц =1 ). Пороговый блок 4 определяет требуемое направление перемещения, и бесконтактный привод 5 постоянного тока начинает разгоняться при нейтральной коммутации. В момент времени t скорость привода Я достигает значения g„, и триггер 32 вырабатывает сигнал перехода на опережающую коммутацию (М g =0 1. Дальнейший разгон шагового двигателя 14 происходит на опережающей коммутации При подходе к согласованному положению широтно-импульсный модулятор 3 переходит из эоны насыщения в линейную зону, сигнал 0> становится последовательностью импульсов, пропорционально скважности которой уменьшается вращающий момент шагового двигателя 14 и в системе начинается процесс торможения. В момент вре мени 1 сигнал рассогласования

0 на выходе блока 1 сравнения из1 меняет знак, сигнал 04 на выходе порогового блока 4 становится равным нулю, и бесконтактный привод по. стоянного тока 5 переходит в режим торможения противоключением. Начиная с момента времени бесконтактный привод постоянного тока 5 переходит в режим нейтральной коммутации, и дальнейший процесс отработки происходит на этой коммутации. Процесс отработки синусоидального сигнала происходит аналогичным образом (фиг. 7) и в дополнительных пояснениях не

10 нуждается.

Указанные отличительные особенности предлагаемой следящей системы позволяют более полно использовать энергетические воэможности шагово 5 ro двигателя за счет переключения угла коммутации:и тем самым увеличить быстродействие системы в 2-5 раз, в .зависимости от типа применяемого шагового двигателя, повысить не менее,.чем в два раза ее статическую точность и.примерно в восемь раз повысить помехоустойчивость по сравнению с известной системой; Все зто, в конечном счете, ведет к повышению производительности оборудования и улучшению качества продукции.

1081622

1081 622

1 (i 83 622 г

Ил=4 тт т.

>rs

Ыг а

4 тт

@uz 4

1081622

ВНИИПИ Заказ 1550/43 Тираж 842 Подписное

Филиал ППП "Патент", r. Ужгород, ул. Проеткная,4