RU2193480C1 - Устройство для управления приводом робота - Google Patents

Устройство для управления приводом робота Download PDF

Info

Publication number
RU2193480C1
RU2193480C1 RU2002102293/02A RU2002102293A RU2193480C1 RU 2193480 C1 RU2193480 C1 RU 2193480C1 RU 2002102293/02 A RU2002102293/02 A RU 2002102293/02A RU 2002102293 A RU2002102293 A RU 2002102293A RU 2193480 C1 RU2193480 C1 RU 2193480C1
Authority
RU
Russia
Prior art keywords
input
adder
output
sensor
drive
Prior art date
Application number
RU2002102293/02A
Other languages
English (en)
Inventor
В.Ф. Филаретов
Original Assignee
Дальневосточный государственный технический университет
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Дальневосточный государственный технический университет filed Critical Дальневосточный государственный технический университет
Priority to RU2002102293/02A priority Critical patent/RU2193480C1/ru
Application granted granted Critical
Publication of RU2193480C1 publication Critical patent/RU2193480C1/ru

Links

Images

Landscapes

  • Manipulator (AREA)

Abstract

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

Description

Изобретение относится к робототехнике и может быть использовано при создании систем управления приводами роботов.
Известно устройство для управления приводом робота, содержащее последовательно соединенные первый блок умножения и первый сумматор, последовательно подключенные усилитель и двигатель, связанный с первым датчиком скорости непосредственно и через редуктор с первым датчиком положения, выход которого соединен с первым входом второго сумматора, подключенного вторым входом к входу устройства, последовательно соединенные второй датчик положения, третий сумматор, четвертый сумматор, первый квадратор и второй блок умножения, второй вход которого подключен к выходу датчика массы и первому входу третьего блока умножения, а выход - к первому входу пятого сумматора, соединенного вторым входом с выходом первого задатчика сигнала, а третьим входом с выходом второго квадратора, вход которого подключен к выходу третьего сумматора и первому входу шестого сумматора, соединенного выходом с первым входом четвертого блока умножения, а вторым входом с выходом третьего блока умножения, второй вход которого подключен к выходу четвертого сумматора, соединенного вторым входом с выходом второго задатчика сигнала, выход третьего задатчика сигнала подключен к второму входу третьего сумматора, а выход второго датчика скорости соединен с вторым входом четвертого блока умножения. Кроме того, устройство содержит пятый блок умножения, седьмой сумматор и последовательно соединенные релейный блок и восьмой сумматор, выход которого подключен к второму входу первого сумматора, соединенного выходом с входом усилителя, выход первого датчика скорости подключен к входу релейного блока, к второму входу восьмого сумматора и первому входу седьмого сумматора, второй вход которого соединен с выходом второго сумматора, а выход - с первым входом первого блока умножения, подключенного вторым входом к выходу пятого сумматора, первый вход пятого блока умножения соединен с выходом четвертого блока умножения, второй вход - с выходом первого датчика скорости, а выход - с третьим входом восьмого сумматора (см. а.с. СССР 1484702, МКИ В 25 J 13/00, 1989 г.).
Его недостатком является то, что оно предназначено только для конкретного привода конкретного робота. Для приводов других степеней подвижности других роботов (с другой кинематикой) это устройство не будет обеспечивать требуемую точность и устойчивость работы.
Известно также устройство для управления приводом робота, содержащее последовательно соединенные первый сумматор, второй сумматор, первый блок умножения, третий сумматор, усилитель и двигатель, связанный с первым датчиком скорости непосредственно и через редуктор с первым датчиком положения, выход которого подключен к первому входу первого сумматора, соединенного вторым входом с входом устройства, последовательно подключенные релейный элемент и четвертый сумматор, второй вход которого подключен к входу релейного элемента, второму входу второго сумматора и выходу первого датчика скорости, выход - к второму входу третьего сумматора, последовательно соединенные первый задатчик сигнала и пятый сумматор, а также второй датчик скорости, датчик массы, второй задатчик сигнала, квадратор, шестой сумматор и с второго по пятый блоки умножения, первый датчик ускорения, а также первый и второй функциональные преобразователи, вход каждого из которых соединен с выходом первого датчика положения, выход датчика массы подключен к второму входу первого блока умножения, первому входу шестого сумматора и второму входу пятого сумматора, соединенного выходом с первыми входами второго и третьего блоков умножения, второй вход каждого из которых подключен соответственно к выходу первого и второго функционального преобразователя, а их выходы соответственно - ко второму входу шестого сумматора и первому входу четвертого блока умножения, соединенного вторым входом через квадратор с выходом второго датчика скорости, а выходом с третьим входом четвертого сумматора, четвертый вход которого подключен к выходу пятого блока умножения, соединенного первым входом с выходом датчика ускорения, а вторым входом с выходом шестого сумматора, третий вход которого подключен к выходу второго задатчика сигнала, а выход сумматора соединен с третьим входом третьего сумматора (см. патент РФ 1782721, БИ 47, 1992 г.).
Данное устройство по своей технической сущности является наиболее близким к изобретению.
Недостатком прототипа является то, что рассматриваемый в нем робот имеет только три степени подвижности. Однако при трех степенях подвижности у робота значительно сокращается рабочая зона (зона обслуживания). Например, при работе на конвейере желательно перемещение робота вдоль этого конвейера без его остановки на время выполнения рабочих операций. Но при введении линейной четвертой степени подвижности в рассматриваемом приводе появляются дополнительные возмущающие моменты, ухудшающие его показатели качества. В результате появляется задача компенсации этих вредных дополнительных моментов за счет введения дополнительных сигналов коррекции.
Задачей, на решение которой направлено заявляемое техническое решение, является обеспечение полной инвариантности динамических свойств электропривода к непрерывным и быстрым изменениям его динамических моментных нагрузочных характеристик при движении манипулятора по всем четырем степеням подвижности и тем самым повышение динамической точности управления.
Технический результат, который может быть получен при реализации заявляемого технического решения, выражается в формировании дополнительного сигнала управления, подаваемого на вход привода, который обеспечивает получение дополнительного моментного воздействия, компенсирующего вредное моментное воздействие со стороны четвертой дополнительной степени подвижности на качественные показатели работы рассматриваемого привода.
Поставленная задача решается тем, что в устройство для управления приводом робота, содержащее последовательно соединенные первый сумматор, второй сумматор, первый блок умножения, третий сумматор, усилитель и двигатель, связанный с первым датчиком скорости непосредственно и через редуктор с первым датчиком положения, выход которого подключен к первому входу первого сумматора, соединенного вторым входом с входом устройства, последовательно подключенные релейный элемент и четвертый сумматор, второй вход которого подключен к входу релейного элемента, второму входу второго сумматора и выходу первого датчика скорости, выход - к второму входу третьего сумматора, последовательно соединенные первый задатчик сигнала и пятый сумматор, а также второй датчик скорости, датчик массы, второй задатчик сигнала, квадратор, шестой сумматор и с второго по пятый блоки умножения, первый датчик ускорения, а также первый и второй функциональные преобразователи, вход каждого из которых соединен с выходом первого датчика положения, выход датчика массы подключен к второму входу первого блока умножения, первому входу шестого сумматора и второму входу пятого сумматора, соединенного выходом с первыми входами второго и третьего блоков умножения, второй вход каждого из которых подключен соответственно к выходу первого и второго функционального преобразователя, а их выходы соответственно - ко второму входу шестого сумматора и первому входу четвертого блока умножения, соединенного вторым входом через квадратор с выходом второго датчика скорости, а выходом с третьим входом четвертого сумматора, четвертый вход которого подключен к выходу пятого блока умножения, соединенного первым входом с выходом датчика ускорения, а вторым входом с выходом шестого сумматора, третий вход которого подключен к выходу второго задатчика сигнала, а выход сумматора соединен с третьим входом третьего сумматора, дополнительно введены второй датчик положения, седьмой сумматор, второй вход которого подключен к выходу первого датчика положения, третий функциональный преобразователь, шестой блок умножения, второй вход которого подключен к выходу пятого сумматора, и седьмой блок умножения, второй вход которого подключен к выходу второго датчика ускорения, а его выход - к пятому входу четвертого сумматора.
Сопоставительный анализ существенных признаков предлагаемого технического решения с существенными признаками аналогов и прототипа свидетельствует о его соответствии критерию "новизна".
При этом отличительные признаки формулы изобретения обеспечивают высокую точность и устойчивость работы привода робота в условиях существенного изменения параметров нагрузки.
На фиг.1 дана блок-схема предлагаемого устройства для управления приводом робота, а фиг.2 - кинематическая схема исполнительного органа робота.
Устройство для управления приводом робота содержит последовательно соединенные первый сумматор 1, второй сумматор 2, первый блок умножения 3, третий сумматор 4, усилитель 5 и двигатель 6, связанный с первым датчиком 7 скорости непосредственно и через редуктор 8 с первым датчиком 9 положения, выход которого подключен к первому входу первого сумматора 1, соединенного вторым входом с входом устройства, последовательно подключенные релейный элемент 10 и четвертый сумматор 11, второй вход которого подключен к входу релейного элемента 10, второму входу второго сумматора 2 и выходу первого датчика 7 скорости, выход - к второму входу третьего сумматора 4, последовательно соединенные первый задатчик сигнала 12 и пятый сумматор 13, а также второй датчик 14 скорости, датчик массы 15, второй задатчик 16 сигнала, квадратор 17, шестой сумматор 18 и с второго по пятый блоки 19-22 умножения, первый датчик 23 ускорения, а также первый 24 и второй 25 функциональные преобразователи, вход каждого из которых соединен с выходом первого датчика 9 положения, выход датчика массы 15 подключен к второму входу первого блока 3 умножения, первому входу шестого сумматора 18 и второму входу пятого сумматора 13, соединенного выходом с первыми входами второго 19 и третьего 20 блоков умножения, второй вход каждого из которых подключен соответственно к выходу первого 24 и второго 25 функционального преобразователя, а их выходы соответственно - ко второму входу шестого сумматора 18 и первому входу четвертого блока 21 умножения, соединенного вторым входом через квадратор 17 с выходом второго датчика 14 скорости, а выходом с третьим входом четвертого сумматора 11, четвертый вход которого подключен к выходу пятого блока 22 умножения, соединенного первым входом с выходом датчика 23 ускорения, а вторым входом с выходом шестого сумматора 18, третий вход которого подключен к выходу второго задатчика 16 сигнала, а выход сумматора 2 соединен с третьим входом третьего сумматора 4, второй датчик 26 положения, седьмой сумматор 27, второй вход которого подключен к выходу первого датчика 9 положения, третий функциональный преобразователь 28, шестой блок 29 умножения, второй вход которого подключен к выходу пятого сумматора 13, и седьмой блок 30 умножения, второй вход которого подключен к выходу второго датчика 31 ускорения, а его выход - к пятому входу четвертого сумматора 11.
На фигурах введены следующие обозначения:
αВХ - сигнал желаемого положения;
q1, q2, q3, q4- соответствующие обобщенные координаты исполнительного органа робота;
Figure 00000002
- скорости изменения соответствующих обобщенных координат;
ε - ошибка привода (величина рассогласования);
m1, m2, m3, mг - соответственно массы первого, второго, третьего звеньев исполнительного органа и захваченного груза;
l2*, l3* - расстояния от осей вращения горизонтальных звеньев до их центров масс;
l2, l3 - длины соответствующих горизонтальных звеньев;
Figure 00000003
- скорость вращения ротора двигателя;
U*, U - соответственно усиливаемый сигнал и сигнал управления двигателем 6.
Устройство работает следующим образом. Сигнал ошибки ε сумматора 1 после коррекции в блоках 2, 3, 4, усиливаясь, поступает на электродвигатель 6, приводя его вал во вращательное движение с направлением и скоростью (ускорением), зависящими от величины поступающего сигнала U, моментов трения и внешнего моментного воздействия Мв. Электропривод при работе с различными грузами, а также за счет взаимовлияния степеней подвижности исполнительного органа обладает переменными моментными характеристиками, которые могут меняться в широких пределах. Это снижает качественные показатели электропривода и даже приводит к потере устойчивости его работы. В результате возникает задача, связанная с обеспечением инвариантности динамических свойств электропривода к непрерывным и быстрым изменениям его моментных нагрузочных характеристик, что позволяет обеспечить стабильность заданного качества системы управления.
Рассматриваемый привод управляет обобщенной координатой q3.
Конструкция робота (фиг.2) является наиболее типовой для отечественных и зарубежных промышленных роботов (см., например, роботы типа skilam, SR-2, SR-3, SR-4, ТУР-2.5, гранат-2,5 и т.д.).
Эта конструкция позволяет осуществлять вертикальное прямолинейное перемещение груза (координата q4), два вращательных движения в горизонтальной плоскости (координаты q2 и q3) и линейное горизонтальное перемещение (координата q1). Моментные характеристики привода, управляющего координатой q3, существенно зависят от изменения координат
Figure 00000004
и груза mг. В вязи с этим для качественного управления координатой q3 необходимо точно компенсировать отрицательное влияние изменения этих координат, а также переменной массы груза mг на динамические свойства рассматриваемого привода (координата q3).
На основе уравнений Лагранжа II рода моментное воздействие на выходной вал привода управления координатой q2 с грузом имеет вид
Figure 00000005

С учетом соотношения (1), а также уравнений электрической
Figure 00000006

и механической
Figure 00000007

цепей электродвигателя постоянного тока с постоянными магнитами или независимого возбуждения рассматриваемый привод, управляющий координатой q3, можно описать следующим уравнением:
Figure 00000008

где R - активное сопротивление якорной цепи двигателя;
J - момент инерции якоря двигателя и вращающихся частей редуктора, приведенных к валу двигателя;
kм - коэффициент крутящего момента;
kω - коэффициент противо-ЭДС;
kв - коэффициент вязкого трения;
iр - передаточное отношение редуктора;
Мстр - момент сухого трения;
kу - коэффициент усиления усилителя 5;
i - ток якоря;
Figure 00000009
- ускорение вращения вала двигателя третьей степени подвижности.
Из уравнения (2) видно, что параметры этого уравнения, а следовательно, и параметры привода, управляющего координатой q3, являются существенно переменными, зависящими от величины
Figure 00000010
В результате в процессе работы привода меняются (притом существенно) его динамические свойства. Для реализации поставленной выше задачи необходимо сформировать такое корректирующее устройство, которое застабилизировало бы параметры привода таким образом, чтобы он описывался дифференциальным уравнением с постоянными параметрами.
Первый положительный вход сумматора 2 (со стороны сумматора 1) единичный, а его второй отрицательный вход имеет коэффициент усиления kω/ky.
Первый, третий и четвертый положительные входы сумматора 11 (соответственно со стороны релейного элемента 10, блока 21 умножения и блока 22 умножения) единичные, его второй положительный вход (со стороны датчика 7 скорости) имеет коэффициент усиления kмkω/R+kв, а пятый положительный вход (со стороны блока 30 умножения) - коэффициент усиления, равный 1/l2. Причем выходной сигнал релейного элемента 10 с нулевой нейтральной точкой имеет вид
Figure 00000011

где
Figure 00000012
- величина момента сухого трения при движении.
Первый положительный вход сумматора 4 (со стороны блока 3 умножения) имеет коэффициент усиления l32/(jнip2), второй положительный (со стороны сумматора 11) - коэффициент усиления R/kмky, а третий положительный (со стороны сумматора 2) - коэффициент усиления [J + (J3 + m3l3*2)/ip2]/Jн, где Jн - номинальное (желаемое) значение приведенного момента инерции, обеспечивающее рассматриваемому приводу робота заданные динамические свойства и показатели качества.
Первый положительный вход сумматора 13 (со стороны датчика 15) имеет коэффициент усиления l2l3/iр, а его второй положительный вход (со стороны задатчика 12) - единичный коэффициент усиления. Сигнал с выхода задатчика сигнала 16 - (l3 + m3l3*2)/ip.
Первый (со стороны блока 19 умножения) и третий (со стороны задатчика 16 сигнала) положительные входы сумматора 18 имеют единичные коэффициенты усиления, а второй положительный вход (со стороны датчика 15) - коэффициент усиления l32/ip.
Таким образом, на выходе сумматора 13 формируется сигнал l2(m3l3* + mгl3)/ip. Поскольку функциональный преобразователь 24 реализует функциональную зависимость cosq3, то на выходе блока 19 умножения формируется сигнал l2(m3l3* + mгl3)cos q3/ip, а на выходе сумматора 18 - сигнал [J3 + m3l3*2 + mгl32 + l2(m3l3* + mгl3)cos q3]/ip.
Датчик 23 ускорения измеряет ускорение вращения второй степени подвижности робота (координату
Figure 00000013
), поэтому на выходе блока 22 умножения формируется сигнал
Figure 00000014

Датчик 14 скорости измеряет скорость вращения во второй степени подвижности (координату q2), а функциональный преобразователь 25 реализует функциональную зависимость sin q3. Поэтому на выходе блока 20 умножения появляется сигнал l2(m3l3* + mгl3)sin q3/ip, а на выходе блока 21 умножения - сигнал
Figure 00000015

Датчик 26 положения установлен во второй степени подвижности робота и измеряет координату q2. Датчик ускорения 31 установлен в первой степени подвижности робота и измеряет координату
Figure 00000016
. Сумматор 27 имеет положительные входы с единичными коэффициентами усиления. В результате на его выходе формируется сигнал q2+q3. Функциональный преобразователь 28 реализует функцию sin(q2+q3). В результате на выходе блока 30 умножения формируется сигнал
Figure 00000017

С учетом отмеченных выше коэффициентов усиления соответствующих входов сумматора 11 на его выходе формируется сигнал
Figure 00000018

На выходе сумматора 2 формируется сигнал
Figure 00000019

а на выходе блока 3 умножения - сигнал
Figure 00000020

Таким образом, с учетом указанных коэффициентов усиления соответствующих входов сумматора 4 на его выходе окончательно будет сформирован сигнал U* вида
Figure 00000021

Несложно показать, что, поскольку при движении привода
Figure 00000022
достаточно точно соответствует Мстр, то, подставив полученное значение в соотношение (2), получим уравнение
Figure 00000023
,
которое имеет постоянные желаемые параметры. То есть, сам привод, управляющий координатой q3, будет обладать постоянными желаемыми динамическим свойствами и качественными показателями.
Таким образом, за счет введения дополнительных элементов и связей удалось обеспечить полную инвариантность привода к эффектам взаимовлияния между степенями подвижности и моментам трения. Это позволяет получить стабильно высокое качество управления в любых режимах работы привода.
Практическая реализация предлагаемого устройства не вызывает затруднений, так как в нем использованы только типовые электронные элементы.

Claims (1)

  1. Устройство для управления приводом робота, содержащее последовательно соединенные первый сумматор, второй сумматор, первый блок умножения, третий сумматор, усилитель и двигатель, связанный с первым датчиком скорости непосредственно и через редуктор с первым датчиком положения, выход которого подключен к первому входу первого сумматора, соединенного вторым входом с входом устройства, последовательно подключенные релейный элемент и четвертый сумматор, второй вход которого подключен к входу релейного элемента, второму входу второго сумматора и выходу первого датчика скорости, выход - к второму входу третьего сумматора, последовательно соединенные первый задатчик сигнала и пятый сумматор, а также второй датчик скорости, датчик массы, второй задатчик сигнала, квадратор, шестой сумматор и с второго по пятый блоки умножения, первый датчик ускорения, а также первый и второй функциональные преобразователи, вход каждого из которых соединен с выходом первого датчика положения, выход датчика массы подключен к второму входу первого блока умножения, первому входу шестого сумматора и второму входу пятого сумматора, соединенного выходом с первыми входами второго и третьего блоков умножения, второй вход каждого из которых подключен соответственно к выходу первого и второго функционального преобразователя, а их выходы соответственно - ко второму входу шестого сумматора и первому входу четвертого блока умножения, соединенного вторым входом через квадратор с выходом второго датчика скорости, а выходом - с третьим входом четвертого сумматора, четвертый вход которого подключен к выходу пятого блока умножения, соединенного первым входом с выходом датчика ускорения, а вторым входом - с выходом шестого сумматора, третий вход которого подключен к выходу второго задатчика сигнала, а выход сумматора соединен с третьим входом третьего сумматора, отличающееся тем, что в него дополнительно введены второй датчик положения, седьмой сумматор, второй вход которого подключен к выходу первого датчика положения, третий функциональный преобразователь, шестой блок умножения, второй вход которого подключен к выходу пятого сумматора, и седьмой блок умножения, второй вход которого подключен к выходу второго датчика ускорения, а его выход - к пятому входу четвертого сумматора.
RU2002102293/02A 2002-01-25 2002-01-25 Устройство для управления приводом робота RU2193480C1 (ru)

Priority Applications (1)

Application Number Priority Date Filing Date Title
RU2002102293/02A RU2193480C1 (ru) 2002-01-25 2002-01-25 Устройство для управления приводом робота

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
RU2002102293/02A RU2193480C1 (ru) 2002-01-25 2002-01-25 Устройство для управления приводом робота

Publications (1)

Publication Number Publication Date
RU2193480C1 true RU2193480C1 (ru) 2002-11-27

Family

ID=20255187

Family Applications (1)

Application Number Title Priority Date Filing Date
RU2002102293/02A RU2193480C1 (ru) 2002-01-25 2002-01-25 Устройство для управления приводом робота

Country Status (1)

Country Link
RU (1) RU2193480C1 (ru)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU2487796C2 (ru) * 2007-05-24 2013-07-20 Дюрр Системз Гмбх Управление перемещением упругих структур робота

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU2487796C2 (ru) * 2007-05-24 2013-07-20 Дюрр Системз Гмбх Управление перемещением упругих структур робота
US8527092B2 (en) 2007-05-24 2013-09-03 Dürr Systems GmbH Movement controller for elastic robot structures

Similar Documents

Publication Publication Date Title
RU2394674C2 (ru) Самонастраивающийся электропривод робота
RU2325268C1 (ru) Устройство для управления приводом робота
RU2193480C1 (ru) Устройство для управления приводом робота
RU2312007C1 (ru) Устройство для управления приводом робота
RU2359306C2 (ru) Самонастраивающийся электропривод робота
RU2423225C1 (ru) Электропривод робота
RU2209719C1 (ru) Устройство для управления приводом робота
RU2363972C2 (ru) Самонастраивающийся электропривод робота
RU2235015C1 (ru) Устройство для управления приводом робота
RU2212329C1 (ru) Устройство для управления приводом робота
RU2063867C1 (ru) Самонастраивающийся электропривод робота
RU2311283C1 (ru) Устройство для управления приводом робота
RU2258601C1 (ru) Устройство для управления приводом робота
RU2066626C1 (ru) Устройство для управления приводом робота
RU2235016C1 (ru) Устройство для управления приводом робота
RU2380215C1 (ru) Самонастраивающийся электропривод робота
RU2115539C1 (ru) Устройство для управления приводом робота
RU2057001C1 (ru) Устройство для управления приводом робота
RU2335389C2 (ru) Устройство для управления приводом робота
RU2054350C1 (ru) Устройство для управления приводом робота
RU2311284C1 (ru) Устройство для управления приводом робота
RU2398672C1 (ru) Электропривод робота
RU2309444C2 (ru) Самонастраивающийся электропривод робота
RU2187426C2 (ru) Самонастраивающийся электропривод робота
RU2277258C1 (ru) Самонастраивающийся электропривод робота

Legal Events

Date Code Title Description
MM4A The patent is invalid due to non-payment of fees

Effective date: 20040126