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

Формула изобретения

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

Описание изобретения к патенту

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

Известно устройство для управления приводом робота, содержащее последовательно соединенные первый сумматор, первый блок умножения, второй сумматор, усилитель и двигатель, связанный с первым датчиком скорости непосредственно и через редуктор - с шестерней, приводящей в движение рейку, закрепленную неподвижно на горизонтальном звене робота, и движок первого датчика положения, установленного на вертикальном звене и измеряющего положение характерной точки горизонтального звена относительно вертикального, последовательно соединенные релейный блок и третий сумматор, второй вход которого подключен к выходу первого датчика скорости, входу релейного блока и второму входу первого сумматора, последовательно соединенные первый задатчик сигнала, четвертый сумматор, пятый сумматор, к второму входу которого подключен второй задатчик сигнала, второй блок умножения, шестой сумматор и третий блок умножения, а также датчик массы, причем выход датчика положения соединен с первым входом седьмого сумматора, подключенного вторым входом к входу электропривода, а выходом - к первому входу первого сумматора, выход третьего сумматора соединен с вторым входом второго сумматора, последовательно соединенные второй датчик скорости и квадратор, выход которого соединен с вторым входом третьего блока умножения, выходом подключенного к третьему отрицательному входу третьего сумматора, выход датчика массы соединен с вторыми входами первого и второго блоков умножения, выход датчика положения соединен с вторым входом четвертого сумматора, выход которого подключен к второму входу шестого сумматора, а выход первого сумматора соединен с третьим входом второго сумматора (см. патент РФ 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.

На чертежах введены следующие обозначения:

_вх - сигнал желаемого значения координаты q₁;

q_i - соответствующие обобщенные координаты исполнительного органа робота (i = 1,4);

- ускорения второй и третьей обобщенной координаты;

- ошибка привода (величина рассогласования);

m₁, m₄, m_г - массы соответствующих звеньев исполнительного органа и захваченного груза;

l=const - расстояние от оси вращения горизонтального звена до его центра масс;

l_г=const - расстояние от оси вращения горизонтального звена до груза;

- скорость вращения ротора двигателя первой степени подвижности;

U*, U - соответственно усиливаемый сигнал и сигнал управления двигателем 4.

Устройство работает следующим образом.

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

Рассматриваемый привод управляет перемещением вокруг вертикальной оси (обобщенная координата q₁). Конструкция робота позволяет осуществлять также вертикальное прямолинейное перемещение горизонтального звена (обобщенная координата q₄) и его горизонтальные прямолинейные перемещения (обобщенные координаты q₂ и q₃).

Моментные характеристики привода, управляющего координатой ₁, существенно зависят от непрерывного изменения координат и m_г. В связи с этим для качественного управления координатой q₁ необходимо точно компенсировать отрицательное влияние изменения координат q₁,q₂,q₃ и m_г на динамические свойства рассматриваемого привода поворота.

Моментное воздействие на выходной вал привода поворота со стороны движущихся масс исполнительного органа робота и груза, определенное с помощью уравнения Лагранжа 2 рода, имеет вид



H(q,m_г)=m₁l²+m_гl_г ²+J_N+J_s; (2)



где J_s и J_N - соответственно моменты инерции вертикального звена исполнительного органа относительно продольной оси и горизонтального звена относительно поперечной оси, проходящей через его центр масс.

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



где R - активное сопротивление якорной цепи;

J - момент инерции якоря двигателя и вращающихся частей редуктора, приведенных к валу двигателя;

k_м - коэффициент крутящего момента;

k - коэффициент противоЭДС;

k_в - коэффициент вязкого трения;

i_р - передаточное отношение редуктора;

М_стр - момент сухого трения;

k_у - коэффициент усиления усилителя 3;

i - ток якоря;

H*=H/i² _p; M*=М/i_p.

Очевидно, что измерение Н и М, вызванное изменением и m_г, существенно влияет на динамические свойства, а следовательно, и качественные показатели рассматриваемого привода.

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

Полагается, что первый положительный вход сумматора 9 (со стороны сумматора 8) имеет единичный коэффициент усиления, а его второй отрицательный вход - коэффициент усиления первый (со стороны блока 12) и третий (со стороны релейного элемента 16) положительные входы сумматора 13 имеют единичные коэффициенты усиления, а его второй положительный вход - коэффициент усиления

Выходной сигнал релейного блока 16 с нулевой нейтральной точкой имеет вид



где M - величина момента сухого трения при движении.

Первый положительный вход сумматора 2 (со стороны блока 1) имеет единичный коэффициент усиления, а его второй положительный вход имеет коэффициент усиления R/k_мk_у).

Первый (со стороны датчика 14) и второй положительные входы сумматора 15 имеют коэффициенты усиления l_г ²/(J_нi_p ²), l/(J_нi_p ²) соответственно, где J_н - номинальное (желаемое) значение приведенного момента инерции, обеспечивающее приводу поворота заданные динамические свойства и качественные показатели. Причем на выходе задатчика 10 формируется сигнал, равный J_s+J_N+Ji_p ²+m₁l².

Первый (со стороны источника 10) и второй положительные входы сумматора 11 имеют коэффициенты усиления



и l_г/i_p соответственно.

Таким образом, на выходе сумматора 11 формируется сигнал, равный (m₁l₁+m_гl_г)/i_р, на выходе сумматора 15 - сигнал



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



Датчики 19 и 23 соответственно установлены во второй и третьей степенях подвижности манипулятора и измеряют ускорения соответственно. В результате на выходе сумматора 20, имеющего первый отрицательный (со стороны блока 18) и второй положительный входы с единичными коэффициентами усиления, формируется сигнал а на выходе блока 12 - сигнал



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

И окончательно на выходе сумматора 2 имеем



Подставив U* из (4) в (3), имеем



Очевидно, что уравнение (5) имеет постоянные желаемые параметры, а сам рассматриваемый привод обладает постоянными желаемыми динамическими свойствами и качественными показателями.