Способ определения фактического положения систем координат звеньев манипулятора

)5 В 25 ) 11/00, 19/00 ГОСУДАРСТВЕННЪЙ КОМИТЕТПО ИЗОБРЕТЕНИЯМ И ОТКРЫТИПРИ ГКНТ СССР ОПИСАНИЕ ИЗОБРЕТЕН ЯГ 4 с КТИЧ Е- ООРДИтотехнии произшленных ских па- изобрености я сиса. Для ВТОРСКОМУ СВИДЕТЕЛЬСТ(54) СПОСОБ ОПРЕДЕЛЕНИЯ ФАСКОГО ПОЛОЖЕНИЯ СИСТЕМ КНАТ ЗВЕНЬЕВ МАНИПУЛЯТОРА(57) Изобретение относится к робоке и может быть использовано прводстве и эксплуатации промыроботов для аттестации кинематичераметров их рабочих органов. Цельтения - повышение точности и надопределения фактического положетем координат робота-манипулято этого на основании 2 и подвижных звеньях 1 манипулятора размещают контролируемые элементы 3, измеряют фактическое положение этих элементов в системе координат внешней аттестующей установки при последовательном многократном движении звеньев 1 с необходимыми для измерения остановками, Затем производят статистическую обработку результатов измерений, из которых определяют наиболее вероятное фактическое положение осей соответствующих систем каординэт. Контролируемые элементы, устанавливаемые на смежные звенья 1 вращательного перемещения, представляют собой два эталонных тела, закрепленных на концах штанги 4, продольная ось которой располагается параллельно 3 оси вращения данного звена 1, 6 ил,Изобретение относится к робототехнике и может быть использовано при производстве и эксплуатации промышленных роботов для аттестации кинематических параметров их рабочих органов.Цель изобретенияповышение точности и надежности,На фиг.1 изображен промышленный робот-манипулятор с установленными на его звеньях контролируемыми элементами; на фиг,2- схема определения фактического положения системы координат; на фиг,З - вариант промышленного робота-манипулятора со звеньями вращательного и линейного перемещения и схема определения положения его системь 1 коорцинат; на фиг.4 - вид А на фиг.3; на фиг.5 - робот только со звеньями линейного перемещения и схема определения его системы координат; на фиг.б - показан вариант схемы определения положения системы координат,Данный способ реализуется следующим образом,На подвижных 1 и неподвижном 2 (основании) звеньях робота-манипулятора устанавливают и закрепляют контролируемые элементы 3, например, в виде кубических эталонных тел. Далее робот устанавливают на координатно-измерительную машину или, если робот велик, устанавливают вокруг него аттестующую систему, например, систему оптических датчиков, которые позволяют с достаточной точностью определять в пространстве положение контролируемых элементов 3, Затем осуществляют перемещения звеньев " манипулятора последовательно от первого звена до последнего таким образом, чтобы звенья вращательного перемещения останавливались не менее; чем в трех точках, а звенья линейного пеоемещения - не менее, чем в двух точках, с повторением цикла перемещения каждого звена не менее 10 - 50 оаз. При этом в каждой точке производят измерение положения каждого контролируемого элемента 3, связанного с ссютветствующим звеном, Здесь дпя куба производят измерения кооодинат 8 или 9 точекрасположенньх на трех взаимно перпендикулярных плоскостях, которые полностью и однозначно определяют положение куба в пространстве, Точки измеоения но чт располагаться по граням куба в соответствии со структурными формулами ЗхЗхЗ, Зх, х 1 и 2 х 2 х 2,при этом три точки на гранях не должны лежать на одной прямой, Полученные координаты точек измерений формируют в массивы данных, используя которые по составленным ма;емагическим моделям, производят расчет нэ компьютере (в системе координаг 25 30 35 40 45 50 55 аттестующей установки) положения определяемой системы координат манипулятора. При этом по координатам точек измерения определяют по математической модели координаты точек взаимного пересечения граней каждого куба в каждой из реализацийего положения, заданного программой. При определении положения системы координат, расположенной в шарнирном соединении двух звеньев 1 с вращательным перемещением, на каждом из смежных звеньев устанавливается контролируемый элемент, состоящий из двух эталонных тел,которые закреплены на концах жесткой штанги 4, продольная ось которой располагается параллельно оси вращения данного звена 1. Определение положения системы координат в данном случае осуществляется следующим образом, По координатам точек(см, фиг.2) последовательного положения звеньев вращения (х 1, у 1, г 1), (х 2, уъ гг), (хз,уз, гз) получают как центр окружности, проходящей через указанные точки, точку (х 3, у 1, г 3 ), аналогично получают точки (х 3, у, Й), (х 3, у 3, д ), (х 3, у 1, г 1 ). По координатам точек (х 3, у 3, г 3) и (х 3, у, Й ) вычисляют уравнечие оси первого шарнира, а по точкам(х 3, узз, д ) и (х 1, у 1, г 1) уравнение оси второго шарнира, При статистической обработке нескольких циклов определяют координаты точек, соответствующих матемэтическомуожиданию центров окружностей, проходящих через вершины кубов, фиксируемых, например, в трех положениях при повороте звена, По координатам этих точек определяют уравнения прямых а и Ь, принимаемых с наименьшими ошибками и высокой достоверностью за оси вращения звеньев. В общем случае мгновенные оси вращения звеньев будут распределяться в пространственных трубках Т 1 и Тг произвольным образом, а прямые а и Ь скрещиваются, По уравнениям прямых а и Ь вычисляют уравнение прямой с, проходящей через две данные прямые так, что отрезок б, отсекаемый прямыми а и Ь, имеет наименьшую длину. Точку пересечения Ос прямой с с прямой а принимают за цетр декартовой системы координат, Ось Ео этой системы совпадает с прямой а, являющейся наиболее вероятной осью вращения первого подвижного звена. Две другие оси ей перпендикулярны и проходят через точку О 0. При этом ось Х 0 располагают в плоскости, проходящей через ось Ео и делящей угол поворота вокруг этой оси, например, пополам, Далее по измерениям точек поверхностей кубо, расположенного на основании 2,определяют положение системы координат Хз, Уз, 2 з и вычисляют вектор Оо смещения центров систем Хо, Уо, 2 о и Хз, Уз, 2 з и углы а,3 у, из разворота, После чего производят пересчет положения системы координат ХзУз 2 з в систему координат ХоУо 2 о манипулятора и записывают полученные значения угловых и линейных смещений в память системы управления и паспорт манипулятора. Для роботов-манипуляторов с звеньями линейного перемещения (фиг.5) количество определяемых положений контролируемых элементов 3 не должно быть менее двух. При этом кубы размещают так: на основании 2 и на третьем подвижном звене 1 робота по одному кубу, Затем перемещают первое подвижное звено 5 в несколько фиксированных положений и измеряют в них положения куба, по которым высчитывают положения в системе ХкУк 2 к вершин куба. По ним высчитывают положение в системе ХкУк 2 к наиболее вероятной оси а звена 1. Эту процедуру повторяют со звеном 6 - вторым подвижным звеном и высчитывают положение его наиболее вероятной оси Ь, При этом вероятные оси определяют при установленных на ноль-метку датчиках обратной связи двух других звеньев (т.е, при крайних положениях двух других звеньев), Центр системы координат робота определяют как точку Оо пересечения наиболее вероятного положения оси первого подвижного звена а и линии с наикратчайшего расстояния между наиболее вероятными осями первого а и Ь второго подвижных звеньев. Оси этой системы определя ет исходящими из центра О, так, что одна из них Уо совпадает с наиболее вероятной осью первого подвижного звена, вторая ось Х, исходит из центра так, чтобы угол а, образуемый ею с прямой Ь, исходящей иэ центра Ос, параллельно вероятной оси Ь второго звена, был минимален, т.е, с = й млн и ось Хо была перпендикулярна оси Уо, Третья ось 2 о перпендикулярна двум другим. Далее определяют фактическое положение куба 7, установленного на основании 2, и определяют его систему координат ХзУз 2 з, Затем аналогично вышеописанному алгоритму производят пересчет положения системы координат и запись полученных значений отклонений в память системы управления и паспорт робота-манипулятора.Для роботов-манипуляторов в варианте на фиг.3 положение системы координат определяют следующим образом.На роботе устанавливают соответствующие контролируемые элементы 3, При20 25 30 40 4550 55 5 10 15 этом куб на основании 2 должен располагаться в пределах рабочей эоны. Роботустанавливают на стол измерительной машины. Перемещают дискретно по колонне 8 основания 2 первое подвижное звено 1 и фиксируют в некоторых положениях, в каждом из которых производят измерения положений куба, установленного на этом звене, Измерения повторяют многократно по приведенному выше алгоритму для других роботов, Затем многократно производят измерения координат трех точек по периметру колонны в двух ее сечениях с целью определения положения ее оси, По данным измерений вычисляют в системе ХкУк 2,координат измерительной машины положения наиболее вероятной оси колонны 02 и прямой 0121, сумма квадратов расстояний положений точки А - вершины куба от которой минимальна. Далее определяют координаты точек 0 и 01 пересечения этих линий с плоскостью основания робота и высчитывают координаты вектора 010, Точку 0 принимают за центр определяемой системы координат, Вертикальная ось 02 О этой системы исходит из точки 0 параллельно прямой 0121, Затем подвижные звенья робота многократно перемещают по программе в исходное положение, в котором производят всякий раз поворот последнего звена с установленной на нем парой кубов с фиксацией в трех положениях, в которых измеряют положение по приведенной выше методике этих кубов. По положениям кубов определяют статистическое множество положений центров вращений и их математическое ожидание, Через эти точки проводят линию, определяют ее положение и принимают ее за наиболее вероятную ось вращения последнего звена, Затем проводят из точки О прямую, перпендикулярную оси 02 О так, чтобы она пересекла полученную ось вращения последнего звена и определяют координаты точки пересечения В. После этого определяют ось ОХО как прямую, проходящую через точки 0 и В. Третья ось ОУо исходит иэ точки 0 перпендикулярно двум другим ОХО и 02 О. Далее измеряют положение куба, установленного на основании 2 робота и определяют в системе координат измерительной машины систему координат ХзУз 2 з, связанную с кубом, Затем рассчитывают положение этой системы координат в системе координат ХоУо 2 о робота, определяемое вектором ОзО и углами а, 3,у (которые не показаны на фиг,3) разворота осей ОзХз, ОзУз, Оз 2 з относительно осей ОХо, ОУ 02 О соответственно.Наличие на основании 2 неподвижного контролируемого элемента 3, который неудаляется после измерений, позволяет роботу при оснащении его сменными контактными щупами с системой контроля положения, связанной с системой управления робота, с высокой точностью корректи ровать ошибки положения рабочего органа в неподвижной системе координат в автоматическом режиме и выполнять операции измерения, например расположения объектов сборки, в системе координат робота и 10 корректировать траекторию движения рабочего органа автоматически,Формула изоб ретенияСпособ Определения фактического по ложения систем координат звеньев манипулятора, заключающийся в том, что с помощью внешней измерительной системы определяют фактические координаты положения контролируемого элемента, расположенного на звене манипулятора, в нескольких последовательных положениях звена, а по результатам измерений осуществляют определение положения соответствующей системы координат, о т л и ч а ю щ и й с я тем, что, с целью повышения точности и надежности, контролируемый элемент размещают на каждом из соответствующих смежных звеньев вращательного перемещения или на соответствующем звене линейного перемещения, а также на основании манипулятора, при этом контролируемый элемент, устанавливаемый на звеньях вращательного перемещения, состоит из двух эталоннцх тел, закрепленных на концах штанги, продольная ось которой располагается параллельно оси вращения данного звена.1613319Составитель Н,Богданов едактор М.Товтин Техред М,Моргентал Корректор Т,Пали каз 3858 Тираж 695 Подписное ВНИИПИ Государственного комитета по изобретениям и открцтиям при ГКНТ СССР113035, Москва, Ж, Раушская наб 4/5Производственно-издательский комбинат "Патент", г. Ужгород, ул,Гагарина, 101