RU2212329C1 - Устройство для управления приводом робота - Google Patents
Устройство для управления приводом робота Download PDFInfo
- Publication number
- RU2212329C1 RU2212329C1 RU2002116916/02A RU2002116916A RU2212329C1 RU 2212329 C1 RU2212329 C1 RU 2212329C1 RU 2002116916/02 A RU2002116916/02 A RU 2002116916/02A RU 2002116916 A RU2002116916 A RU 2002116916A RU 2212329 C1 RU2212329 C1 RU 2212329C1
- Authority
- RU
- Russia
- Prior art keywords
- input
- adder
- output
- series
- multiplier unit
- Prior art date
Links
Images
Landscapes
- Manipulator (AREA)
Abstract
Изобретение относится к робототехнике и может быть использовано при создании приводов роботов. Устройство для управления приводом робота содержит последовательно соединенные первый блок умножения, первый сумматор, усилитель и двигатель, последовательно соединенные источник постоянного сигнала, четвертый сумматор, второй блок умножения и пятый сумматор, последовательно соединенные датчик массы и шестой сумматор. Двигатель связан с первым датчиком скорости непосредственно и через редуктор с первым датчиком положения. Выход первого датчика положения соединен с первым входом второго сумматора. Второй сумматор подключен вторым входом к входу устройства, а выходом через третий сумматор - к первому входу первого блока умножения. Выход шестого сумматора подключен к второму входу первого блока умножения. Выход датчика скорости подключен к входу релейного элемента и вторым входам третьего и пятого сумматоров. Третий вход сумматора подключен к выходу релейного элемента, а его выход - к второму входу первого сумматора. В устройство дополнительно введены последовательно соединенные первый синусный функциональный преобразователь, третий блок умножения и седьмой сумматор, последовательно соединенные косинусный функциональный преобразователь и четвертый блок умножения. Второй вход третьего блока умножения подключен к выходу первого датчика ускорения. Выход седьмого сумматора подключен к второму входу второго блока умножения. Вход косинусного функционального преобразователя соединен с входом синусного функционального преобразователя и выходом датчика положения. Второй вход четвертого блока умножения подключен к выходу второго датчика ускорения, а выход - к второму входу седьмого сумматора. Вторые входы четвертого и шестого сумматоров подключены соответственно к выходам датчика массы и источника постоянного сигнала. Изобретение позволяет повысить динамическую точность управления приводом робота. 3 ил.
Description
Изобретение относится к робототехнике и может быть использовано при создании приводов роботов.
Известно устройство для управления приводом робота, содержащее последовательно соединенные первый сумматор, первый блок умножения, второй сумматор, усилитель и двигатель, связанный с первым датчиком скорости непосредственно и через редуктор - с шестерней, приводящей в движение рейку, закрепленную неподвижно на горизонтальном звене робота, и движок первого датчика положения, установленного на вертикальном звене и измеряющего положение характерной точки горизонтального звена относительно вертикального, последовательно соединенные релейный блок и третий сумматор, второй вход которого подключен к выходу первого датчика скорости, входу релейного блока и второму входу первого сумматора, последовательно соединенные первый задатчик сигнала, четвертый сумматор, пятый сумматор, к второму входу которого подключен второй задатчик сигнала, второй блок умножения, шестой сумматор и третий блок умножения, а также датчик массы, причем выход датчика положения соединен с первым входом седьмого сумматора, подключенного вторым входом к входу электропривода, а выходом - к первому входу первого сумматора, выход третьего сумматора соединен с вторым входом второго сумматора, последовательно соединенные второй датчик скорости и квадратор, выход которого соединен с вторым входом третьего блока умножения, выходом подключенного к третьему отрицательному входу третьего сумматора, выход датчика массы соединен с вторыми входами первого и второго блоков умножения, выход датчика положения соединен с вторым входом четвертого сумматора, выход которого подключен к второму входу шестого сумматора, а выход первого сумматора соединен с третьим входом второго сумматора (см. патент РФ 2037173, БИ 16, 1995 г.).
Известно также устройство для управления приводом робота, содержащее последовательно соединенные первый блок умножения, первый сумматор, усилитель и двигатель, связанный с первым датчиком скорости непосредственно и через редуктор с первым датчиком положения, выход которого соединен с первым входом второго сумматора, подключенного вторым входом к входу устройства, а выходом через третий сумматор - к первому входу первого блока умножения, последовательно соединенные источник постоянного сигнала, четвертый сумматор, второй блок умножения и пятый сумматор, последовательно соединенные датчик массы и шестой сумматор, выход которого подключен к второму входу первого блока умножения, причем выход датчика скорости подключен к входу релейного элемента и вторым входам третьего и пятого сумматоров, третий вход пятого сумматора подключен к выходу релейного элемента, а его выход - к второму входу первого сумматора (см. а.с. SU 1484702, БИ 21, 1989 г.).
Недостатком этих устройств (аналога и прототипа) является то, что они эффективны только для исполнительного органа робота, имеющего три степени подвижности (выдвижение руки, поворот вертикальной стойки и вертикальное перемещение руки). Однако при этих трех степенях подвижности у робота мала рабочая зона (зона обслуживания). Если ввести два взаимно перпендикулярных движения вертикальной стойки в горизонтальной плоскости, то зона обслуживания робота при его движении в этой плоскости может быть существенно расширена. Однако в этом случае в соответствующих приводах появляются возмущающие моментные воздействия, значительно ухудшающие их показатели качества. В результате возникает задача компенсации этих вредных моментных воздействий за счет введения дополнительных сигналов коррекции.
Задачей, на решение которой направлено заявляемое техническое решение, является обеспечение полной инвариантности динамических свойств электропривода к непрерывным и быстрым изменениям его динамических моментных нагрузочных характеристик при движении манипулятора по всем четырем рассматриваемым степеням подвижности и, тем самым, повышение его динамической точности управления.
Технический результат, который может быть получен при реализации заявляемого технического решения, выражается в формировании дополнительного сигнала управления, подаваемого на вход привода, который обеспечивает получение дополнительного моментного воздействия, компенсирующего вредное моментное воздействие со стороны остальных степеней подвижности на качественные показатели работы рассматриваемого привода.
Поставленная задача решается тем, что в устройство для управления приводом робота, содержащее последовательно соединенные первый блок умножения, первый сумматор, усилитель и двигатель, связанный с первым датчиком скорости непосредственно и через редуктор с первым датчиком положения, выход которого соединен с первым входом второго сумматора, подключенного вторым входом к входу устройства, а выходом через третий сумматор - к первому входу первого блока умножения, последовательно соединенные источник постоянного сигнала, четвертый сумматор, второй блок умножения и пятый сумматор, последовательно соединенные датчик массы и шестой сумматор, выход которого подключен к второму входу первого блока умножения, причем выход датчика скорости подключен к входу релейного элемента и вторым входам третьего и пятого сумматоров, третий вход пятого сумматор подключен к выходу релейного элемента, а его выход - к второму входу первого сумматора, дополнительно введены последовательно соединенные первый синусный функциональный преобразователь, третий блок умножения, второй вход которого подключен к выходу первого датчика ускорения, и седьмой сумматор, выход которого подключен к второму входу второго блока умножения, последовательно соединенные косинусный функциональный преобразователь, вход которого соединен с входом синусного функционального преобразователя и выходом датчика положения, и четвертый блок умножения, второй вход которого подключен к выходу второго датчика ускорения, а выход - к второму входу седьмого сумматора, причем вторые входы четвертого и шестого сумматоров подключены соответственно к выходам датчика массы и источника постоянного сигнала.
Сопоставительный анализ существенных признаков предлагаемого технического решения с существенными признаками аналогов и прототипа свидетельствует о его соответствии критерию "новизна".
При этом отличительные признаки формулы изобретения обеспечивают высокую точность и устойчивость привода робота в условиях существенного изменения параметров нагрузки.
На фиг.1 представлена функциональная схема устройства; на фиг.2 - кинематическая схема исполнительного органа робота; на фиг.3 - кинематическая схема исполнительного органа робота, вид сверху.
Устройство для управления приводом робота содержит последовательно соединенные первый блок 1 умножения, первый сумматор 2, усилитель 3 и двигатель 4, связанный с первым датчиком 5 скорости непосредственно и через редуктор 6 с первым датчиком 7 положения, выход которого соединен с первым входом второго сумматора 8, подключенного вторым входом к входу устройства, а выходом через третий сумматор 9 - к первому входу первого блока 1 умножения, последовательно соединенные источник 10 постоянного сигнала, четвертый сумматор 11, второй блок 12 умножения и пятый сумматор 13, последовательно соединенные датчик 14 массы и шестой сумматор 15, выход которого подключен к второму входу первого блока 1 умножения, причем выход датчика 5 скорости подключен к входу релейного элемента 16 и вторым входам третьего 9 и пятого 13 сумматоров, третий вход пятого сумматора 13 подключен к выходу релейного элемента 16, а его выход - к второму входу первого сумматора 2, последовательно соединенные первый синусный функциональный преобразователь 17, третий блок 18 умножения, второй вход которого подключен к выходу первого датчика 19 ускорения, и седьмой сумматор 20, выход которого подключен к второму входу второго блока 12 умножения, последовательно соединенные косинусный функциональный преобразователь 21, вход которого соединен с входом синусного функционального преобразователя 17 и выходом датчика 7 положения, и четвертый блок 22 умножения, второй вход которого подключен к выходу второго датчика 23 ускорения, а выход - к второму входу седьмого сумматора 20, причем вторые входы четвертого 11 и шестого 15 сумматоров подключены соответственно к выходам датчика 14 массы и источника 10 постоянного сигнала. Объект управления 24.
На чертежах введены следующие обозначения:
αвх - сигнал желаемого значения координаты q1;
qi - соответствующие обобщенные координаты исполнительного органа робота (i = 1,4);
- ускорения второй и третьей обобщенной координаты;
ε - ошибка привода (величина рассогласования);
m1, m4, mг - массы соответствующих звеньев исполнительного органа и захваченного груза;
l=const - расстояние от оси вращения горизонтального звена до его центра масс;
lг=const - расстояние от оси вращения горизонтального звена до груза;
- скорость вращения ротора двигателя первой степени подвижности;
U*, U - соответственно усиливаемый сигнал и сигнал управления двигателем 4.
αвх - сигнал желаемого значения координаты q1;
qi - соответствующие обобщенные координаты исполнительного органа робота (i = 1,4);
- ускорения второй и третьей обобщенной координаты;
ε - ошибка привода (величина рассогласования);
m1, m4, mг - массы соответствующих звеньев исполнительного органа и захваченного груза;
l=const - расстояние от оси вращения горизонтального звена до его центра масс;
lг=const - расстояние от оси вращения горизонтального звена до груза;
- скорость вращения ротора двигателя первой степени подвижности;
U*, U - соответственно усиливаемый сигнал и сигнал управления двигателем 4.
Устройство работает следующим образом.
Сигнал ошибки ε с сумматора 8 после коррекции в блоках 1, 2 и 9, усиливаясь, поступает на электродвигатель 4, приводит его вал во вращательное движение с направлением и скоростью (ускорением), зависящими от величины поступающего сигнала ε, моментов трения и внешнего моментного воздействия М. Электропривод при работе с различными грузами, а также за счет взаимовлияния степеней подвижности исполнительного органа обладает переменными моментными характеристиками, которые могут меняться в широких пределах. Это снижает качественные показатели электропривода и даже приводит к потере устойчивости его работы. В результате возникает задача, связанная с обеспечением инвариантности динамических свойств электропривода к непрерывным и быстрым изменениям его моментных нагрузочных характеристик, что позволяет обеспечить стабильность заданного качества системы управления.
Рассматриваемый привод управляет перемещением вокруг вертикальной оси (обобщенная координата q1). Конструкция робота позволяет осуществлять также вертикальное прямолинейное перемещение горизонтального звена (обобщенная координата q4) и его горизонтальные прямолинейные перемещения (обобщенные координаты q2 и q3).
Моментные характеристики привода, управляющего координатой q1, существенно зависят от непрерывного изменения координат и mг. В связи с этим для качественного управления координатой q1 необходимо точно компенсировать отрицательное влияние изменения координат q1,q2,q3 и mг на динамические свойства рассматриваемого привода поворота.
Моментное воздействие на выходной вал привода поворота со стороны движущихся масс исполнительного органа робота и груза, определенное с помощью уравнения Лагранжа 2 рода, имеет вид
H(q,mг)=m1l2+mгlг 2+JN+Js; (2)
где Js и JN - соответственно моменты инерции вертикального звена исполнительного органа относительно продольной оси и горизонтального звена относительно поперечной оси, проходящей через его центр масс.
H(q,mг)=m1l2+mгlг 2+JN+Js; (2)
где Js и JN - соответственно моменты инерции вертикального звена исполнительного органа относительно продольной оси и горизонтального звена относительно поперечной оси, проходящей через его центр масс.
С учетом соотношений (1) и (2), а также уравнений электрической и механической цепей электродвигателя постоянного тока с постоянными магнитами или независимого возбуждения рассматриваемый привод поворота можно описать следующим дифференциальным уравнением:
где R - активное сопротивление якорной цепи;
J - момент инерции якоря двигателя и вращающихся частей редуктора, приведенных к валу двигателя;
kм - коэффициент крутящего момента;
kω - коэффициент противоЭДС;
kв - коэффициент вязкого трения;
iр - передаточное отношение редуктора;
Мстр - момент сухого трения;
kу - коэффициент усиления усилителя 3;
i - ток якоря;
H*=H/i2 p; M*=М/ip.
где R - активное сопротивление якорной цепи;
J - момент инерции якоря двигателя и вращающихся частей редуктора, приведенных к валу двигателя;
kм - коэффициент крутящего момента;
kω - коэффициент противоЭДС;
kв - коэффициент вязкого трения;
iр - передаточное отношение редуктора;
Мстр - момент сухого трения;
kу - коэффициент усиления усилителя 3;
i - ток якоря;
H*=H/i2 p; M*=М/ip.
Очевидно, что измерение Н и М, вызванное изменением и mг, существенно влияет на динамические свойства, а следовательно, и качественные показатели рассматриваемого привода.
Для реализации поставленной задачи необходимо сформировать такое корректирующее устройство, которое застабилизировало бы параметры привода таким образом, чтобы он описывался дифференциальным уравнением с постоянными желаемыми параметрами и не зависел бы от переменных М, Н, mг и сил трения.
Полагается, что первый положительный вход сумматора 9 (со стороны сумматора 8) имеет единичный коэффициент усиления, а его второй отрицательный вход - коэффициент усиления первый (со стороны блока 12) и третий (со стороны релейного элемента 16) положительные входы сумматора 13 имеют единичные коэффициенты усиления, а его второй положительный вход - коэффициент усиления
Выходной сигнал релейного блока 16 с нулевой нейтральной точкой имеет вид
где Mτ - величина момента сухого трения при движении.
Выходной сигнал релейного блока 16 с нулевой нейтральной точкой имеет вид
где Mτ - величина момента сухого трения при движении.
Первый положительный вход сумматора 2 (со стороны блока 1) имеет единичный коэффициент усиления, а его второй положительный вход имеет коэффициент усиления R/kмkу).
Первый (со стороны датчика 14) и второй положительные входы сумматора 15 имеют коэффициенты усиления lг 2/(Jнip 2), l/(Jнip 2) соответственно, где Jн - номинальное (желаемое) значение приведенного момента инерции, обеспечивающее приводу поворота заданные динамические свойства и качественные показатели. Причем на выходе задатчика 10 формируется сигнал, равный Js+JN+Jip 2+m1l2.
Первый (со стороны источника 10) и второй положительные входы сумматора 11 имеют коэффициенты усиления
и lг/ip соответственно.
и lг/ip соответственно.
Таким образом, на выходе сумматора 11 формируется сигнал, равный (m1l1+mгlг)/iр, на выходе сумматора 15 - сигнал
а на выходе блока 1 умножения - сигнал
Датчики 19 и 23 соответственно установлены во второй и третьей степенях подвижности манипулятора и измеряют ускорения соответственно. В результате на выходе сумматора 20, имеющего первый отрицательный (со стороны блока 18) и второй положительный входы с единичными коэффициентами усиления, формируется сигнал а на выходе блока 12 - сигнал
На выходе сумматора 13 формируется сигнал
И окончательно на выходе сумматора 2 имеем
Подставив U* из (4) в (3), имеем
Очевидно, что уравнение (5) имеет постоянные желаемые параметры, а сам рассматриваемый привод обладает постоянными желаемыми динамическими свойствами и качественными показателями.
а на выходе блока 1 умножения - сигнал
Датчики 19 и 23 соответственно установлены во второй и третьей степенях подвижности манипулятора и измеряют ускорения соответственно. В результате на выходе сумматора 20, имеющего первый отрицательный (со стороны блока 18) и второй положительный входы с единичными коэффициентами усиления, формируется сигнал а на выходе блока 12 - сигнал
На выходе сумматора 13 формируется сигнал
И окончательно на выходе сумматора 2 имеем
Подставив U* из (4) в (3), имеем
Очевидно, что уравнение (5) имеет постоянные желаемые параметры, а сам рассматриваемый привод обладает постоянными желаемыми динамическими свойствами и качественными показателями.
Claims (1)
- Устройство для управления приводом робота, содержащее последовательно соединенные первый блок умножения, первый сумматор, усилитель и двигатель, связанный с первым датчиком скорости непосредственно и через редуктор с первым датчиком положения, выход которого соединен с первым входом второго сумматора, подключенного вторым входом к входу устройства, а выходом через третий сумматор - к первому входу первого блока умножения, последовательно соединенные источник постоянного сигнала, четвертый сумматор, второй блок умножения и пятый сумматор, последовательно соединенные датчик массы и шестой сумматор, выход которого подключен ко второму входу первого блока умножения, причем выход датчика скорости подключен ко входу релейного элемента и вторым входам третьего и пятого сумматоров, третий вход пятого сумматора подключен к выходу релейного элемента, а выход - ко второму входу первого сумматора, отличающееся тем, что в него дополнительно введены последовательно соединенные первый синусный функциональный преобразователь, третий блок умножения, второй вход которого подключен к выходу первого датчика ускорения, и седьмой сумматор, выход которого подключен ко второму входу второго блока умножения, последовательно соединенные косинусный функциональный преобразователь, вход которого соединен со входом синусного функционального преобразователя и выходом датчика положения, и четвертый блок умножения, второй вход которого подключен к выходу второго датчика ускорения, а выход - ко второму входу седьмого сумматора, причем вторые входы четвертого и шестого сумматоров подключены, соответственно, к выходам датчика массы и источника постоянного сигнала.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
RU2002116916/02A RU2212329C1 (ru) | 2002-06-24 | 2002-06-24 | Устройство для управления приводом робота |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
RU2002116916/02A RU2212329C1 (ru) | 2002-06-24 | 2002-06-24 | Устройство для управления приводом робота |
Publications (2)
Publication Number | Publication Date |
---|---|
RU2212329C1 true RU2212329C1 (ru) | 2003-09-20 |
RU2002116916A RU2002116916A (ru) | 2004-08-10 |
Family
ID=29777792
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
RU2002116916/02A RU2212329C1 (ru) | 2002-06-24 | 2002-06-24 | Устройство для управления приводом робота |
Country Status (1)
Country | Link |
---|---|
RU (1) | RU2212329C1 (ru) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2631784C1 (ru) * | 2016-06-22 | 2017-09-26 | Федеральное государственное автономное образовательное учреждение высшего образования "Дальневосточный федеральный университет" (ДВФУ) | Самонастраивающийся электропривод манипулятора |
RU2631783C1 (ru) * | 2016-06-22 | 2017-09-26 | Федеральное государственное автономное образовательное учреждение высшего образования "Дальневосточный федеральный университет" (ДВФУ) | Самонастраивающийся электропривод манипулятора |
-
2002
- 2002-06-24 RU RU2002116916/02A patent/RU2212329C1/ru not_active IP Right Cessation
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2631784C1 (ru) * | 2016-06-22 | 2017-09-26 | Федеральное государственное автономное образовательное учреждение высшего образования "Дальневосточный федеральный университет" (ДВФУ) | Самонастраивающийся электропривод манипулятора |
RU2631783C1 (ru) * | 2016-06-22 | 2017-09-26 | Федеральное государственное автономное образовательное учреждение высшего образования "Дальневосточный федеральный университет" (ДВФУ) | Самонастраивающийся электропривод манипулятора |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
RU2394674C2 (ru) | Самонастраивающийся электропривод робота | |
RU2423224C2 (ru) | Электропривод робота | |
RU2212329C1 (ru) | Устройство для управления приводом робота | |
RU2325268C1 (ru) | Устройство для управления приводом робота | |
RU2312007C1 (ru) | Устройство для управления приводом робота | |
RU2258600C1 (ru) | Устройство для управления приводом робота | |
RU2423225C1 (ru) | Электропривод робота | |
RU2380215C1 (ru) | Самонастраивающийся электропривод робота | |
RU2257288C1 (ru) | Устройство для управления приводом робота | |
RU2335389C2 (ru) | Устройство для управления приводом робота | |
RU2189306C2 (ru) | Устройство для управления приводом робота | |
RU2363972C2 (ru) | Самонастраивающийся электропривод робота | |
RU2193480C1 (ru) | Устройство для управления приводом робота | |
RU2235016C1 (ru) | Устройство для управления приводом робота | |
RU2443543C1 (ru) | Электропривод манипулятора | |
RU2398672C1 (ru) | Электропривод робота | |
RU2478465C1 (ru) | Электропривод манипулятора | |
RU2345885C1 (ru) | Устройство для управления приводом робота | |
RU2311284C1 (ru) | Устройство для управления приводом робота | |
RU2209719C1 (ru) | Устройство для управления приводом робота | |
RU2054350C1 (ru) | Устройство для управления приводом робота | |
RU2079867C1 (ru) | Устройство для управления приводом робота | |
RU2311283C1 (ru) | Устройство для управления приводом робота | |
RU2235015C1 (ru) | Устройство для управления приводом робота | |
RU2235014C1 (ru) | Устройство для управления приводом робота |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
MM4A | The patent is invalid due to non-payment of fees |
Effective date: 20040625 |