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

Классы МПК:B25J13/00 Управление манипуляторами
Автор(ы):
Патентообладатель(и):Дальневосточный государственный технический университет
Приоритеты:
подача заявки:
1994-06-22
публикация патента:

Изобретение относится к робототехнике и позволяет повысить точность и устойчивость привода при больших скоростях изменения нагрузки в процессе работы манипулятора с учетом электрической постоянной времени двигателя. Сущность изобретения: для формирования необходимых корректирующих сигналов предлагается дополнительно ввести второй датчик 30 ускорения, восьмой 31, девятый 33, десятый 35, одиннадцатый 36, двенадцатый 38 и тринадцатый 40 блоки умножения, квадратор 32, восьмой 34 и девятый 37 сумматоры, а также дифференциатор 39. После коррекции привод становится инвариантным к изменениям параметров нагрузки, а также к моментам сухого и вязкого трения. При этом стабилизируются его динамические свойства и качественные показатели работы. 2 ил.
Рисунок 1, Рисунок 2

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

УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ ПРИВОДОМ РОБОТА, содержащее последовательно соединенные первый сумматор, второй сумматор, первый блок умножения, третий сумматор, усилитель и двигатель, связанный непосредственно с первым датчиком скорости и через редуктор с первым датчиком положения, выход которого подключен к первому входу первого сумматора, соединенного вторым входом с входом устройства, последовательно подключенные второй датчик скорости, второй блок умножения, третий блок умножения и четвертый сумматор, выход которого соединен с вторым входом третьего сумматора, второй вход - с вторым входом второго сумматора и выходом первого датчика скорости, а третий вход - с выходом релейного элемента, подключенного входом к второму входу третьего блока умножения и выходу первого датчика скорости, последовательно соединенные датчик массы и пятый сумматор, второй вход которого подключен к выходу первого задатчика сигнала, а выход - к второму входу первого блока умножения, а также второй датчик положения, второй и третий задатчики сигнала, шестой и седьмой сумматоры, четвертый и пятый блоки умножения, первый датчик ускорения, первый и второй функциональные преобразователи, шестой блок умножения и седьмой блок умножения, первый вход которого подключен к выходу второго блока умножения, второй вход - к выходу второго датчика скорости, а выход - к четвертому входу четвертого сумматора, соединенного пятым входом с выходом пятого блока умножения, первый вход которого подключен к выходу первого датчика ускорения, а второй вход - к выходу седьмого сумматора, соединенного первым входом с выходом третьего задатчика сигнала, вторым входом - с выходом четвертого блока умножения и третьим входом пятого сумматора, а третим входом - с выходом датчика массы и первым входом шестого сумматора, второй вход которого подключен к выходу второго задатчика сигнала, а выход - к первому входу шестого блока умножения и четвертого блока умножения, соединенного вторым входом с выходом первого функционального преобразователя, вход которого подключен к выходу второго датчика положения и входу второго функционального преобразователя, соединенного выходом с вторым входом шестого блока умножения, выход которого подключен к второму входу второго блока умножения, отличающееся тем, что в устройство введены второй датчик ускорения, установленный на выходном валу двигателя, выход которого подключен к третьему и через восьмой блок умножения - к четвертому входу третьего сумматора, последовательно соединенные квадратор, девятый блок умножения, второй вход которого подключен к выходу четвертого блока умножения, восьмой сумматор и десятый блок умножения, второй вход которого подключен к выходу первого датчика скорости, а выход - к пятому входу третьего сумматора, последовательно соединенные одиннадцатый блок умножения, первый вход которого подключен к выходу шестого блока умножения, девятый сумматор, второй вход которого соединен с выходом девятого блока умножения, и двенадцатый блок умножения, второй вход которого соединен с входом квадратора и выходом второго датчика скорости, а его выход - с шестым входом третьего сумматора, последовательно соединенные дифференциатор, вход которого подключен к выходу первого датчика ускорения и второму входу одиннадцатого блока умножения, и тринадцатый блок умножения, второй вход которого соединен с выходом седьмого сумматора, а выход - с седьмым входом третьего сумматора, причем вторые входы восьмого блока умножения и восьмого сумматора подключены соответственно к выходам второго и одиннадцатого блоков умножения.

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

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

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

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

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

Данное устройство по своей технической сущности является наиболее близким к изобретению.

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

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

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

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

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

На фиг.1 представлена блок-схема предлагаемого устройства для управления приводом робота; на фиг.2 кинематическая схема исполнительного органа робота.

Устройство для управления приводом робота содержит последовательно соединенные первый сумматор 1, первый блок 2 умножения, второй сумматор 3, усилитель 4 и двигатель 5, связанный с первым датчиком 6 скорости непосредственно и через редуктор 7 с первым датчиком 8 положения, выход которого соединен с первым отрицательным входом третьего сумматора 9, подключенного вторым положительным входом к входу устройства, последовательно соединенные релейный блок 10 и четвертый сумматор 11, второй вход которого соединен с выходом первого датчика 6 скорости и входом релейного блока 10, последовательно соединенные первый задатчик 12 сигнала и пятый сумматор 13, второй вход которого соединен с выходом датчика 14 массы, а выход с вторым входом первого блока 2 умножения, последовательно соединенные второй датчик 15 скорости, второй блок 16 умножения и третий блок 17 умножения, второй вход которого соединен с выходом первого датчика 6 скорости, а выход с третьим входом четвертого сумматора 11, а также второй датчик 18 положения, причем выход третьего сумматора 9 подключен к первому входу первого сумматора 1, второй вход которого соединен с выходом первого датчика скорости 6, выход четвертого сумматора 11 подключен к второму входу второго сумматора 3. Кроме того, оно содержит последовательно соединенные второй задатчик 19 сигнала, шестой сумматор 20, четвертый блок 21 умножения, второй вход которого через первый функциональный преобразователь 22 соединен с выходом второго датчика 18 положения, седьмой сумматор 23, второй вход которого соединен с выходом третьего задатчика 24 сигнала, и пятый блок 25 умножения, второй вход которого соединен с выходом первого датчика 26 ускорения, а выход подключен к четвертому входу четвертого сумматора 11, последовательно соединенные второй функциональный преобразователь 27, вход которого соединен с входом первого функционального преобразователя 22, и шестой блок 28 умножения, второй вход которого подключен к выходу шестого сумматора 20, а выход к второму входу второго блока 16 умножения, пятый вход четвертого сумматора 11 подключен к выходу седьмого блока 29 умножения, первый вход которого соединен с выходом второго датчика 15 скорости, а второй вход с выходом второго блока 16 умножения, третий вход пятого сумматора 13 соединен с выходом четвертого блока 21 умножения, третий вход седьмого сумматора 23 подключен к выходу датчика 14 массы и второму входу шестого сумматора 20, второй датчик 30 ускорения, установленный на выходном валу двигателя 5, выход которого подключен к третьему и через восьмой блок 31 умножения к четвертому входу второго сумматора 3, последовательно соединенные квадратор 32, девятый блок 33 умножения, второй вход которого подключен к выходу четвертого блока 21 умножения, восьмой сумматора 34 и десятый блок 35 умножения, второй вход которого подключен к выходу первого датчика 6 скорости, а выход к пятому входу второго сумматора 3, последовательно соединенные одиннадцатый блок 36 умножения, первый вход которого подключен к выходу шестого блока 28 умножения, девятый сумматор 37, второй вход которого соединен с выходом девятого блока 33 умножения и двенадцатый блок 38 умножения, второй вход которого соединен с входом квадратора 32 и выходом второго датчика 15 скорости, а его выход с шестым входом второго сумматора 3, последовательно соединенные дифференциатор 39, вход которого подключен к выходу первого датчика 26 ускорения и второму входу одиннадцатого блока 36 умножения, и тринадцатый блок 40 умножения, второй вход которого соединен с выходом седьмого сумматора 23, а выход с седьмым входом второго сумматора 3. Объект управления 41 механически соединен с выходным валом редуктора 7.

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

устройство для управления приводом робота, патент № 2057002вх сигнал желаемого положения;

q1, q2, q3 соответствующие обобщенные координаты исполнительного органа робота;

устройство для управления приводом робота, патент № 2057002,устройство для управления приводом робота, патент № 2057002 скорости изменения соответствующих обобщенных координат;

устройство для управления приводом робота, патент № 2057002- ошибка привода (величина рассогласования);

m1, m2, m3, mг соответственно массы первого, второго, третьего звеньев исполнительного органа и захваченного груза;

l2*, l3* расстояния от осей вращения горизонтальных звеньев до их центров масс;

устройство для управления приводом робота, патент № 2057002, устройство для управления приводом робота, патент № 2057002 длины соответствующих горизонтальных звеньев;

устройство для управления приводом робота, патент № 2057002, устройство для управления приводом робота, патент № 2057002 скорость и ускорение вращения ротора двигателя;

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

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

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

Рассматриваемый привод управляет обобщенной координатой q2. Конструкция робота (фиг. 2) является наиболее типовой для отечественных и зарубежных промышленных роботов (например, роботы типа Skilam (SR-2, SR-3, SR-4), ТУР 2,5, Гранат 2,5 и т.д. Эта конструкция позволяет осуществлять вертикальное прямолинейное перемещение груза (координата q1) и два вращательных в горизонтальной плоскости (координаты q2 и q3).

Моментные характеристики привода, управляющего координатой q2,существенно зависят от изменения координат q3, устройство для управления приводом робота, патент № 2057002, устройство для управления приводом робота, патент № 2057002,устройство для управления приводом робота, патент № 2057002 и mг. В связи с этим для качественного управления координатой q2 необходимо точно компенсировать отрицательное влияние изменения координат q3, устройство для управления приводом робота, патент № 2057002, устройство для управления приводом робота, патент № 2057002,устройство для управления приводом робота, патент № 2057002, а также переменной массы груза mг на динамические свойства рассматриваемого привода поворота (координата q2).

Для определения моментных воздействий на рассматриваемый привод (обобщенных моментов неконсервативных сил) воспользуемся уравнением Лагранжа 2-го рода. Кинетическая энергия Т всех движущихся масс исполнительного органа (фиг.2) представляется в виде

устройство для управления приводом робота, патент № 2057002 устройство для управления приводом робота, патент № 2057002 устройство для управления приводом робота, патент № 2057002 + где I2, I3 моменты инерции соответствующих горизонтальных звеньев относительно их центров масс.

Потенциальная энергия является функцией только координаты q1. Учитывая, что

устройство для управления приводом робота, патент № 2057002(m3l*3+mгl3)l2cos(q3)]устройство для управления приводом робота, патент № 2057002+

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

устройство для управления приводом робота, патент № 2057002 0 на основе уравнений Лагранжа 2-го рода можно записать, что моментное воздействие на выходной вал привода, управляющего координатой q2, при движении робота (фиг.2) с грузом имеет вид

MВ= H(q3)устройство для управления приводом робота, патент № 2057002+h(q3, устройство для управления приводом робота, патент № 2057002)устройство для управления приводом робота, патент № 2057002+MВН, (1) где

H(q3)= I2+I3+m2l*22+m3l*32+(m3+mг)l22+mгl23 + 2l2(m3l*3+mгl3)cos(q3), h(q3, устройство для управления приводом робота, патент № 2057002)=-2l2(m3l*3+mгl3)sin(q3)устройство для управления приводом робота, патент № 2057002, (2)

MВН [I3+m3l*32+mгl23+(m3l*3+mгl3)l2cosq3] устройство для управления приводом робота, патент № 2057002-l2(m3l*3+mгl3)sin(q3)устройство для управления приводом робота, патент № 2057002. С учетом соотношений (1) и (2), а также уравнений электрической U Lустройство для управления приводом робота, патент № 2057002 +iR+Kустройство для управления приводом робота, патент № 2057002 и механической iKм= (H*+I)устройство для управления приводом робота, патент № 2057002+(h*+Kв)устройство для управления приводом робота, патент № 2057002+Mстр+M*ВН цепей электродвигателя постоянного тока с постоянными магнитами или независимого возбуждения рассматриваемый привод, управляющий координатой q2, можно описать следующим дифференциальным уравнением

устройство для управления приводом робота, патент № 2057002 (3) где

устройство для управления приводом робота, патент № 2057002 -2l2(m3l*3+mгl3)(sin(qустройство для управления приводом робота, патент № 2057002 устройство для управления приводом робота, патент № 2057002+cos(q3)устройство для управления приводом робота, патент № 2057002),

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

H*= H/i2р, h*=h/i2р, M*ВН= MВН/ip, h*=устройство для управления приводом робота, патент № 2057002/i2p, устройство для управления приводом робота, патент № 2057002=устройство для управления приводом робота, патент № 2057002/ip;

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

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

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

Kустройство для управления приводом робота, патент № 2057002 коэффициент противоЭДС;

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

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

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

Ку коэффициент усиления усилителя 4;

i ток якоря;

устройство для управления приводом робота, патент № 2057002 ускорение вращения вала двигателя второй степени подвижности.

Из (3) видно, что параметры этого уравнения, а следовательно, и параметры привода, управляющего координатой q2, являются существенно переменными, зависящими от величин q3, устройство для управления приводом робота, патент № 2057002, устройство для управления приводом робота, патент № 2057002,устройство для управления приводом робота, патент № 2057002 и mг. В результате в процессе работы привода существенно меняются его динамические свойства. Таким образом, для реализации поставленной задачи необходимо сформировать такое корректирующее устройство, которое застабилизировало бы параметры привода так, чтобы он описывался дифференциальным уравнением с постоянными параметрами.

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

Первый положительный вход сумматора 20 единичный, а задатчик 19 сигнала подает на него сигнал l2l3*m3. Второй положительный вход этого сумматора имеет коэффициент усиления l2l3. В результате на выходе этого сумматора формируется сигнал l2(m3l3* + mгl3).

Второй датчик 18 положения измеряет обобщенную координату q3робота, а функциональный преобразователь 22 реализует cos q3. В результате на выходе блока 21 умножения формируется сигнал l2(m3l3* + +mгl3) cos q3.

Первый положительный вход сумматора 13 имеет единичный коэффициент усиления, а задатчик 12 сигнала подает на этот вход сигнал

[I + (I2 + I3 + m2l2*2 + m3l22 + m3l3*2)/ip2]/Iн.

На второй его положительный вход с коэффициентом усиления (l22 + l32)/(ip2 Iн) датчик 14 массы подает сигнал mг. Третий положительный вход сумматора 13 имеет коэффициент усиления 2/(ip2 Iн). В результате на его выходе формируется сигнал

устройство для управления приводом робота, патент № 2057002 а на выходе блока 2 умножения сигнал Aустройство для управления приводом робота, патент № 2057002- устройство для управления приводом робота, патент № 2057002 устройство для управления приводом робота, патент № 2057002. Функциональный преобразователь 27 реализует функциональную зависимость sin q3. В результате на выходе блока 28 умножения формируется сигнал l2(m3l3* + mгl3) sin q3.

Датчик 15 скорости измеряет скорость изменения обобщенной координаты q3 и, как и датчик 18 положения, установлен в третьей степени подвижности робота. В результате на третий отрицательный вход сумматора 11 (со стороны блока 17 умножения) с коэффициентом усиления 2/ip2поступает сигнал l2(m3l*32+mгl3)sin(q3)устройство для управления приводом робота, патент № 2057002 а на пятый отрицательный вход этого сумматора (со

стороны блока 29 умножения) с коэффициентом усиления 1/ip сигнал l2(m3l*32+mгl23)sin(q3)устройство для управления приводом робота, патент № 2057002.

Первый и второй положительные входы сумматора 23 (соответственно со стороны блока 21 умножения и задатчика 24 сигнала) имеют единичные коэффициенты усиления, а его третий положительный вход коэффициент усиления l32. Задатчик сигнала 24 формирует сигнал l3 + m3l3*2, а датчик 26 ускорения измеряет ускорение изменения обобщенной координаты устройство для управления приводом робота, патент № 2057002 и установлен в третьей степени подвижности робота. В результате на выходе блока 25 умножения формируется сигнал

[I3+m3l*32+mгl23+l2(m3l*3+mгl3)cos q3] устройство для управления приводом робота, патент № 2057002, который поступает на четвертый положительный вход сумматора 11, имеющий коэффициент усиления 1/ip. Первый и второй положительные входы сумматора 11 (соответственно со стороны релейного элемента 10 и датчика 6 скорости) соответственно имеют единичный коэффициент усиления и коэффициент усиления, равный Км kустройство для управления приводом робота, патент № 2057002 /R + Kв. Выходной сигнал релейного элемента 10 с нулевой нейтральной точкой имеет вид

Uвых10 устройство для управления приводом робота, патент № 2057002-устройство для управления приводом робота, патент № 2057002 при устройство для управления приводом робота, патент № 2057002 устройство для управления приводом робота, патент № 2057002 где устройство для управления приводом робота, патент № 2057002Мустройство для управления приводом робота, патент № 2057002 величина момента сухого трения при движении. В результате на выходе сумматора 11 формируется сигнал

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

Второй датчик 30 ускорения измеряет ускорение вращения устройство для управления приводом робота, патент № 2057002 вала двигателя 5. Третий положительный вход сумматора 3 (со стороны датчика 30) имеет коэффициент усиления, равный устройство для управления приводом робота, патент № 2057002. Четвертый отрицательный вход сумматора 3 (со стороны блока 31 умножения) имеет коэффициент усиления, равный устройство для управления приводом робота, патент № 2057002. На этот вход поступает сигнал l2(m3l*3+m3l3)sin(q3)устройство для управления приводом робота, патент № 2057002 устройство для управления приводом робота, патент № 2057002.

На выходе одиннадцатого блока 36 умножения формируется сигнал l2(m3l*3+mгl3)sin(q3)устройство для управления приводом робота, патент № 2057002, а на выходе девятого блока 33 умножения сигнал l2(m3l*3+mгl3)sin(q3)устройство для управления приводом робота, патент № 2057002.

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

Первый (со стороны блока 36) и второй отрицательные входы девятого сумматора 37 имеют соответственно коэффициент усиления, равный 3, и единичный коэффициент усиления. В результате на выходе двенадцатого блока 38 умножения формируется сигнал

l2(m3l*3+mгl3)/cos(q3)устройство для управления приводом робота, патент № 2057002+3sin(q3)устройство для управления приводом робота, патент № 2057002), а на выходе тринадцатого блока 40 умножения сигнал

[I3+m3l*32+mгl23+l2(m3l*3+mгl3)cosq3]устройство для управления приводом робота, патент № 2057002.

Первый положительный вход сумматора 3 (со стороны блока 2 умножения) имеет единичный коэффициент усиления, его второй положительный вход коэффициент усиления R/(Kм Ку), его пятый положительный вход коэффициент усиления R/(KмКу), его пятый положительный вход (со стороны блока 35) коэффициент усиления устройство для управления приводом робота, патент № 2057002 а шестой положительный (со стороны блока 38 умножения) и седьмой положительный (со стороны блока 40 умножения) одинаковые коэффициенты усиления, равные устройство для управления приводом робота, патент № 2057002.

В результате на выходе сумматора 3 формируется сигнал U*, равный U*= Aустройство для управления приводом робота, патент № 2057002- устройство для управления приводом робота, патент № 2057002 устройство для управления приводом робота, патент № 2057002+ устройство для управления приводом робота, патент № 2057002 B + устройство для управления приводом робота, патент № 2057002 [(2h*+KВ)устройство для управления приводом робота, патент № 2057002+устройство для управления приводом робота, патент № 2057002 устройство для управления приводом робота, патент № 2057002+устройство для управления приводом робота, патент № 2057002] (4)

Поскольку при движении привода Mтsign устройство для управления приводом робота, патент № 2057002 достаточно точно соответствует Мстр, то сигнал U* (4) обеспечивает превращение уравнения (3) с существенно переменными параметрами в уравнение с постоянными номинальными желаемыми параметрами, обеспечивающими приводу заданные динамические и качественные показатели

LIустройство для управления приводом робота, патент № 2057002+RIустройство для управления приводом робота, патент № 2057002 +KМKустройство для управления приводом робота, патент № 2057002устройство для управления приводом робота, патент № 20570022=KуKмустройство для управления приводом робота, патент № 2057002.

Класс B25J13/00 Управление манипуляторами

устройство для управления подводным роботом -  патент 2524034 (27.07.2014)
устройство для управления подводным роботом -  патент 2523160 (20.07.2014)
роботизированная хирургическая система минимального инвазивного вмешательства и способ ее управления -  патент 2518806 (10.06.2014)
устройство ручного управления манипулятором-триподом -  патент 2501648 (20.12.2013)
электропривод манипулятора -  патент 2489251 (10.08.2013)
электропривод робота -  патент 2489250 (10.08.2013)
электропривод робота -  патент 2488480 (27.07.2013)
электропривод робота -  патент 2488479 (27.07.2013)
электропривод манипулятора -  патент 2487008 (10.07.2013)
электропривод манипулятора -  патент 2478465 (10.04.2013)
Наверх