Управление перемещением упругих структур робота



Управление перемещением упругих структур робота
Управление перемещением упругих структур робота
Управление перемещением упругих структур робота
Управление перемещением упругих структур робота
Управление перемещением упругих структур робота
Управление перемещением упругих структур робота
Управление перемещением упругих структур робота
Управление перемещением упругих структур робота

 


Владельцы патента RU 2487796:

ДЮРР СИСТЕМЗ ГМБХ (DE)

Изобретение относится к способу управления окрасочным роботом и характеризуется следующими этапами: задание траектории робота с помощью нескольких точек траектории, которые должны быть пройдены базовой точкой робота, причем отдельные точки траектории определены соответствующими пространственными координатами, преобразование пространственных координат отдельных точек траектории согласно инверсной кинематике робота в соответствующие координаты ( θ _ ) осей, которые отображают положение отдельных осей робота в соответствующих точках траектории, настройка привязанных к осям регуляторов (2) для отдельных осей робота в соответствии с преобразованными координатами ( θ _ ) осей, настройка привязанных к осям приводных двигателей (1) отдельных осей с помощью соответствующих регуляторов (2), при этом предусмотрено вычисление поправок ( Δ ( θ _ ) ) для отдельных точек траектории в соответствии с динамической моделью (5) робота, причем поправки ( Δ ( θ _ ) ) учитывают упругость и/или трение, и/или инерционность робота, вычисление скорректированных координат ( θ _ ) K O R R ) осей для отдельных точек траектории по нескорректированным координатам ( θ _ ) осей отдельных точек траектории и по поправкам ( Δ ( θ _ ) ) траектории и настройка привязанных к осям регуляторов (2) со скорректированными координатами ( θ _ ) K O R R ) осей. Обеспечивается точность позиционирования робота. 3 н. и 8 з.п. ф-лы, 8 ил.

 

Изобретение относится к способу управления многоосным роботом, в частности окрасочным роботом, согласно независимому пункту формулы изобретения.

Из DE 10342471 A1 известно управление многоосным окрасочным роботом, перемещающим вершину инструмента (Tool Center Point (TCP)) вдоль заданной траектории робота. Эта известная система управления роботом для повышения точности позиционирования окрасочного робота может учитывать и компенсировать механическую упругость отдельных осей робота. При этом отдельные оси окрасочного робота управляются соответствующим регулятором осей, причем механическая упругость окрасочного робота учитывается таким образом, что отклонение регулируемой величины регулятора относительно упругой оси робота в рамках межосевой связи воздействует на регулятор относительно жесткой оси.

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

Из US 2004/0093119 A1 известна система управления роботом, корректирующая ошибки позиционирования робота, обусловленные трением, при регулировании приводов отдельных осей робота, причем заданная траектория робота все же не изменяется. Поэтому точность позиционирования робота в результате этого управления роботом улучшается в недостаточной степени, что, в частности, относится к высокодинамическому режиму работы робота.

Кроме того, в отношении уровня техники следует еще указать на документы DE 102004056861 A1; «Proceedings of the 2005 IEEE Conference on Control Algorithms», August 28-31, 2005, 1170-1175; «Proceedings of IFAC Symposium on Robot Control», September 19-21, 1994, стр.485-490; DE 69829559 T2; DE 102004008406 A1; «Proceedings of the 1992 IEEE Conference on Robotics and Automation», май 1992, стр.1429-1435; «Transactions on Control Systems Technology», Vol.12, No.6, ноябрь 2004, стр.904-919 и EP 1173801 B1. Однако даже при таком уровне техники точность позиционирования робота является неудовлетворительной.

Ближайшим аналогом настоящего изобретения может рассматриваться документ Wells R.L. - INSTITUTE OF ELECTRICAL AND ELECTRONICS ENGINEERS: A STUDY OF PATH ERRORS DUE TO SERVO DYNAMICS AND LINK FLEXIBILITIES IN A TWO-COORDINATE ROBOTIC MANIPULATOR, PROCEEDINGS OF THE INTERNATIONAL CONFERENCE ON SYSTEMS, MAN AND CYBERNETICS. NEW YORK, 17 OCT. 1993 (1993-10-17), стр.705-709, который раскрывает способ управления многоосным роботом, однако данный способ не учитывает величины внутренних вращающих моментов и/или внешних вращающих моментов.

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

Поставленная задача решается согласно изобретению способом управления роботом по независимому пункту формулы изобретения.

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

В рамках способа управления согласно изобретению для базовой точки робота, как, например, для так называемой Tool Center Point (TCP), траектория робота задается несколькими точками траектории, которые должны быть пройдены базовой точкой. При этом отдельные точки траектории, предпочтительно, определяются пространственными координатами, определяющими положение отдельных точек траектории в трех пространственных направлениях. Например, для каждой точки траектории может быть задан набор координат или вектор позиции с тремя координатами, указывающими положение соответствующей точки траектории в трехмерной декартовой системе координат.

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

Затем преобразованные координаты осей отдельных точек траектории служат для управления регуляторами, привязанными к отдельным осям, что само по себе известно из уровня техники, как, например, из уже цитировавшейся вначале патентной заявки DE 10342471 A1.

Затем регуляторы, привязанные к отдельным осям робота, управляют приводными двигателями отдельных осей робота, так что базовая точка (например, Tool Center Point) последовательно проходит отдельные точки заданной траектории робота.

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

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

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

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

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

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

В рамках изобретения величины внутренних вращающих моментов содержат член Mfric, stat статического трения, отображающий трение, не зависящее от скорости, действующее в направлении вращения соответствующего приводного двигателя и которое может быть вычислено по знаку первой производной q ˙ i нескорректированных координат осей точек траектории по времени и по заданной постоянной статического сопротивления. При этом член Mfric, stat статического трения вычисляется по постоянной fista статического трения и по нескорректированным координатам qi осей по следующей формуле: M f r i c , s t a t , i = f i s t a sgn ( q ˙ i )

причем индекс i означает соответствующую ось робота.

Кроме того, величины внутренних вращающих моментов, вычисленные в рамках динамической модели робота, предпочтительно, содержат член Mfric, dyn динамического трения, причем речь идет о линейном члене, действующем пропорционально скорости вращения соответствующего приводного двигателя. Член динамического трения может быть, например, вычислен по динамической постоянной fivis трения и первой производной q ˙ i нескорректированных координат осей точек траектории по времени по следующей формуле:

M f r i c , d y n , i = f i v i s q ˙ i

Наконец, величины внутренних вращающих моментов, вычисленные в рамках динамической модели робота, предпочтительно, содержат также инерционный член Minert, отображающий механическую инерционность трансмиссии соответствующей оси робота и пропорциональный ускорению вращения соответствующего приводного двигателя. При этом инерционный член Minert может быть вычислен по второй производной q ¨ i нескорректированных координат осей точек траектории по времени и по постоянной Ji по следующей формуле:

.

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

«Внутренние» параметры fista, fivis и Ji, предпочтительно, экспериментально определяются для каждой оси с помощью специальной программы перемещения робота и метода оптимизации. При этом во время этого перемещения считываются создаваемые вращающие моменты двигателей приводов и одновременно вычисляются вращающие моменты двигателей, получающиеся только за счет масс двигателей. Для каждой результирующей разности моментов методом наименьших квадратов вычисляются внутренние параметры. Полученный набор параметров относится к текущей температуре ветви двигателя/передачи соответствующей оси. Рабочая температура робота подразделяется на дискретные шаги. Робот при перемещении последовательно нагревается. По достижении соответствующего очередного уровня температуры для определения параметров fista, fivis и Ji осуществляется вышеупомянутый метод идентификации, и одновременно записывается соответствующая температура. Таким образом, для каждой оси при каждом шаге температуры получают соответствующий набор параметров. Позднее во время работы для каждой оси циклически считывается текущая величина температуры, а после этого в режиме работы «online» устанавливается соответствующий набор параметров.

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

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

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

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

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

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

фиг.2А и 2В - способ управления в виде блок-схемы программы,

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

фиг.4 - диаграмма для вычисления внутреннего трения в зависимости от производной координат осей по времени,

фиг.5 - схема определения параметров динамической модели робота в рамках процесса калибровки,

фиг.6 - вариант фиг.5, в котором параметры модели вычисляются иным образом, а также

фиг.7 - вариант фиг.5, в котором ось робота для определения параметров динамической модели робота заторможена до остановки.

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

При этом отдельные оси робота приводятся в движение приводными двигателями 1, что известно из уже цитировавшейся вначале патентной заявки DE 10342471 A1.

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

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

Затем интерполятор 3 траектории преобразует пространственные координаты отдельных точек траектории согласно заданной инверсной кинематике робота в координаты осей, отображающие положение отдельных осей окрасочного робота в соответствующих точках траектории. Таким образом, интерполятор траектории выдает многомерный вектор θ _ позиции, причем число измерений соответствует числу осей робота, так что отдельные компоненты qi вектора θ _ позиции отображают положения отдельных осей окрасочного робота в соответствующих точках траектории.

Затем вектор θ _ позиции подается в вычислительный блок 4, вычисляющий первую d θ _ / d t и вторую производную d θ _ 2 / d t 2 вектора θ _ позиции по времени, т.е. скорость и ускорение в системе координат осей.

Кроме того, система управления содержит динамическую модель 5 робота, реализованную с помощью программных средств, которая по вектору θ _ позиции, отнесенному к оси, по первой d θ _ / d t и второй производной d θ _ 2 / d t 2 вектора θ _ позиции по времени рассчитывает вектор M _ момента, который состоит из суммы внешнего вращающего момента M _ A U β E N и внутреннего вращающего момента M _ INNEN , причем внутренний вращающий момент M _ INNEN учитывает трение и инерционность отдельных осей робота и вычисляется по следующей формуле:

M _ INNEN , i = f i s t a sgn ( q i ) + f v i s q ˙ i + J i q ¨ i

Затем вектор M _ = M _ AU β EM + M _ INNEN момента подается на вычислительный блок 6, вычисляющий по вектору M _ момента вектор Δ θ _ поправки траектории, который затем используется для корректировки траектории, как это еще будет описано подробно. При этом вектор поправки Δ θ _ траектории вычисляется по вектору M _ момента по следующей формуле:

Δ θ i ( s ) = M i s 2 θ + s D + K

Затем нескорректированный вектор θ _ позиции вместе с вектором Δ θ _ поправки траектории подается в сумматор 7, вычисляющий скорректированный вектор θ _ KORR позиции, причем скорректированный вектор θ _ KORR позиции компенсирует динамические отклонения траектории при управлении роботом.

Затем скорректированный вектор θ _ KORR позиции для своего сглаживания подается в фильтр 8. Таким образом, фильтр 8 выдает сглаженный вектор θ _ * KORR позиции, причем отдельные компоненты скорректированного и сглаженного вектора θ _ * KORR позиции подаются в отдельные регуляторы 2 осей для отдельных осей робота.

Блок-схема на фиг.2А и 2В поясняет рабочий способ вышеупомянутого управления роботом.

При первом шаге S1 интерполятору 3 задается траектория из нескольких точек, через которые базовая точка (Tool Center Point (TCP)) окрасочного робота должна последовательно пройти, причем отдельные точки заданной траектории определены в пространственных декартовых координатах.

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

Затем при следующем шаге S3 вычислительное устройство 4 вычисляет первую d θ _ / d t и вторую производную d θ _ 2 / d t 2 вектора θ _ позиции по времени в координатах осей.

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

Шаг S5 предусматривает, чтобы в зависимости от предварительно измеренной окружающей температуры Т параметры динамической рабочей модели 5 затем считывались из накопителя параметров, причем речь в случае параметров модели идет о статической постоянной fista трения, динамической постоянной fivis трения и об инерционной постоянной Ji.

Затем при шаге S6 в динамической модели 5 робота для учета трения и инерционности робота вычисляется суммарный момент M _ как сумма внутреннего момента M _ INNEN и внешнего момента M _ AU β EN .

Затем шаг S7 предусматривает, чтобы суммарный момент M _ , вычисленный в соответствии с динамической моделью робота, пересчитывался в соответствии с упругостью осей робота в соответствующие поправки Δ θ _ траектории для отдельных точек траектории в координатах осей.

Затем при шаге S8 вычисляются скорректированные координаты θ _ KORR осей отдельных точек траектории, для чего сумматор 7 прибавляет поправки Δ θ _ траектории к нескорректированным координатам θ _ осей.

Кроме того, шаг S9 предусматривает, чтобы скорректированные координаты θ _ KORR осей в целях сглаживания отфильтровывались фильтром 8.

Кроме того, при шаге S10 осуществляется настройка отдельных регуляторов 2 осей со скорректированными и с отфильтрованными координатами θ _ * KORR осей.

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

На фиг.3 изображен пример выполнения вычислительного блока 6 на фиг.1, вычисляющего по вектору M _ момента вектор поправки Δ θ _ траектории. В этом примере выполнения вычислительный блок 6 состоит из пропорционального звена Р 9, пропорционального звена РТ1 10, пропорционального звена РТ2 11 и сумматора 12, причем пропорциональное звено Р 9, пропорциональное звено РТ1 10, пропорциональное звено РТ2 11 со стороны входа принимают вектор M _ момента, а со стороны выхода соединены с сумматором 12, суммирующим для вычисления вектора поправки Δ θ _ траектории выходные сигналы пропорционального звена Р 9, пропорционального звена РТ1 10 и пропорционального звена РТ2 11.

Пропорциональное звено Р само по себе известно из уровня техники и обозначается как пропорциональное звено Р. Таким образом, пропорциональное звено 9 имеет пропорциональную переходную характеристику.

Пропорциональное звено РТ1 известно из уровня техники и имеет пропорциональную переходную характеристику с запаздыванием первого порядка.

Наконец, пропорциональное звено РТ2 также известно из уровня техники и имеет пропорциональную переходную характеристику с запаздыванием второго порядка.

Таким образом, отдельные компоненты Δ θ _ i _ вектора поправки Δ θ _ траектории вычисляются вычислительным блоком 6 как следующая передаточная функция:

Δ θ i ( s ) = M i s 2 θ + s D + K

На фиг.4 изображена диаграмма для вычисления внутреннего момента Mfri в зависимости от первой производной q ˙ координат осей по времени. Из нее видно, что к моменту Mfric трения в мертвой зоне вокруг нулевой точки имеет место особый подход, для чего величины момента Mfric трения от начала до конца мертвой зоны интерполируются линейно.

На фиг.5 в упрощенном виде показано вычисление вышеупомянутых параметров динамической модели робота. При этом в качестве примера изображена лишь одна единственная ось 13 робота с концевым эффектором 14 и соединительным элементом 15 передачи.

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

Затем у концевого эффектора 14 с помощью измерительного блока 17 измеряется и передается на блок 18 обработки данных отклонение, причем блок 18 обработки данных для расчета механической переходной характеристики оси 13 робота подвергает измеренное отклонение концевого эффектора анализу Фурье или корреляционному анализу.

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

Особенность этого примера выполнения заключается в том, что измерительный блок 17 со стороны выхода соединен с анализатором 19, сравнивающим измеренное отклонение с критерием качества и осуществляющим соответствующую поправку в корректирующем блоке 20. Корректирующий блок 20, в свою очередь, соединен со схемой 21 вычислений, воздействующей на критерий качества анализатора 19.

Наконец, на фиг.7 изображен вариант фиг.5, причем концевой эффектор 14 при этом тормозится до остановки. При этом возбудитель 16 проворачивает приводной двигатель пошаговым образом дальше и при этом для расчета жесткости пружины оси 13 измеряет вращающий момент приводного двигателя.

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

ПЕРЕЧЕНЬ ПОЗИЦИЙ

1. Приводные двигатели

2. Регулятор осей

3. Интерполятор траектории

4. Вычислительный блок

5. Модель робота

6. Вычислительный блок

7. Сумматор

8. Фильтр

9. Пропорциональное звено Р

10. Пропорциональное звено РТ1

11. Пропорциональное звено РТ2

12. Сумматор

13. Ось робота

14. Концевой эффектор

15. Соединительный элемент передачи

16. Возбудитель

17. Измерительный блок

18. Блок обработки данных

19. Анализатор

20. Корректирующий блок

21. Схема вычислений

1. Способ управления многоосным роботом, в частности окрасочным роботом, включающий задание (S1) траектории робота с помощью нескольких точек траектории, которые должны быть пройдены базовой точкой робота, причем отдельные точки траектории определены соответствующими пространственными координатами, преобразование (S2) пространственных координат отдельных точек траектории согласно инверсной кинематике робота в соответствующие координаты ( θ _ ) осей, причем координаты ( θ _ ) осей отображают положение отдельных осей робота в соответствующих точках траектории, настройку (S10) привязанных к осям регуляторов (2) для отдельных осей робота в соответствии с преобразованными координатами ( θ _ ) осей, настройку (S11) привязанных к осям приводных двигателей (1) отдельных осей с помощью соответствующих регуляторов (2), вычисление (S3-S7) поправок ( Δ θ _ ) для отдельных точек траектории в соответствии с динамической моделью (5) робота, причем поправки ( Δ θ _ ) траектории учитывают упругость, и/или трение, и/или инерционность робота, вычисление (S8) скорректированных координат ( Δ θ _ K O R R ) осей для отдельных точек траектории по нескорректированным координатам ( θ _ ) осей отдельных точек траектории и по поправкам ( Δ θ _ ) траектории, и настройку (S10) привязанных к осям регуляторов (2) со скорректированными координатами ( Δ θ _ K O R R ) осей, отличающийся тем, что осуществляют вычисление (S6) величин ( M _ INNEN ) внутренних вращающих моментов и/или величин M _ AUSEN внешних вращающих моментов по нескорректированным внешним координатам ( θ _ ) точек траектории в соответствии с динамической моделью (5) робота, причем величины ( M _ INNEN ) внутренних вращающих моментов отображают внутренний вращающий момент приводных двигателей (1) и соответствующих осей робота, при этом величины ( M _ INNEN ) внутренних вращающих моментов содержат следующие составляющие: член статического трения, член динамического трения и/или инерционный член, и вычисление (S7) поправок ( Δ θ _ ) траектории по величинам ( M _ INNEN ) внутренних вращающих моментов и величинам M _ AUSEN внешних вращающих моментов.

2. Способ по п.1, отличающийся тем, что упомянутые составляющие для величин ( M _ INNEN , M _ INNEN , i ) внутренних вращающих моментов включают упомянутый член статического трения, который вычисляют по знаку первой производной ( q ˙ i ) нескорректированных координат ( θ _ ) для осей точек траектории по времени и по статической постоянной (fista) трения, и/или упомянутый член динамического трения, который вычисляют по первой производной ( q ˙ i ) нескорректированных координат ( θ _ ) осей точек траектории по времени и по динамической постоянной (fivis) трения и/или упомянутый инерционный член, который вычисляют по второй производной ( q ¨ i ) нескорректированных координат ( θ _ ) осей точек траектории по времени и по инерционной постоянной (Ji).

3. Способ по любому из пп.1 и 2, отличающийся тем, что осуществляют измерение (S4) окружающей температуры (Т), считывание (5) параметров (fista, fivis, Ji) динамической модели робота из накопителя параметров в соответствии с измеренной окружающей температурой (Т) и вычисление (S7) поправок ( Δ θ _ ) траектории со считанными параметрами (fista, fivis, Ji) динамической модели робота.

4. Способ по п.3, отличающийся тем, что параметры модели, считанные в зависимости от температуры, содержат следующие величины: статическую постоянную (fista) трения, и/или динамическую постоянную (fivis) трения, и/или инерционную постоянную (Ji).

5. Способ по любому из пп.1 и 2, отличающийся тем, что поправки ( Δ θ _ ) траектории вычисляют по величинам ( M _ INNEN ) внутренних вращающих моментов и/или величинам M _ AUSEN внешних вращающих моментов с помощью пропорционального звена Р (9), и/или пропорционального звена РТ1 (10), и/или пропорционального звена РТ2 (11).

6. Способ по п.1, отличающийся тем, что поправки ( Δ θ _ ) траектории вычисляются с учетом упругости осей робота по величинам ( M _ INNEN ) внутренних вращающих моментов и/или величинам M _ AUSEN внешних вращающих моментов.

7. Способ по любому из пп.1 и 2, отличающийся тем, что в нем предусмотрена фильтрация (S9) скорректированных координат ( Δ θ _ K O R R ) осей точек траектории для сглаживания коррекции до настройки регуляторов (2), привязанных к осям.

8. Способ по п.7, отличающийся тем, что скорректированные координаты (θKORR) осей отфильтровывают следующими типами фильтров: фильтром средней величины, фильтром средней величины, определяющим средневзвешенную величину, фильтром, увеличивающим фазу, фильтром FIR, полосовым фильтром и/или фильтром нижних частот.

9. Способ по любому из пп.1 и 2, отличающийся тем, что поправки ( Δ θ _ ) траектории при коррекции прибавляются к нескорректированным координатам ( θ _ ) осей точек траектории.

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

11. Робот, в частности многоосный робот, в особенности окрасочный робот, с системой управления по п.10 формулы изобретения.



 

Похожие патенты:

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

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

Изобретение относится к рабочей станции и способу управления такой станцией. .

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

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

Изобретение относится к области строительства, а именно к устройству управления строительной машиной со стрелой. .

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

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

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

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

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

Изобретение относится к способу обучения робота и способу управления обученным роботом, обеспечивающим удобное и легкое использование робота. Для обучения робота помещают его в заданное положение Р0 в области рабочего места относительно объектов в окружении робота. Используют часть или точку Р манипулятора робота, например точку, к которой прикреплен инструмент при использовании робота, для определения одного или нескольких геометрических признаков относительно указанных объектов в окружении робота. Устанавливают связь между указанными геометрическими признаками и первыми координатами связанной с роботом системы координат. Причем робот выполнен с возможностью выполнения, в случае поступления соответствующей команды, перемещения заданных частей робота относительно указанного окружения посредством ссылки на указанные один или несколько геометрических признаков. Геометрические признаки могут быть сохранены в запоминающем устройстве и использованы впоследствии также и при других настройках, отличающихся от конкретных настроек, при которых производилось обучение. 2 н. и 8 з.п. ф-лы, 1 ил.

Изобретение относится к способу и системе для распознавания физических объектов (103-105). В способе объект (105) захватывают захватным устройством (112), прикрепленным к роботизированной руке (116). Используя датчик изображения, получают множество исходных изображений области, содержащей объект (105), в то время как объект (105) перемещается роботизированной рукой (116). На захватном устройстве (112) установлена камера (114) с возможностью перемещения вдоль него или способная иначе контролировать перемещение захватного устройства (112). Движущиеся элементы изображения извлекают из множества исходных изображений, вычисляя на основе исходных изображений изображение расхождения и формируя из изображения расхождения фильтрующее изображение. Результирующее изображение получают с использованием фильтрующего изображения в качестве битовой маски. Результирующее изображение используют для классификации объекта (105). Изобретение обеспечивает улучшение качества выбора объектов из рабочего пространства робота, уменьшение количества перемещений роботизированной руки и, таким образом, уменьшение потребления энергии роботизированной рукой. 4 н. и 13 з.п. ф-лы, 5 ил.
Наверх