Устройство координатного позиционирования
Изобретение относится к устройствам, осуществляющим точные шаги перемещений , и может быть использовано в прецизи онном технологическом оборудовании, механизмах точной подачи инструмента или обрабатываемого изделия. Цель изобретения -повышениеточности позиционирования каретки за счет уменьшения погрешности определения координаты каретки в пределах каждой четверти периода изменения сигналов датчика. Устройство содержит датчик перемещений каретки с фотоприемниками, блок автоматической регулировки амплитуды синусоидальных сигналов, аналоговый сумматор , элемент извлечения квадратного корня , два делителя, умножители, блок выбора направления перемещения каретки, реверсивный счетчик, аналого-цифровой преобразователь , линейный преобразователь. Изобретение позволяет повысить точность позиционирования каретки за счет уменьшения погрешности определения координаты каретки. 1 ил. tn с
СОЮЗ СОВЕТСКИХ
СОЦИАЛИСТИЧЕСКИХ
РЕСПУБЛИК (51)5 G 05 В 19/02
ГОСУДАРСТВЕННЫИ КОМИТЕТ
ПО ИЗОБРЕТЕНИЯМ И ОТКРЫТИЯМ
ПРИ ГКНТ СССР
ОПИСАНИЕ ИЗОБРЕТЕНИЯ
К АВТОРСКОМУ СВИДЕТЕЛЬСТВУ (21) 4657600/24 (22) 01.03.89 (46) 30.11.91, Бюл. ¹ 44 (72) К.А, Грибоедов (53) 62-50(088. 8) (56)-Борисовский С,П. и др. Лазерные интерферометры перемещения второго поколения. — M,: Электроника, 1982, Авторское свидетельство СССР
¹ 1068995, кл. G 11 В 21/04, 1982. (54) УСТРОЙСТВО КООРДИНАТНОГО ПОЗИЦИОНИРОВАНИЯ (57) Изобретение относится к устройствам, осуществляющим точные шаги перемещений, и может быть использовано в прецизионном технологическом обор,.довании, механизмах точной подачи инструмента или
Изобретение относится к устройствам, осуществляющим точные шаги перемещений, и может быть использовано в прецизионном технологическом оборудовании, в механизмах точной подачи инструмента или обрабатываемого изделия.
Цель изобретения — повышение точности позиционирования каретки за счет уменьшения погрешности определения ее координаты в пределах каждой четвертипериодэ изменения сигналов датчика.
На чертеже приведена схема устройства координатного позиционирования. устройство содержит датчик 1 перемещения каретки, например, с фотоприемниками 2, выходы которых соединены .с входами блока 3 автоматической регулиров.. (Л,„, 1695264 A l обрабатываемого изделия. Цель изобретения — повышение точности позиционирования каретки за счет уменьшения погрешности определения координаты каретки в пределах каждой четверти периода изменения сигналов датчика. Устройство содержит датчик перемещений каретки с фотоприемниками, блок автоматической регулировки амплитуды синусоидальных сигналов, аналоговый cvMматор, элемент извлечения квадратного корня, два делителя, умножители, блок выбора направления перемещения каретки, реверсивный сче1чик, аналого-цифровой преобразователь, линейный преобразователь.
Изобретение позволяет повысить точность позиционирования каретки за счет уменьшения погрешности определения координаты каретки, 1 ил. ки амплитуды синусоидальных сигналов, состоящего из двух умножителей 4 и 5, входы которых соединены с входами блока автоматической регулировки амплитуды синусоидальных сигналов, а выходь1 — с входами аналогового сумматора 6, выходом соедиi:àíHoão с входом элемента 7 извлечения квадратного корня, и двух делителей 8 и 9, одни входы которых соединены с входами умножителей 4 и 5, а другие входы соединены с выходом элемента 7 извлечения квадратного корня 7, Выходы делителей 8 и 9 являются выходами блока 3 автоматической регулировки амплитуды синусоидальных сигналов, которые через усилители-ограничители 10 подключены к блоку 11 выбора направления перемещения каретки, выходы
1695264
)) +(c» (2» ))г10
30
= A„Гл,л, ((„ которого подключены к реверсивному счетчику 12, Один из выходов блока 3 автоматической регулировки амплитуды синусоидальных сигналов 3 соединен через двухполупериодный выпрямитель-13 с входом аналого-цифрового преобразователя 14, выход которого соединен к линейному преобразователю 15, Выход линейного преобразователя 15 соединен с входом преобразователя 16 кодов, два других входа которого соединены с выходами усилителей-ограничителей 10, Выход преобразователя 16 кодов соединен с цифровым сумматором 17, другие входы которого соединены с выходом реверсивного счетчика 12 и управляющим входом 18 устройства. Выход цифрового сумматора через цифроаналоговый преобразователь 19 подсоединен к усилителю 20 мощности. Выход усилителя 20 мощности соединен, напри.мер, с электродвигателем 21, кинематически связаны с кареткой 22, Устройство работает следующим образом, При перемещении каретки 22 фотоприемники 2 датчика перемещений выдают электрические сигналы Ul и Ог, связанные с текущей координатной каретки 22 следующими зависимостями:
U< =Um s n (2 — ), S
Ог = Umcos (2л — ), S
f,qe U — амплитудные значения сигналов фотоприемников", S — текущая координата положения каретки 22; (Т вЂ” период изменения сигналов фотоприемников 2, С выходов датчика 1 перемещения каретки сигналы Ul и Ог поступают на входы умножителей 4 и 5, На выходе умножителей
4 и 5 сигналы Uy> и Оуг имеют вид:
Т))
S г.
Иу г = Ау Ог = Ау (Um сов (2 л Т))
S где Ау — коэффициент передачи умножителя.
Эти сигналы поступают на аналоговый сумматор 6, суммируются в нем, и суммарный сигнал с его выхода поступает на вход элемента 7 извлечения квадратного корня, на выходе которого сигнал Ок имеет вид
22 ° 2„ГА,((2 422„((2;,— ) (22(uÄ (22-((где A((и Ас — коэффициенты передачи соответственно элемента извлечения квадратного корня и аналогового сумматора.
Так как (8(П (2л. Т))г + (cos (2 л — ))г — веilf2T%1H3 постоянная, то Mo>KHG записать UK = АЦ, причем
*= . %*, 2„,2
С выхода элемента 7 извлечения квадратного корня сигнал поступает на входы делителей 8 и 9,- на выходах которых сигналы имеют вид: и и т A ((51(2 (222 ) 22 = 22 -2* . П =-— 22 2((22 — 2 к м л ((, ((м. (22 2 ( (2At= "* — = "к — - ((25 (222 — )
К где Ад — коэффициент передачи двигателя.
Как видно,амплитудь(сигналов Од и Одг не зависят от амплитуды сигналов датчика перемещения каретки Ul и Ог и определяются лишь коэффициентами передачи умножителя, аналогового сумматора, элемента извлечения квадратного корня и делителя.
Сигналы Uq< и Одг с выходов блока 3 автоматической регулировки амплитуды синусоидальных сигналов поступают на входы усилителей-ограничителей 10, В усилителях-ограничителях 10 формируются двухуровневые знаковые сигналы, изменение которых происходит в моменты изменения полярности входных сигналов Од1 и Одг, На выходах блока 11 выбора направления перемещения каретки формируются импульсные сигналы, характеризующие действительное прямое и обратное перемещения каретки 22 с периодом их следования, пропорциональным дискретности смещения каретки на величину Т/4.
Младшие разряды сигнала действительной координаты каретки 22 формируются цепью, состоящей из блоков 13 — 16, При этом синусоидальный сигнал с одного из выходов блока 3 автоматической регулировки амплитуды синусоидальных сигналов выпрямляется в двухполупериодном выпрямителе. Затем однополярный пульсирующий сигнал, каждая полуволна которого соответствует смещению каретки 22 на величину Т/2, преобразуется в аналого-цифровом преобразователе 14 в последовательность цифровых К-разрядных кодовых сигналов, Далее К-разрядный сигнал, соответствующий значениям действительных координат каретки 22, но сформированный в пределах отрезков Т/2 по синусоидальному закону, преобразуется в линейном преобразователе 15 в последовательность N-ðàçð (äíûõ кодов, линейно
1 69 52 Ã) 4 связанных с теми же координатами каретки
22, в соответствии с выражением
Y =-агс sin—
Z где Y — выходной N-разрядный код, соответствующий главному, значению функции
X Л. агс sin — в пределах от 0 до
X — мгновенное значение входного К- 10 разрядного кода;
Z — максимальное (амплитудное) значение входного кода, Последние преобразуются в преобразователе кодов 16 в кодовый сигнал действи- 15 тельной координаты каретки 22 в пределах отрезка Т/4, поступающий на цифровой сумматор 17. По управляющему входу 18 устройства на цифровой сумматор 17 поступает управляющий сигнал, задающий коор- 20 динату позиционирования каретки 22 в виде полного кода координаты.
В реверсивном счетчике 12 происходит подсчет импульсов, поступающих с блока 11 выбора направления перемещения каретки, 25 в результате чего на выходе реверсивного счетчика 12 формируются старшие разряды кода действительного положения каретки
22, младший из которых соответствует изменению координаты на величину Т/4. 30
B цифровом сумматоре 17 происходит суммирование кодов, поступающий от преобразователя 16 кодов и реверсивного счетчика 12, для получения полного кода действительной координаты каретки, и вы- 35 читание из него полного кода координаты позиционирования каретки, поступающего по управляющему входу 18 устройства, На выходе цифрового сумматора 17, таким образом, формируется полный разностный 40 сигнал управления движением каретки 22, который после преобразования в цифроаналоговом преобразователе 19 в аналоговую форму и усиления в усилителе 20 мощности поступает на электродвигатель 21 для осу- 45 ществления перемещения каретки 22 до тех пор, пока разностный сигнал не станет равным нулю.
Изобретение позволяет повысить точность позиционирования каретки за счет 50 уменьшения погрешности определения координаты каретки, так как координата действительного положения каретки определяется внутри четверти периода синусоидальных сигналов, соответствующих перемещению 55 каретки, путем сравнения мгновенных эначений сигналов с их амплитудными энлч ниями, не изменяющимися от нестабильности осветителя датчика, климатических условий, загрязненности среды и т.д. благодаря введению блока автоматической регулировки амплитуды синусоидальных сигналов.
Формула изобретения
Устройство координатного позиционирования, содержащее датчик перемещения каретки, два усилителя-ограничителя, выходы которого соединены с соответствующими входами преобразователя кодов и блока выбора направления перемещения каретки, первый и второй выходы которого подключены к соответствующим первому и второму входам реверсивного счетчика, выход которого соединен с первым входом сумматора, второй вход которого подключен к выходу преобразователя кодов, а третий вход — к управляющему входу устройства, выход .цифрового сумматора соединен с входом цифроаналогового преобразователя. выход которого через усилитель мощности подключен к выходу устройства,.а также последовательно соединенные двухполупериодный выпрямитель, аналого-цифровой преобразователь и линейный преобразователь, выход которого соединен с третьим входом поеобразователя кодов, о т л и ч а ю щ е е с я тем, что, с целью повышения точности позиционирования каретки за счет уменьшения погрешности определения координаты каретки, в него введен блок автоматической регулировки амплитуды синусоидальных сигналов, первый и второй информационные входы которого соединены с соответствующими выходами датчика перемещения каретки, а первый и второй — с входами первого и второго усилителей-ограничителей соответственно, состоящий из двух умножителей, соответствующие входы которых подключены к первому и второму входам блока автоматической регулировки амплитуды, и к первым входам первого и второго делителей, выходы умножителей соединены с соответствующими входами аналогового сумматора, выход которого соединен с.входом элемента извлечения квадратного корня, выходом подключенного к вторым входам делителей, выходы которых подключены соответственно к первому и второму выходам блока автоматической регулировки амплитуды синусоидальных сигналов.
1695264
Составитель К.Грибоедов
Редактор Л.Пчолинская Техред M.Ìoðãåíòàë Корректор:С.Черни
Заказ 4161 Тираж Подписное
ВНИИПИ Государственного комитета по изобретениям и открытиям при ГКНТ СССР
113035, Москва, Ж-35, Раушская наб,, 4/5
Производственно-издательский комбинат "Патент", г. Ужгород, ул,Гагарина, 101