Forbidden

You don't have permission to access /zzz_siteguard.php on this server.

УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ ПРИВОДОМ РОБОТА - Патент РФ 2054350
Главная страница  |  Описание сайта  |  Контакты
УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ ПРИВОДОМ РОБОТА
УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ ПРИВОДОМ РОБОТА

УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ ПРИВОДОМ РОБОТА

Патент Российской Федерации
Суть изобретения: Использование: робототехника, в частности в приводах роботов типа "Юнимейт". Сущность изобретения: для формирования необходимых корректирующих сигналов при больших скоростях изменения параметров нагрузки учитывается электрическая постоянная времени электродвигателя постоянного тока. После коррекции привод становится инвариантным к изменениям параметров нагрузки, а также к моментам сухого вязкого трения. При этом стабилизируются его динамические свойства и качественные показатели работы. 2 ил.
Поиск по сайту

1. С помощью поисковых систем

   С помощью Google:    

2. Экспресс-поиск по номеру патента


введите номер патента (7 цифр)

3. По номеру патента и году публикации

2000000 ... 2099999   (1994-1997 гг.)

2100000 ... 2199999   (1997-2003 гг.)
Номер патента: 2054350
Класс(ы) патента: B25J13/00
Номер заявки: 94018685/08
Дата подачи заявки: 24.05.1994
Дата публикации: 20.02.1996
Заявитель(и): Дальневосточный государственный технический университет
Автор(ы): Филаретов В.Ф.
Патентообладатель(и): Дальневосточный государственный технический университет
Описание изобретения: Изобретение относится к робототехнике и может быть использовано при создании системы управления приводами роботов.
Известно устройство для управления приводом робота, содержащее последовательно соединенные первый блок умножения и первый сумматор, последовательно подключенные усилитель и двигатель, связанный с первым датчиком скорости непосредственно и через редуктор с первым датчиком положения, выход которого соединен с первым входом второго сумматора, подключенного вторым входом к входу устройства, последовательно соединенные второй датчик положения, третий сумматор, четвертый сумматор, первый квадратор и второй блок умножения, второй вход которого подключен к выходу датчика массы и первому входу третьего блока умножения, а выход к первому входу пятого сумматора, соединенного вторым входом с выходом первого задатчика постоянного сигнала, а третьим входом с выходом второго квадратора, вход которого подключен к выходу третьего сумматора и первому входу шестого сумматора, соединенного выходом с первым входом четвертого блока умножения, а вторым входом с выходом третьего блока умножения, второй вход которого подключен к выходу четвертого сумматора, соединенного вторым входом с выходом второго задатчика постоянного сигнала, выход третьего задатчика постоянного сигнала подключен к второму входу третьего сумматора, а выход второго датчика скорости соединен с вторым входом четвертого блока умножения, а также пятый блок умножения, седьмой сумматор и последовательно соединенные релейный блок и восьмой сумматор, выход которого подключен к второму входу первого сумматора, выходом соединенного с входом усилителя, причем выход первого датчика скорости подключен к входу релейного блока, к второму входу восьмого сумматора и первому входу седьмого сумматора, второй вход которого соединен с выходом второго сумматора, а выход с первым входом первого блока умножения, подключенного вторым входом к выходу пятого сумматора, первый вход пятого блока умножения соединен с выходом четвертого блока умножения, второй вход с выходом первого датчика скорости, а выход с третьим входом восьмого сумматора (Авт. св. N 1484702, кл. B 25 J 13/00, 1989).
Недостатком данного устройства является то, что оно предназначено только для конкретного привода конкретного робота. Для приводов других степеней подвижности других роботов (с другой кинематикой) это устройство не будет обеспечивать требуемую точность и устойчивость работы.
Известно также устройство для управления приводом робота, содержащее последовательно соединенные первый блок умножения и первый сумматор, последовательно подключенные усилитель и двигатель, связанный с первым датчиком скорости непосредственно и через редуктор с первым датчиком положения, выход которого соединен с первым входом второго сумматора, подключенного вторым входом к входу устройства, последовательно соединенные второй датчик положения, третий сумматор, четвертый сумматор, первый и второй блок умножения, второй вход которого подключен к выходу датчика массы и первому входу третьего блока умножения, а выход к первому входу пятого сумматора, соединенного вторым входом с выходом первого задатчика постоянного сигнала, а третьим входом с выходом второго квадратора, вход которого подключен к выходу третьего сумматора и первому входу шестого сумматора, соединенного выходом с первым входом четвертого блока умножения, а вторым входом с выходом третьего блока умножения, второй вход которого подключен к выходу четвертого сумматора, соединенного вторым входом с выходом второго задатчика постоянного сигнала, выход третьего задатчика постоянного сигнала подключен к второму входу третьего сумматора, а выход второго датчика скорости соединен с вторым входом четвертого блока умножения, а также пятый блок умножения, седьмой сумматор и последовательно соединенные релейный блок и восьмой сумматор, выход которого подключен к второму входу первого сумматора, выходом соединенного с входом усилителя, причем выход первого датчика скорости подключен к входу релейного блока, к второму входу восьмого сумматора и первому входу седьмого сумматора, второй вход которого соединен с выходом второго сумматора, а выход с первым входом первого блока умножения, подключенного вторым входом к выходу пятого сумматора, первый вход пятого блока умножения соединен с выходом четвертого блока умножения, его второй вход с выходом первого датчика скорости, а выход с третьим входом восьмого сумматора, последовательно соединенные четвертый задатчик постоянного сигнала, девятый сумматор, второй вход которого соединен с выходом пятого сумматора, шестой и седьмой блоки умножения и десятый сумматор, выход которого подключен к четвертому входу восьмого сумматора, последовательно соединенные пятый задатчик постоянного сигнала, одиннадцатый сумматор, второй вход которого соединен с выходом шестого сумматора и восьмой блок умножения, выход которого подключен ко второму входу десятого сумматора, последовательно соединенные третий датчик скорости и третий квадратор, выход которого соединен с вторым входом шестого блока умножения, последовательно соединенные третий датчик положения, второй усилитель и первый функциональный преобразователь, выход которого подключен к второму входу седьмого блока умножения, а второй вход восьмого блока умножения через второй функциональный преобразователь соединен с выходом третьего датчика положения.
Данное устройство по своей технической сущности является наиболее близким к изобретению.
Однако в нем не учитывается, считаясь малой, электрическая постоянная времени используемого электродвигателя.
В результате возникает задача построения такой самонастраивающейся коррекции, которая обеспечила бы высокую точность и устойчивость работы привода робота с рассматриваемой кинематической схемой исполнительного органа при учете электрической постоянной времени двигателя.
Технический результат, который достигается при реализации изобретения, выражается в формировании дополнительного форсирующего сигнала управления, подаваемого на вход привода, который точнее компенсирует вредное моментное воздействие со стороны других степеней подвижности робота на качественные показатели работы рассматриваемого устройства.
Поставленная задача решается тем, что устройство для управления приводом робота, содержащее последовательно соединенные первый блок умножения и первый сумматор, последовательно подключенные усилитель и двигатель, связанный с первым датчиком скорости непосредственно и через редуктор с первым датчиком положения, выход которого соединен с первым входом второго сумматора, подключенного вторым входом к входу устройства, последовательно соединенные второй датчик положения, третий сумматор, четвертый сумматор, первый квадратор и второй блок умножения, второй вход которого подключен к выходу датчика массы и первому входу третьего блока умножения, а выход к первому входу пятого сумматора, соединенного вторым входом с выходом первого задатчика постоянного сигнала, а третьим входом с выходом второго квадратора, вход которого подключен к выходу третьего сумматора и первому входу шестого сумматора и первому входу шестого сумматора, соединенного выходом с первым входом четвертого блока умножения, а вторым входом с выходом третьего блока умножения, второй вход которого подключен к выходу четвертого сумматора, соединенного вторым входом с выходом второго задатчика постоянного сигнала, выход третьего задатчика постоянного сигнала подключен к второму входу третьего сумматора, а выход второго датчика скорости соединен с вторым входом четвертого блока умножения, а также пятый блок умножения, седьмой сумматор и последовательно соединенные релейный блок и восьмой сумматор, выход которого подключен к второму входу первого сумматора, выходом соединенного с входом усилителя, причем выход первого датчика скорости подключен к входу релейного блока, к второму входу восьмого сумматора и первому входу седьмого сумматора, второй вход которого соединен с выходом второго сумматора, а выход с первым входом первого блока умножения, подключенного вторым входом к выходу пятого сумматора, первый вход пятого блока умножения соединен с выходом четвертого блока умножения, его второй вход с выходом первого датчика скорости, а выход с третьим входом восьмого сумматора, последовательно соединенные четвертый задатчик постоянного сигнала, девятый сумматор, второй вход которого соединен с выходом пятого сумматора, шестой и седьмой блоки умножения и десятый сумматор, выход которого подключен к четвертому входу восьмого сумматора, последовательно соединенные пятый задатчик постоянного сигнала, одиннадцатый сумматор, второй вход которого соединен с выходом шестого сумматора, и восьмой блок умножения, выход которого подключен к второму входу десятого сумматора, последовательно соединенные третий датчик скорости и третий квадратор, выход которого соединен с вторым входом шестого блока умножения, последовательно соединенный третий датчик положения, второй усилитель и первый функциональный преобразователь, выход которого подключен к второму входу седьмого блока умножения, а второй вход восьмого блока умножения через второй функциональный преобразователь соединен с выходом третьего датчика положения, отличается тем, что оно дополнительно содержит первый датчик ускорения, установленный на выходном валу двигателя, девятый блок умножения, первый вход которого подключен к выходу четвертого блока умножения, его второй вход к третьему входу первого сумматора и выходу первого датчика ускорения, а выход к пятому входу восьмого сумматора, последовательно соединенные четвертый квадратор, десятый блок умножения, двенадцатый сумматор и одиннадцатый блок умножения, выход которого соединен с шестым входом восьмого сумматора, последовательно соединенные двенадцатый блок умножения, первый вход которого подключен к выходу третьего датчика скорости, тринадцатый блок умножения, второй вход которого соединен с выходом второго датчика ускорения, тринадцатый сумматор, четыр- надцатый блок умножения, второй вход которого подключен к выходу девятого сумматора, и четырнадцатый сумматор, выход которого соединен с седьмым входом восьмого сумматора, последовательно соединен- ные пятнадцатый, шестнадцатый cемнад-цатый блоки умножения, последовательно соединенные третий функциональный преобразователь, вход которого подключен к выходу второго усилителя, восемнадцатый блок умножения, второй вход которого соединен с выходом третьего квадратора и вторым входом семнадцатого блока умножения, девятнадцатый блок умножения, выход которого подключен к второму входу тринадцатого сумматора, последовательно соединенные четвертый функциональный преобразователь, вход которого подключен к выходу третьего датчика положения, двадцатый блок умножения, второй вход которого подключен к выходу одиннадцатого сумматора и двадцать первый блок умножения, второй вход которого соединен с вторыми входами одиннадцатого и девятнадцатого блоков умножения, а также с выходом первого датчика скорости, а его выход с третьим входом четырнадцатого сумматора, последовательно соединенные двадцать второй блок умножения, первый вход которого подключен к выходу второго функционального преобразователя, и двадцать третий блок умножения, второй вход которого соединен с выходом второго датчика скорости, входом четвертого квадратора и вторым входом шестнадцатого блока умножения, а его выход с четвертым входом четырнадцатого сумматора, последовательно соединенные шестой задатчик постоянного сигнала и пятнадцатый сумматор, второй вход которого подключен к выходу датчика массы, а выход к второму входу десятого блока умножения, последовательно соединенные третий датчик ускорения и двадцать четвертый блок умножения, второй вход которого подключен к выходу шестого сумматора и первому входу пятнадцатого блока умножения, второй вход которого соединен с выходом первого функционального преобразователя и вторым входом двенадцатого блока умножения, а выход семнадцатого блока умножения подключен к второму входу четырнадцатого сумматора.
За счет введения дополнительных элементов и связей, указанных в отличительной части формулы изобретения, удается обеспечить полную инвариантность привода к эффектам взаимовлияния между степенями подвижности и моментами трения и при наличии электрической постоянной времени якорной цепи электродвигателя.
На фиг. 1 представлена блок-схема предлагаемого устройства для управления приводом робота; на фиг. 2 кинематическая схема исполнительного органа робота.
Устройство для управления приводом робота содержит последовательно соединенные первый блок 1 умножения и первый сумматор 2, последовательно подключенные усилитель 3 и двигатель 4, связанный с первым датчиком 5 скорости непосредственно и через редуктор 6 с первым датчиком 7 положения, выход которого соединен с первым входом второго сумматора 8, подключенного вторым входом к входу устройства, последовательно соединенные второй датчик 9 положения, третий сумматор 10, четвертый сумматор 12, первый квадратор 11 и второй блок 15 умножения, второй вход которого подключен к выходу датчика 16 массы и первому входу третьего блока 20 умножения, а выход к первому входу пятого сумматора 17, соединенного вторым входом с выходом первого задатчика 11 постоянного сигнала, а третьим входом с выходом второго квадратора 19, вход которого подключен к выходу третьего сумматора 10 и первому входу шестого сумматора 21, соединенного выходом с первым входом четвертого блока 22 умножения, а вторым входом с выходом третьего блока 20 умножения, второй вход которого подключен к выходу четвертого сумматора 12, соединенного вторым входом с выходом второго задатчика 13 постоянного сигнала, выход третьего задатчика 18 постоянного сигнала подключен к второму входу третьего сумматора 10, а выход второго датчика 23 скорости соединен с вторым входом четвертого блока 22 умножения, а также пятый блок 24 умножения, седьмой сумматор 25 и последовательно соединенные релейный блок 26 и восьмой сумматор 27, выход которого подключен к второму входу первого сумматора 2, выходом соединенного с входом усилителя 3.
Выход первого датчика 5 скорости подключен к входу релейного блока, к второму входу восьмого сумматора 27 и первому входу седьмого сумматора 25, второй вход которого соединен с выходом второго сумматора 8, а выход с первым входом первого блока 1 умножения, подключенного вторым входом к выходу пятого сумматора 17. Первый вход пятого блока 24 умножения соединен с выходом четвертого блока 22 умножения, его второй вход с выходом первого датчика 5 скорости, а выход с третьим входом восьмого сумматора 27.
Кроме того, устройство содержит последовательно соединенные четвертый задатчик 28 постоянного сигнала, девятый сумматор 29, второй вход которого соединен с выходом пятого сумматора 17, шестой 30 и седьмой 31 блоки умножения и десятый сумматор 32, выход которого подключен к четвертому входу восьмого сумматора 27, последовательно соединенные пятый задатчик 33 постоянного сигнала, одиннадцатый сумматор 34, второй вход которого соединен с выходом шестого сумматора 22, и восьмой блок 35 умножения, выход которого подключен к второму входу десятого сумматора 32, последовательно соединенные третий датчик 36 скорости и третий квадратор 37, выход которого соединен с вторым входом шестого блока 30 умножения, последовательно соединенные третий датчик 38 положения, второй усилитель 29 и первый функциональный преобразователь 40, выход которого подключен к второму входу седьмого блока 31 умножения, а второй вход восьмого блока 35 умножения через второй функциональный преобразователь 41 соединен с выходом третьего датчика 38 положения, первый датчик 42 ускорения, установленный на выходном валу двигателя 4, девятый блок 43 умножения, первый вход которого подключен к выходу четвертого блока 22 умножения, его второй вход к третьему входу первого сумматора 2 и выходу первого датчика 42 ускорения, а выход к пятому входу восьмого сумматора 27, последовательно соединенные четвертый квадратор 44, десятый блок 45 умножения, двенадцатый сумматор 46 и одиннадцатый блок 47 умножения, выход которого соединен с шестым входом восьмого сумматора 27, последовательно соединенные двенадцатый блок 43 умножения, первый вход которого подключен к выходу третьего датчика 36 скорости, тринадцатый блок 49 умножения, второй вход которого соединен с выходом второго датчика 50 ускорения, второй вход которого подключен к выходу девятого сумматора 29, и четырнадцатый сумматор 53, выход которого соединен с седьмым входом восьмого сумматора 27, последовательно соединенные пятнадцатый 54, шестнадцатый 55 и семнадцатый 56 блоки умножения, последовательно соединенные третий функциональный преобразователь 57, вход которого подключен к выходу второго усилителя 39, восемнадцатый блок 58 умножения, второй вход которого соединен с выходом третьего квадратора 37 и вторым входом семнадцатого блока 56 умножения, девятнадцатый блок 59 умножения, выход которого подключен к второму входу тринадцатого сумматора 51, последовательно соединенные четвертый функциональный преобразователь 60, вход которого подключен к выходу третьего датчика 38 положения двадцатый блок 61 умножения, второй вход которого подключен к выходу сумматора 34, и двадцать первый блок 62 умножения, второй вход которого соединен с вторыми входами одиннадцатого и девятнадцатого 59 блоков умножения, а также с выходом первого датчика 5 скорости, а его выход с третьим выходом четырнадцатого сумматора 53, последовательно соединенные двадцать второй блок 63 умножения, первый вход которого подключен к выходу второго функционального преобразователя 41, и двадцать третий блок 64 умножения, второй вход которого соединен с выходом второго датчика 23 скорости, входом четвертого квадратора 44 и вторым входом шестнадцатого блока 55 умножения, а его выход с четвертым входом четырнадцатого сумматора 53, последовательно соединенные шестой задатчик 65 постоянного сигнала и пятнадцатый сумматор 66, второй вход которого подключен к выходу датчика 16 массы, а выход к второму входу десятого блока 45 умножения, последовательно соединенные третий датчик 67 ускорения и двадцать четвертый блок 68 умножения, второй вход которого подключен к выходу шестого сумматора 21 и первому входу пятнадцатого блока 54 умножения, второй вход которого соединен с выходом первого функционального преобразователя 40 и вторым входом двенадцатого блока 48 умножения, а выход семнадцатого блока 56 умножения подключен ко второму входу четырнадцатого сумматора 53, объект управления 69.
На фиг. 1 и 2 введены следующие обозначения:
αвх сигнал желаемого положения;
q1, q2, q3 соответствующие обобщенные координаты исполнительного органа робота;
,=iр,q3 скорости изменения соответствующих обобщенных координат;
, ускорения соответствующих обобщенных координат;
q2ip ускорение вращения вала двигателя во второй степени подвижности робота;
m1, m2, m3, mг соответственно массы первого, второго, третьего звеньев исполнительного органа и захваченного груза;
l2*, l3* расстояния от осей вращения второго и третьего звеньев до их центров масс;
l3 расстояние от центра масс третьего звена до средней точки схвата;
скорость вращения ротора двигателя;
U*, U соответственно усиливаемый сигнал и сигнал управления двигателем 4;
ip передаточное отношение редуктора.
Устройство работает следующим образом. Сигнал ошибки ε сумматора 8 после коррекции в блоках 1, 2, 25, усиливаясь, поступает на электродвигатель 4, приводя его вал во вращательное движение с направлением и скоростью (ускорением), зависящими от величины поступающего сигнала ε, моментов трения и внешнего моментного воздействия Мв.
Электропривод при работе с различными грузами, а также за счет взаимовлияния степеней подвижности исполнительного органа, обладает переменными моментными характеристиками, которые могут меняться в широких пределах. Это снижает качественные показатели электропривода и даже приводит к потере устойчивости его работы.
Рассматриваемый привод управляет обобщенной координатой q2. Конструкция робота (см. фиг. 2) является типовой для промышленных роботов (см. например, "Юнимент").
Моментные характеристики привода, управляющего координатой q2зависят от изменения координат q2, q3, , , , , mг. В связи с этим для качественного управления координатой q2 необходимо точно компенсировать отрицательное влияние изменения координат q2, q3, , , , , а также переменной массы груза mг на динамические свойства рассматриваемого привода поворота (координата q2).
Для определения моментных воздействий на рассматриваемый привод (обобщенных моментов неконсервативных сил) воспользуемся уравнением Лагранжа II рода. Кинетическая энергия Т всех движущихся масс исполнительного органа (фиг. 2) представляется в виде
+mг×
где IN2, IN3 моменты инерций второго и третьего звеньев относительно поперечных осей, проходящих через их центры массы;
IS1, IS2, IS3 моменты инерций первого, второго и третьего звеньев относительно их продольных осей.
Потенциальная энергия имеет вид
П g[m2l2* + m3(l3* + q3) + mг(l3* + q3 + l3)]sin q2. Учитывая, что
[IN2+m2l*22+IN3+m3(l*3+q3)2+mг(l*3+q3+l3)2]<>,


на основе уравнений Лангража II рода можно записать, что моментное воздействие на выходной вал привода, управляющего координатой q2 при движении робота (фиг. 2) с грузом имеет вид:
Mв=H(q3)+h(q3, )+Mвн,
(1)
где H(q3)= IN2 + IN3 + m2l2*2 + m3(l3* + q3)2 + +mг(l3* + q3 + l3)2,
h(q3, )=2[m3(l*3+q3)+mг(l*3+q3+l3)]<>,

(2)
где g ускорение свободного падения.
С учетом соотношений (1) и (2), а также уравнений электрической U=L + iR+K и механической iKм=(I+H*)+(h*+Kв)+Mстр+M*вн цепей электродвигателя постоянного тока с постоянными магнитами или независимого возбуждения рассматриваемый привод, управляющий координатой q2, можно описать следующим дифференциальным уравнением

(3)
где =2{[m3+(l*3+q3)+mг(l*3+q3+l3)]<>+(m3+mг)}i2р.

H*=H(q3)/i2р, h*=h(q3, )/i2р, M*вн=Mвн/iр,
R активное сопротивление якорной цепи двигателя; I момент инерции якоря двигателя и вращающихся частей редуктора, приведенных к валу двигателя; Км коэффициент крутящего момента; Кw коэффициент противо-ЭДС; Кв коэффициент вязкого трения; Мстр момент сухого трения; Ку коэффициент усиления усилителя 3; i ток якоря.
Из формулы (3) видно, что параметры этого уравнения, а следовательно, и параметры привода, управляющего координатой q2, являются существенно переменными, зависящими от величин q2, q3, , , , , mг. В результате в процессе работы привода меняются (притом существенно) его динамические свойства. Таким образом, для реализации поставленной задачи необходимо сформировать такое корректирующее устройство, которое застабилизировало бы параметры привода так, чтобы он описывался дифференциальным уравнением с постоянными желаемыми параметрами.
Полагается, что первый положительный вход сумматора 25 (со стороны сумматора 8) единичный, а его второй отрицательный вход имеет коэффициент усиления Kωу. Следовательно на выходе сумматора 25 формируется сигнал ε .
Положительные входы третьего 10 и четвертого 12 сумматоров единичные. Датчик положения 9 установлен на втором звене робота и измеряет обобщенную координату q3, так как его движок механически связан с третьим звеном. Задатчик 18 вырабатывает сигнал l3*, а задатчик 13 сигнал l3.
Таким образом, на выходе сумматора 10 формируется сигнал l3* + q, а на выходе сумматора 12 сигнал l3* + q3 + l3, на выходе блока 15 умножения сигнал mг(l3* + q3 + l3)2, а на выходе квадратора 19 сигнал (l3* + +q3)2. С выхода задатчика 11 на второй положительный единичный вход сумматора 17 поступает сигнал, равный Iip2 + IN2 + IN3 + +m2l2*2. Поскольку первый (со стороны блока 15) и третий (со стороны квадратора 19) положительные входы этого сумматора соответственно имеют единичный коэффициент усиления и коэффициент усиления, равный m3, то на его выходе формируется сигнал Н + Iip2 (см. /2/), а на выходе блока 1 умножения сигнал
(Ii2р+H)
На выходе блока 20 умножения формируется сигнал mг(l3* + q3 + l3). Первый вход сумматора 21 (со стороны сумматора 10) имеет коэффициент усиления 2m3, а его второй вход коэффициент усиления 2. В результате на выходе блока умножения 22 формируется сигнал h (см. /2/), так как датчик 23 измеряет скорость перемещения третьего звена , относительно второго, а на выходе блока 24 умножения сигнал h.
На выходе задатчика 33 формируется сигнал 2m2l2*. Первый и второй положительные входы сумматора 34 имеют коэффициенты усиления q/2, поэтому на его выходе формируется сигнал
g[m2l2* + m3(l3* + q3) + mг(l3* + q3 + l3)]
Датчик положения 38 измеряет обобщенную координату q2, на выходе функционального преобразователя 41 формируется сигнал cos q2, а на выходе блока 35 умножения сигнал g[m2l2* + m3(l3* + q3) + mг(l3* + q3 + l3)]cos q2.
Задатчик 28 вырабатывает сигнал Iip2 + +Is2 + Is3. Первый отрицательный (со стороны задатчика 28) и второй положительный входы сумматора 29 имеют коэффициенты усиления 1/2. В результате на его выходе формируется сигнал
[IN2+IN3-Is2-Is3+m2l*22+m3(l*3+q3)2+mг(l*3+q3+l3)2]
Датчик скорости 36 измеряет координату , усилитель 39 имеет коэффициент усиления 2, а его функциональный преобразователь 40 реализует функцию sin. В результате на выходе блока 31 умножения формируется сигнал
[IN2+IN3-Is2-Is3+m2l*22+m3(l*3+q3)2+mг(l*3+q3+l3)2]<>sin(2q2). Положительные входы сумматора 32 имеют единичные коэффициенты усиления, поэтому на выходе этого сумматора формируется сигнал Мвн (см. /2/).
Выходной сигнал релейного блока 26 с нулевой нейтральной точкой имеет вид
Uвых 26= при где Мт величина момента сухого трения при движении.
Первый датчик 42 ускорения, установленный на выходном валу электродвигателя 4, измеряет ускорение вращения этого вала . В результате на выходе девятого блока 43 умножения формируется сигнал h, на выходе шестого задатчика 65 постоянного сигнала сигнал m3, в результате на выходе пятнадцатого сумматора 66, имеющего положительные входы с коэффициентами усиления, равными 2, формируется сигнал 2(m3 + mг), а на выходе двенадцатого сумматора 46, имеющего два положительных входа с единичными коэффициентами усиления сигнал
2(m3+mг)+2[mг(l*3+q3+l3)+m3(l*3+q3)] так как третий датчик 67 ускорения, установленный в третьей степени подвижности робота, измеряет ускорение вращения этой степени подвижности .
Второй датчик 50 ускорения установлен в первой степени подвижности робота и измеряет ускорение вращения этой степени подвижности . Третий функциональный преобразователь 57 реализует функцию cos. Первый (со стороны блока 49 умножения) и второй положительные входы тринадцатого сумматора 51 соответственно имеют единичный коэффициент усиления и коэффициент усиления, равный 1/ip. В результате на выходе этого сумматора формируется сигнал
sin(2q2)+cos(2q2), так как ip= и на выходе четырнадцатого блока 52 умножения сигнал

На выходе семнадцатого блока 56 умножения формируется сигнал
2[m3(l*3+q3)+mг(l*3+q3+l3)]sin(2q2)<>, на выходе двадцать третьего блока 64 умножения сигнал
2(m3 + mг)cos (q2), и на выходе двадцать первого блока 62 умножения сигнал
gip(m2l*2+m3(l*3+q3)+mг(l*3+q3+l3)]sin(q2)<>
Первый (со стороны блока 52) второй (со стороны блока 56) и четвертый (со стороны блока 64 умножения) положительные входы сумматора 53 соответственно имеют коэффициенты усиления 2L(ipR), L(2ipR) и gL(2ipR), а его третий отрицательный вход коэффициент усиления L/(ip2R). В результате на выходе сумматора 53 формируется сигнал Мвн*.
Первый (со стороны релейного блока 26), второй (со стороны датчика 5), третий (со стороны блока 24) и четвертый положительные входы сумматора 27 соответственно имеют следующие коэффициенты усиления единичный, + Kв, 1/i2p, 1/ip.
Пятый (со стороны блока 43 умножения), шестой (со стороны блока 47 умножения и седьмой (со стороны сумматора 53) положительные входы сумматора 27 соответственно имеют коэффициенты усиления
2L/(ip2R), L(ip2R), L/R.
В результате на выходе сумматора 27 формируется сигнал
+ K+Mт+sign+h+M*вн+ (+M*вн+2h<>).
Первый (со стороны блока 1), второй (со стороны сумматора 27) и третий положительные входы сумматора 2 соответственно имеют коэффициенты усиления 1/(Iнip2), R/(КмКу), LКвмКу.
В результате на выходе этого сумматора формируется сигнал

(4)
Поскольку при движении привода Мт sign достаточно точно соответствует Мстр, то сигнал (4), как несложно убедиться, обеспечивает превращение уравнения (3) с существенно переменными параметрами в уравнение с номинальными постоянными желаемыми параметрами, обеспечивающими приводу заданные динамические свойства и показатели качества
LI+RI+KмK=KуKмε, где заранее выбранные Iн и Ку обеспечат приводу заданные динамические свойства и показатели качества.
Формула изобретения: УСТРОЙСТВО ДЛЯ УПРАВЛЕНИЯ ПРИВОДОМ РОБОТА, содержащее последовательно соединенные первый блок умножения и первый сумматор, последовательно подключенные усилитель и двигатель, связанный с первым датчиком скорости непосредственно и через редуктор с первым датчиком положения, выход которого соединен с первым входом второго сумматора, подключенного вторым входом к входу устройства, последовательно соединенные второй датчик положения, третий сумматор, четвертый сумматор, первый квадратор и второй блок умножения, второй вход которого подключен к выходу датчика массы и первому входу третьего блока умножения, а выход - к первому входу пятого сумматора, соединенного вторым входом с выходом первого задатчика постоянного сигнала, а третьим входом - с выходом второго квадратора, вход которого подключен к выходу третьего сумматора и первому входу шестого сумматора, соединенного выходом с первым входом четвертого блока умножения, а вторым входом - с выходом третьего блока умножения, второй вход которого подключен к выходу четвертого сумматора, соединенного вторым входом с выходом второго задатчика постоянного сигнала, выход третьего задатчика постоянного сигнала подключен к второму входу третьего сумматора, а выход второго датчика скорости соединен с вторым входом четвертого блока умножения, а также пятый блок умножения, седьмой сумматор и последовательно соединенные релейный блок и восьмой сумматор, выход которого подключен к второму входу первого сумматора, выходом соединенного с входом усилителя, причем выход первого датчика скорости подключен к входу релейного блока, второму входу восьмого сумматора и первому входу седьмого сумматора, второй вход которого соединен с выходом второго сумматора, а выход - с первым входом первого блока умножения, подключенного вторым входом к выходу пятого сумматора, первый вход пятого блока умножения соединен с выходом четвертого блока умножения, его второй вход - с выходом первого датчика скорости, а выход - с третьим входом восьмого сумматора, последовательно соединенные четвертый задатчик постоянного сигнала, девятый сумматор, второй вход которого соединен с выходом пятого сумматора, шестой и седьмой блоки умножения и десятый сумматор, выход которого подключен к четвертому входу восьмого сумматора, последовательно соединенные пятый задатчик постоянного сигнала, одиннадцатый сумматор, второй вход которого соединен с выходом шестого сумматора, и восьмой блок умножения, выход которого подключен к второму входу десятого сумматора, последовательно соединенные третий датчик скорости и третий квадратор, выход которого соединен с вторым входом шестого блока умножения, последовательно соединенные третий датчик положения, второй усилитель и первый функциональный преобразователь, выход которого подключен к второму входу седьмого блока умножения, а второй вход восьмого блока умножения через второй функциональный преобразователь соединен с выходом третьего датчика положения, отличающееся тем, что оно дополнительно содержит первый датчик ускорения, установленный на выходном валу двигателя, девятый блок умножения, первый вход которого подключен к выходу четвертого блока умножения, его второй вход - к третьему входу первого сумматора и выходу первого датчика ускорения, а выход - к пятому входу восьмого сумматора, последовательно соединенные четвертый квадратор, десятый блок умножения, двенадцатый сумматор и одиннадцатый блок умножения, выход которого соединен с шестым входом восьмого сумматора, последовательно соединенные двенадцатый блок умножения, первый вход которого подключен к выходу третьего датчика скорости, тринадцатый блок умножения, второй вход которого соединен с выходом второго датчика ускорения, тринадцатый сумматор, четырнадцатый блок умножения, второй вход которого подключен к выходу девятого сумматора, четырнадцатый сумматор, выход которого соединен с седьмым входом восьмого сумматора, последовательно соединенные пятнадцатый, шестнадцатый и семнадцатый блоки умножения, последовательно соединенные третий функциональный преобразователь, вход которого подключен к выходу второго усилителя, восемнадцатый блок умножения, второй вход которого соединен с выходом третьего квадратора и вторым входом семнадцатого блока умножения, девятнадцатый блок умножения, выход которого подключен к вторму входу тринадцатого сумматора, последовательно соединенные четвертый функциональный преобразователь, вход которого подключен к выходу третьего датчика положения, двадцатый блок умножения, второй вход которого подключен к выходу одиннадцатого сумматора, и двадцать первый блок умножения, второй вход которого соединен с вторыми входами одиннадцатого и девятнадцатого блоков умножения, а также с выходом первого датчика скорости, а его выход - с третьим входом четырнадцатого сумматора, последовательно соединенные двадцать второй блок умножения, первый вход которого подключен к выходу второго функционального преобразователя, и двадцать третий блок умножения, второй вход которого соединен с выходом второго датчика скорости, входом четвертого квадратора и вторым входом шестнадцатого блока умножения, а его выход - с четвертым входом четырнадцатого сумматора, последовательно соединенные шестой задатчик постоянного сигнала и пятнадцатый сумматор, второй вход которого подключен к выходу датчика массы, а выход - к второму входу десятого блока умножения, последовательно соединенные третий датчик ускорения и двадцать четвертый блок умножения, второй вход которого подключен к выходу шестого сумматора и первому входу пятнадцатого блока умножения, второй вход которого соединен с выходом первого функционального преобразователя и вторым входом двенадцатого блока умножения, а выход семнадцатого блока умножения подключен к второму входу четырнадцатого сумматора.