Устройство для регистрации положения движущегося объекта Советский патент 1993 года по МПК G01B7/30 

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

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

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

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

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

датчик нарушения внешнего питания, канал формирования автономного питания, преобразователь аналог-цифра соединенный с выходом датчика углового положения, двухпозиционный переключатель, первый вход которого соединен с выходом блока сервоуправления, второй вход - с выходом канала формирования автономного питания, при этом выход двухпозиционного переключателя соединен с датчиком углового положения, блок обработки выполнен в ви00Сл Os О

ю

СА)

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

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

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

В частности подразумевается, что такое возбуждение может быть выполнено в основном на низкой частоте {например, с пери одом возбуждающего импульса 20-500 мсек), когда преобразователь обнаружит, что движущаяся часть, с которой он связан, остановилась или почти остановилась. С другой стороны, когда преобразователь обнаружит значительное перемещение движущейся части, возбуждающая частота

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

На фиг. 1 представлена блок-схема общей структуры прибора, соответствующего изобретению; на фиг. 2 - возможная временная диаграмма возбуждающего сигнала,

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

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

двигателем 1, вал которого вращается вокруг соответствующей оси XL

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

ся прямая связь между положением,

достигаемым валом двигателя 1 во время последовательных вращений вокруг оси xi, и положением, достигаемым движущейся частью во время перемещения,

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

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

5 осей движения.

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

0 V.

Как известно, синус-косинусный вращающийся трансформатор можно сравнить с небольшой вращающейся электрической машиной, состоящей из ротора и статора с

5 двумя обмотками, расположенными под углом 90° (или, наоборот, с двумя обмотками, расположенными под углом 90° на роторе, и одной на статоре).

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

На блок-схеме фиг. 1 позиция 3 обозначает совокупность клемм обмотки возбуж- дения, в то время как позиции 4 и 5, с другой стороны, обозначают пары выходных клемм, на которых присутствуют два сигнала углового положения синусной и косинусной фермы соответственно.

При нормальной работе ррбота, с которым связан прибор 1, устройство общего управления 6, называемое сервоуправлени- ем, непосредственно подает возбуждающее напряжение на синус-косинусный вращающийся трансформатор 2. Обычно это синусоидальное напряжение с частотой порядка 2,6-3,0 кГц или 5,0 кГц и амплитудой порядка 32 В или 5-6 В полного размаха..

Если говорить более точно, синусоидальное возбуждающее напряжение достигает входа 3 синус-косинусного вращающегося трансформатора 2 через линию 7, которая тянется от сервоуправления 6 через переключатель твердого состояния (например, транзистор) 8, двухпозицион- ный переключатель, связанный с выделителем мощности 9-.

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

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

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

К примеру, могут быть приняты во внимание максимальные величины скорости двигателя, соответствующие 30006000 об/мин, с ускорениями порядка 800 квадрантов/с2.

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

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

Например, приемлемая величина входного сопротивления для фильтра 10 по крайней мере 500 кОм на частоте возбуждения. Частота спада обычно выбирается в пределах октавы за частотой возбуждения.

Как синусный, так и косинусный сигналы 4,5 после выхода с фильтра 10 направляются на устройство регистрации углового положения (квадрантный детектор) 11.

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

Последовательно соединенный .фильтр 10 и квадрантный детектор 11 образуют преобразователь аналог-цифра.

В простейшей конфигурации схема 11 включает просто два компаратора с порогом около нуля, способных распознавать знак (положительный или отрицательный) синусного и косинусного сигналов, и логическую сеть, способную генерировать на выходе устройства 11 на линии шины данных 12 процессора 13, работающего как микроконтроллер устройства, двухразрядный кодированный логический сигнал в соответствии с показанной ниже преобразующей таблицей.

Предложенный метод преобразования не состоит просто в выборе назначения данной логической величины (например, О) положительному знаку синусного или коси; нусного сигнала и противоположной логической величины (1) отрицательному знаку.

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

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

Двоичное кодирование, показанное в вышеприведенной таблице, имеет преимущество с точки зрения загрузки в память данных (которой обычно является резидентное запоминающее устройство с произ- вольной выборкой) процессора 13 накопленного элемента данных, относящегося к вращению двигателя 1 (и, следовательно, к положению связанной с ним движущейся части) и организованного, на- пример, в шестнадцатиразрядную цепочку Si, S2...S16, где Si, 82 - (младшие разряды) являются двумя битами, несущими результат операции распознавания квадранта, проводимой устройство 10; Зз, $14 являются двенадцатью накапливающими разрядами, предназначенными для выражения положе- , ния, достигнутого двигателем (и движущейся частью), с возможностью регистрации до различных; положений; Sis является свободным битом; предоставляемым для генерации маркеров или флагов; Si6 является битом направления.

Ротационный счет увеличивается или уменьшается, когда синус-косинусный вра- щающийся трансформатор 2 и связанные с ним схемы обнаруживают переход между квадрантами 1 и 4, Если бит „направления имеет уровень логического О, тогда ротационный счет будет уменьшен при переходе из квадранта 4 в квадрант 1. Если бит Направления имеет уровень логической 1, ротационный счет увеличится при переходе из квадранта 1 в квадрант 4. Очевидно, это решение общеизвестного характера, приве- денное здесь чисто в качестве не ограничивающего примерз.

Частота, используемая для распознавания квадрантов, должна выбираться таким образом, чтобы избежать потери информа- ции.

Обнаружение или выборка должны поэтому выполняться на соответственно более высокой частоте, которая тем выше, чем больше допустимые скорость или ускорение движущейся части, перемещаемой двигателем 1.§

Например, максимальная скорость роботов, выпускаемых в настоящее время за1 явителям и, соответствует скорости

вращения двигателя 1 порядка 6000 об/мин, к которой из предосторожности (чтобы учесть мгновение состояния избыточной скорости) полезно добавить дополнительный запас в 1000 об/мин, что дает общую величину 7000 об/мин.

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

В общем, учитывая также присутствие шума в системе, предпочтительно выполнять выборку углового положения двигателя 1 по крайней мере дважды для каждого квадранта при максимальной скорости движения, давая, однако, процессору 13 период времени для выполнения минимальной обработки отсчетов, предоставляемых синус-косинусным вр ащающимс трансформатором 2 (с использованием процедур, которые более подробно будут описаны ниже), перёд загрузкой их в память с . произвольной выборкой в качестве данных считывания..

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

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

Такая обработка способна учесть любые ошибки считывания при использовании критериев, схематически показанных в таблице истинности на фиг. 3.

В этой таблице входы ряда соответствуют угловому положению (квадранту), представленному 2-разрядным логическим сигналом, выдаваемым детектором квадрантов 10 на базе описанных выше критери-. ев. Входы, колонок, с другой стороны, представляют моментальный элемент данных, ранее запомненный процессором 13.

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

Эта ошибка квантования имеет определенное значение при переходе двух квадрантов (1 и 4), который характеризует нулевую точку, то есть угловое положение, при котором в соответствии с описанными выше критериями имеет место увеличение (или уменьшение) ротационного счета внутри процессора 13. Однако ошибками квантования в трех других переходных точках между квадрантами можно пренебречь.

В таблице, показанной на фиг, 3, вход ОК обозначает состояние, в котором дан- 1)ые, предоставленные детектором квадрантов 10, соответствуют данным процессора 13..

С другой стороны, ячейки, помеченные ЕРР относятся к ситуациям, в которых имеется различие в 180° (двух квадрантов), показание того, что устройство могло потерять точную информацию относящуюся к положению двигателя для части, управляемой последним.

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

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

Что касается выбора процессора или микроконтроллера 13, предпочтительным считается выбор компонента с 16-разрядной внутренней архитектурой.

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

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

Работа процессора 13 регулируется программной памятью (операционной системой), состоящей из программируемого постоянного запоминающего устройства 14, и тактируется главной тактовой схемой (показанной для ясности как компонент вне процессора 13) I . использованием 5-вольтного напряжения постоянного тока, подаваемого, например, регулятором 16.

Последний соединен с питающей сетью V (состоящей в показанном примере из ис- 5 точника напряжения 17-36 В) через преобразователь постоянноготока 17. Последний питает зарядное устройство батареи 18, предназначенное для поддержания буферной батареи 19 в заряженном состоянии. 10 Чтобы собранное устройство можно было объединить с управляемой движущейся частью, считается предпочтительным выбрать запаянную свинцом батарею, работающую, при напряжении 6 Вольт с емкостью 5 заряда порядка 0,9 А/ч.

В любом случае предпочтительно обеспечить соединения для возможности подключения к внешней батареи большей емкости.

0 Зарядное устройство 18 обычно должно быть достаточно мощным для обеспечения полного заряда батареи 19 до максимальной емкости в течение периода времени порядка 0.5 часа,

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

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

Это по существу прерывистая работа 5 предназначена для уменьшения расхода энергии, используемой от буферной батареи 19..

Линия 21 обозначает соединительный интерфейс, который позволяет процессору 0 13 осуществлять связь через свой последовательный порт 22 с сервоуправлением 6. . ,

Могут посылаться двухсторонние сооб- щения путем использования различных протоколов, таких как двоичные протоколы и 5 протоколы А С11.

При нормальной работе системы, когда устройство запитано (или присутствует сетевое питание), данные углового положения, загруженные в процессор 13, посредством сигналов, генерируемых синус-косинусным вращающимся трансформатором 2 (возбуждаемым сервоуправлени- ем 6 через линию 7 и двухпозиционный переключатель 8), могут, таким образом, передаваться на сервоуправление 6.

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

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

В случае прерывания подачи внешнего электропитания, которое может произойти из-за отключения робота (например, при временной остановке работы или для переноса его на другой завод) или в результате сбоя питания, сервоконтроллер 6 уже не будет способен подавать синусоидальный сигнал для возбуждения синус-косинусного вращающегося трансформатора 2 на линии 7.

Отсутствие возбуждающего сигнала обнаруживается датчик нарушения внешнего питания сигнала 23, соединенной с линией 7, которая передает соответствующее сообщение по шине данных 12 процессора 13i

Последний воздействует на переключатель 8 и управляющую схему 20, изменяя конфигурацию устройства таким образом, что все его активные компоненты могут быть запитаны буферной батареей 19, активируя вспомогательный возбуждающий источник (управляемый генератор импульсов) 24, включенный в настоящее устройство,

Вспомогательный возбуждающий источник (управляемый генератор импульсов) 24 соединен с возбуждающим входом 3 синус-косинусного вращающегося трансформатора 2 посредством двухпозиционного переключателя 8, переключение которого управляется процессором 13.

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

Если говорить более точно, он может состоять из прямоугольных (или трапецеидальных) импульсов Раз с длительностью примерно 100 микросекунд, то есть с длительностью, рапной длительности полуволн

синусоидального возбуждающего сигнала частоты 5 кГц, подаваемого на синус-косинусный вращающийся трансформатор во время обычной работы.

Вспомогательный возбуждающий источник (управляемый генератор импульсов) 24 активируется управляющей схемой 20 в соответствии с тактовым сигналом, вырабатываемым схемой 15, как минимум, на двух

0 разных частотах.

Последовательно соединенные зарядные устройство 18, буферная батарея (19) и управляемый генератор импульсов образуют канал формирования автономного пи5 тания.

Первая частота (период Т21 на фиг. 2), обычно являющаяся низкой (например, импульс возбуждения с периодам 20-500 миллисекунд), предназначена для исполь0 зования в режиме ожидания, то есть, когда есть основания ожидать, что движущаяся часть, связанная с двигателем 1, будет пере- мещаться очень медленно (например, вследствие перемещения, передаваемого

5 оператором вручную во время сборки или изменения конфигурации робота) или не будет двигаться совсем; в последнем случае просто необходимо проверить, стоит ли движущаяся часть водном и том же положении.

0 Вторая частота (период Ti на фиг. 2), обычно являющаяся более высокой (по крайней мере на один период величины), может-соответствовать, например, выделению импульса через каждые 2 миллисекун5 ды. Поэтому эта же частота, которая по существу сравнима с частотой, на которой во время нормальной работы системы происходит отсчет данных о квадрантах, вырабатываемых устройством 11.

0 Эта вторая возбуждающая частота используется всякий раз, когда данные о квадрантах, полученные от синус-косинусного вращающегося трансформатора 2, показывают, что двигатель 1 движется быстро или

5 со скоростями движения, сравнимыми с теми, что возникают во время обычной работы.

Эта ситуация может иметь место в момент, непосредственно следующий за

0 прерыванием подачи внешнего электропитания, когда движущаяся часть продолжает перемещаться в течение определенного периода времени благодаря инерции (в особенности если ее не тормозят) или при

5 переключении робота.

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

На фиг. 2а в схематичной форме показана возможная последовательность, по которой из обычного состояния работы системы (фаза А), когда происходит подача внешнего питания, сервоуправлением на синус-косинусный вращающийся трансформатор 2, переходят к аварийной работе, обеспечиваемой прибором 1, после сбоя внешнего питания и невозможности вследствие этого возбуждения; синус-косинусного вращаю: щегося трансформатора сервоуправлением 6. В частности, во время аварийной работы происходит следующая последовательность -.. ;- ;.

первая фаза В (движение робота по инерции), в которой источник 24 подает свои возбуждающие импульсы Раз с более высокой частотой (например, импульс Р23 с длительностью 100 микросекунд подается через каждые 1.,1 миллисекунды), и

ВТОР.ЭЯ фаза ожидания С, в которой после обнаружения микропроцессором отсутствия движения или отсутствия быстрых движений источник 23 переводит к работе с бблее низкой частотой, и импульсы Ргз выдаются с интервалами, например, в 20 миллисекунд.

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

На фиг. 2 в в схематичной форме показана ситуация, при которой переход от низкочастотной работы в режиме Ожидания (фаза С) к обычной работе системы не происходит прямо, а включает возврат к фазе быстрого возбуждения (фаза В), например, из-за быстрого движения, переданного роботу внешним оператором.

На фиг. 4 схематично, в форме алгоритма, показана возможная логическая последовательность работы процессора 13.

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

Если эти условия не имеют места; процессор 13 продолжает управлять работой настоящего устройства в соответствии с критериями нормальной работы системы, 5 при необходимости передавая сервоконт- роллеру 6 данные углового положения через интерфейс связи 21..

Если, с другой стороны, процессор 13 получает от датчика нарушения внешнего

0 питания 24 сообщение, указывающее на прерывание подачи электропитания и синусоидального возбуждающего напряжения, то процессор 13 сам во время последующей стадии 26 вызывает переключение двухпо5 зиционного переключателя 8 и вынуждает

настоящее устройство полностью перейти

.на питание, обеспечиваемое буферной тареей 19 под управлением устройства 20. В этой точке процессор 13 может

0 вызвать посылку вспомогательным источником (генератором импульсов) 24 возбуждающего импульса синус-косинусному вращающемуся трансформатору 2 (стадия 27), чтобы позже перейти (в coot5 ветствии с критериями, описанными выше с привлечением табл. фиг. 3) к считыванию данных углового положения, предоставляемых детектором 11.

В частности это может состоять вопе0 рации считывания данных 28, за которой следует проверочная операция 29, в которой применяется таблица истинности, показанная на фиг. 3, с возможным выходом либо на операцию отображения ошибки 30

5 (в случае когда имеется возврат к одному из условий, характеризуемых ячейках йдоль диагонали таблицы фиг. 3), либо на обычную загрузку 31 считанных данных в память процессора 13.

0 После операции проверки 32, в которой

процессор 13 считывает состояние датчика

нарушения внешнего питания 23, изменяя

в конфигурацию прибора для обычной работы

системы - линии 33 в случае, когда датчик

5 23 указывает на восстановление подачи внешнего электропитания и синусоидального возбуждающего напряжения сервоконт- роллером 6. процессор 13 сам приступает к следующей проверочной операции 34, про0 веряющей, указывают ли загруженные данные движение по отношению к предыдущему запомненному положению.

Результат теста, проведенного на стадии 3.4, позволяет процессору 13 устано5 вить, необходимо ли осуществить возврат к стадии 27 с выдачей нового возбуждающего импульса по истечении одного или другого периода (Ti или Тг), соответствующего одной из двух различных возбуждающих частот.

Пока процессор 13 продолжает обнаруживать движение, он продолжает активировать вспомогательный источник (генератор импульсов) 24 (стадия 35, чтобы получить импульсное возбуждение синус-косинусного вращающегося трансформатора 2 на более высокой частоте (фаза В фиг. 2а).

Когда сравнение с предыдущей операцией считывания показывает, что никакого движения обнаружено не было (признак того, что движущая часть робота остановилась или перемещается на малой скорости), возврат к стадии 27 осуществляется после периода ожидания 36 имеющего деятельность, равную длительности периода Т2, что устанавливает условие так называемого режима ожидания.

Однако, как только проверка покажет существование движения, снова произойдет возврат к стадии 27, при коорой будет выдай новый .возбуждающий импульс на стадии 35 или после периода ожидания, имеющего длительность, равную длительности периода Ti на фиг. -2.

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

Формула изобретения

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

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

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

2.Устройство по п. 1, о т л и ч а ю щ е е- с я тем, что канал формирования автономного питания выполнен в виде последовательно соединенных зарядного устройства, буферной батареи и управляемого генератора импульсов.

3.Устройство по п. 2, о т л и ч а ю щ е е- с я тем, что управляемый генератор импульсов выполнен двухчастотным.

4.Устройство по п. 1, о т л и ч а ю щ е е- с я тем, что преобразователь аналог - цифра выполнен в виде последовательно соединенных фильтра и квадрантного детектора.

.

гг

жи-

/J

19

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

7;

5

G

5 J %f- %

t

Го

Фиг. 7

-1W)г2

00

or

11 ю

00 01

1L

10

Фиг.З