RU2725447C1 - Самонастраивающийся электропривод манипулятора - Google Patents

Самонастраивающийся электропривод манипулятора Download PDF

Info

Publication number
RU2725447C1
RU2725447C1 RU2019118748A RU2019118748A RU2725447C1 RU 2725447 C1 RU2725447 C1 RU 2725447C1 RU 2019118748 A RU2019118748 A RU 2019118748A RU 2019118748 A RU2019118748 A RU 2019118748A RU 2725447 C1 RU2725447 C1 RU 2725447C1
Authority
RU
Russia
Prior art keywords
input
output
adder
multiplication
multiplication unit
Prior art date
Application number
RU2019118748A
Other languages
English (en)
Inventor
Владимир Федорович Филаретов
Original Assignee
Федеральное государственное бюджетное учреждение науки Институт автоматики и процессов управления Дальневосточного отделения Российской академии наук (ИАПУ ДВО РАН)
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Федеральное государственное бюджетное учреждение науки Институт автоматики и процессов управления Дальневосточного отделения Российской академии наук (ИАПУ ДВО РАН) filed Critical Федеральное государственное бюджетное учреждение науки Институт автоматики и процессов управления Дальневосточного отделения Российской академии наук (ИАПУ ДВО РАН)
Priority to RU2019118748A priority Critical patent/RU2725447C1/ru
Application granted granted Critical
Publication of RU2725447C1 publication Critical patent/RU2725447C1/ru

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00—Controls for manipulators
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

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

Description

Изобретение относится к робототехнике и может быть использовано при создании электроприводов манипуляторов.
Известен электропривод робота, содержащий последовательно соединенные первый блок умножения, первый сумматор, усилитель и электродвигатель, связанные с первым датчиком скорости непосредственно и через редуктор - с первым датчиком положения, выход которого соединен с первым входом второго сумматора, подключенного вторым входом к входу устройства, последовательно соединенные второй датчик положения, третий сумматор, второй вход которого подключен к выходу первого задатчика сигнала, четвертый сумматор, второй вход которого соединен с выходом второго задатчика сигнала, первый квадратор, второй блок умножения, второй вход которого подключен к выходу датчика массы, и пятый сумматор, второй вход которого подключен к выходу третьего задатчика сигнала, третий вход через второй квадратор - к выходу третьего сумматора, а выход - ко второму входу первого блока умножения, последовательно соединенные третий блок умножения, первый вход которого соединен с выходом датчика массы, а второй вход - с выходом четвертого сумматора, шестой сумматор, второй вход которого подключен к выходу третьего сумматора, четвертый блок умножения, второй вход которого соединен с выходом второго датчика скорости, и пятый блок умножения, седьмой сумматор, первый вход которого подключен к выходу второго сумматора, выход - к первому входу первого блока умножения, а второй вход - ко второму входу пятого блока умножения, выходу первого датчика скорости, входу релейного блока и первому входу восьмого сумматора, второй вход которого подключен к выходу релейного блока, третий вход - к выходу пятого блока умножения, а выход - ко второму входу первого сумматора, последовательно соединенные четвертый задатчик сигнала, девятый сумматор, второй вход которого соединен с выходом пятого сумматора, шестой и седьмой блоки умножения и десятый сумматор, выход которого подключен к четвертому входу восьмого сумматора, последовательно соединенные третий датчик скорости и третий квадратор, выход которого подключен ко второму входу шестого блока умножения, последовательно соединенные второй усилитель и первый синусный функциональный преобразователь, выход которого подключен к второму входу седьмого блока умножения, а также последовательно соединенные второй косинусный функциональный преобразователь, подключенный входом к выходу первого датчика положения и входу второго усилителя, и восьмой блок умножения, второй вход которого соединен с выходом шестого сумматора, а выход - со вторым входом десятого сумматора, последовательно соединенные третий датчик положения, третий косинусный функциональный преобразователь, девятый блок умножения, второй вход которого подключен к выходу шестого сумматора, десятый блок умножения, второй вход которого соединен с выходом первого датчика ускорения, а также одиннадцатый блок умножения, второй вход которого через четвертый синусный функциональный преобразователь, подключен к выходу первого датчика положения, а выход - к пятому входу восьмого сумматора, последовательно соединенные пятый синусный функциональный преобразователь, подключенный входом к выходу третьего датчика положения, двенадцатый блок умножения, второй вход которого подключен к выходу шестого сумматора, тринадцатый блок умножения, второй вход которого соединен с выходом второго датчика ускорения, и одиннадцатый сумматор, второй вход которого соединен с выходом десятого блока умножения, а выход - с первым входом одиннадцатого блока умножения (патент РФ №2489250, кл. B25J 13/00. Бюл. №22, 2013 г.).
Недостаток известного технического решения в том, что в нем не учитывается, считаясь малой, электрическая постоянная времени электродвигателя. Поэтому полная инвариантность динамических свойств рассматриваемого электропривода к непрерывным изменениям его моментных нагрузочных характеристик не обеспечивается.
Известен также самонастраивающийся электропривод манипулятора, содержащий последовательно соединенные первый блок умножения и первый сумматор, последовательно подключенные усилитель и двигатель, связанные с первым датчиком скорости непосредственно и через редуктор - с первым датчиком положения, выход которого соединен с первым входом второго сумматора, подключенного вторым входом к входу устройства, последовательно соединенные второй датчик положения, установленный в третьей степени подвижности манипулятора, третий сумматор, четвертый сумматор, первый квадратор и второй блок умножения, второй вход которого подключен к выходу датчика массы и первому входу третьего блока умножения, а выход - к первому входу пятого сумматора, соединенного вторым входом с выходом первого задатчика постоянного сигнала, а третьим входом - с выходом второго квадратора, вход которого подключен к выходу третьего сумматора и первому входу шестого сумматора, соединенного выходом с первым входом четвертого блока умножения, а вторым входом - с выходом третьего блока умножения, второй вход которого подключен к выходу четвертого сумматора, соединенного вторым входом с выходом второго задатчика постоянного сигнала, выход третьего задатчика постоянного сигнала подключен к второму входу третьего сумматора, а выход второго датчика скорости, установленного в третьей степени подвижности манипулятора, соединен со вторым входом четвертого блока умножения, выход которого подключен к первому входу пятого блока умножения, последовательно соединенные релейный блок и восьмой сумматор, второй вход которого подключен к выходу первого датчика скорости, к первому входу седьмого сумматора, к входу релейного блока, к второму входу пятого блока умножения, выход которого подключен к третьему входу восьмого сумматора, а выход - ко второму входу первого сумматора, выходом соединенного с входом усилителя, причем второй вход седьмого сумматора соединен с выходом второго сумматора, а выход - с первым входом первого блока умножения, подключенного вторым входом к выходу пятого сумматора, последовательно соединенные четвертый задатчик постоянного сигнала, девятый сумматор, второй вход которого соединен с выходом пятого сумматора, шестой и седьмой блоки умножения и десятый сумматор, выход которого подключен к четвертому входу восьмого сумматора, последовательно соединенные первый датчик ускорения, установленный в третьей степени подвижности манипулятора, и восьмой блок умножения, девятый блок умножения, выход которого подключен к второму входу десятого сумматора, последовательно соединенные третий датчик скорости, установленный в первой степени подвижности манипулятора, и третий квадратор, выход которого соединен с вторым входом шестого блока умножения, пятый задатчик постоянного сигнала, последовательно соединенные второй усилитель и первый функциональный преобразователь, реализующий функцию sin, выход которого подключен ко второму входу седьмого блока умножения, а первый вход девятого блока умножения через второй функциональный преобразователь, реализующий функцию cos, подключен к выходу первого датчика положения и к входу второго усилителя, второй датчик ускорения, установленный на выходном валу двигателя, десятый блок умножения, первый вход которого подключен к выходу четвертого блока умножения, второй вход - к третьему входу первого сумматора и выходу второго датчика ускорения, а выход - к пятому входу восьмого сумматора, последовательно соединенные четвертый квадратор, одиннадцатый блок умножения, одиннадцатый сумматор и двенадцатый блок умножения, выход которого соединен с шестым входом восьмого сумматора, последовательно соединенные тринадцатый блок умножения, первый вход которого подключен к выходу третьего датчика 36 скорости, четырнадцатый блок умножения, второй вход которого соединен с выходом третьего датчика ускорения, установленного в первой степени подвижности манипулятора, двенадцатый сумматор, пятнадцатый блок умножения, второй вход которого подключен к выходу девятого сумматора, и тринадцатый сумматор, выход которого соединен с седьмым входом восьмого сумматора, последовательно соединенные шестнадцатый, семнадцатый и восемнадцатый блоки умножения, последовательно соединенные третий функциональный преобразователь, реализующий функцию cos, вход которого подключен к выходу второго усилителя, девятнадцатый блок умножения, второй вход которого соединен с выходом третьего квадратора и вторым входом восемнадцатого блока умножения, двадцатый блок умножения, выход которого подключен ко второму входу двенадцатого сумматора, последовательно соединенные четвертый функциональный преобразователь, реализующий функцию sin, вход которого подключен к выходу первого датчика положения, двадцать первый блок умножения, второй вход которого подключен к выходу шестого сумматора, к вторым входам восьмого и девятого блоков умножения и к первому входу шестнадцатого блока умножения, и двадцать второй блок умножения, второй вход которого соединен со вторыми входами двенадцатого и двадцатого блоков умножения, а также с выходом первого датчика скорости, а его выход - с третьим входом тринадцатого сумматора, второй вход которого подключен к выходу восемнадцатого блока умножения, последовательно соединенные двадцать третий блок умножения, первый вход которого подключен к выходу второго функционального преобразователя, и двадцать четвертый блок умножения, второй вход которого соединен с выходом второго датчика скорости, входом четвертого квадратора и вторым входом семнадцатого блока умножения, а его выход - с четвертым входом тринадцатого сумматора, четырнадцатый сумматор, первый вход которого подключен к выходу пятого задатчика постоянного сигнала, второй - к выходу датчика массы, а выход - к вторым входам одиннадцатого и двадцать третьего блоков умножения, причем второй вход шестнадцатого блока умножения соединен с выходом первого функционального преобразователя и вторым входом тринадцатого блока умножения, а второй вход одиннадцатого сумматора - с выходом восьмого блока умножения, последовательно соединенные третий датчик положения, установленный в первой степени подвижности манипулятора, пятый функциональный преобразователь, реализующий функцию cos, двадцать пятый блок умножения, второй вход которого через шестой функциональный преобразователь, реализующий функцию sin, подключен к выходу первого датчика положения, двадцать шестой блок умножения, второй вход которого подключен к выходу шестого сумматора, двадцать седьмой блок умножения, выход которого подключен к восьмому входу восьмого сумматора, последовательно соединенные четвертый датчик ускорения, установленный в четвертой степени подвижности манипулятора, дифференциатор, двадцать восьмой блок умножения, пятнадцатый сумматор и двадцать девятый блок умножения, выход которого подключен к девятому входу восьмого сумматора, последовательно соединенные седьмой функциональный преобразователь, реализующий функцию sin, вход которого подключен к выходу третьего датчика положения, тридцатый блок умножения, второй вход которого подключен к выходу шестого функционального преобразователя, тридцать первый блок умножения, второй вход которого подключен к выходу третьего датчика скорости, шестнадцатый сумматор и тридцать второй блок умножения, выход которого подключен ко второму входу пятнадцатого сумматора, последовательно соединенные тридцать третий блок умножения, первый вход которого подключен к выходу четвертого датчика ускорения и к второму входу тридцать второго блока умножения, второй вход - к выходу двадцать пятого блока умножения и к второму входу двадцать восьмого блока умножения, тридцать четвертый блок умножения, второй вход которого подключен к выходу второго датчика скорости, и тридцать пятый блок умножения, второй вход которого подключен к выходу четырнадцатого сумматора, а выход - к десятому входу восьмого сумматора, последовательно соединенные тридцать шестой блок умножения, первый вход которого через восьмой функциональный преобразователь, реализующий функцию cos, подключен к выходу первого датчика положения, а второй - к выходу пятого функционального преобразователя, тридцать седьмой блок умножения, второй вход которого подключен к выходу первого датчика скорости, а выход - ко второму входу шестнадцатого сумматора (патент РФ №2608005, кл. B25J 13/00, B25J 9/16. Бюл. №2, 2017). Это устройство по своей технической сущности является наиболее близким к заявляемому изобретению и взято за прототип.
Недостатком прототипа также является то, что в нем отсутствует полная инвариантность динамических свойств рассматриваемого электропривода к непрерывным изменениям его моментных нагрузочных характеристик, поскольку в нем рассматривается манипулятор с другой кинематической схемой, которая имеет меньшее число степеней подвижности.
Задачей, на решение которой направлено заявляемое техническое решение, является обеспечение полной инвариантности динамических свойств рассматриваемого электропривода к непрерывным и быстрым изменениям его динамических моментных нагрузочных характеристик при движении конкретного манипулятора по всем его степеням подвижности.
Технический результат, который может быть получен при реализации заявляемого технического решения, выражается в формировании дополнительного сигнала управления, подаваемого на вход электропривода, который обеспечивает формирование моментного воздействия, необходимого для обеспечения полной инвариантности его показателей качества к непрерывно изменяющимся параметрам нагрузки.
Поставленная задача решается тем, что в самонастраивающийся электропривод манипулятора, содержащий последовательно соединенные первый блок умножения и первый сумматор, последовательно подключенные усилитель и двигатель, связанные с первым датчиком скорости непосредственно и через редуктор - с первым датчиком положения, выход которого соединен с первым входом второго сумматора, подключенного вторым входом к входу устройства, последовательно соединенные второй датчик положения, установленный в третьей степени подвижности манипулятора, третий сумматор, четвертый сумматор, первый квадратор и второй блок умножения, второй вход которого подключен к выходу датчика массы и первому входу третьего блока умножения, а выход - к первому входу пятого сумматора, соединенного вторым входом с выходом первого задатчика постоянного сигнала, а третьим входом - с выходом второго квадратора, вход которого подключен к выходу третьего сумматора и первому входу шестого сумматора, соединенного выходом с первым входом четвертого блока умножения, а вторым входом - с выходом третьего блока умножения, второй вход которого подключен к выходу четвертого сумматора, соединенного вторым входом с выходом второго задатчика постоянного сигнала, выход третьего задатчика постоянного сигнала подключен к второму входу третьего сумматора, а выход второго датчика скорости, установленного в третьей степени подвижности манипулятора, соединен со вторым входом четвертого блока умножения, выход которого подключен к первому входу пятого блока умножения, последовательно соединенные релейный блок и восьмой сумматор, второй вход которого подключен к выходу первого датчика скорости, к первому входу седьмого сумматора, к входу релейного блока, к второму входу пятого блока умножения, выход которого подключен к третьему входу восьмого сумматора, а выход - ко второму входу первого сумматора, выходом соединенного с входом усилителя, причем второй вход седьмого сумматора соединен с выходом второго сумматора, а выход - с первым входом первого блока умножения, подключенного вторым входом к выходу пятого сумматора, последовательно соединенные четвертый задатчик постоянного сигнала, девятый сумматор, второй вход которого соединен с выходом пятого сумматора, шестой и седьмой блоки умножения и десятый сумматор, выход которого подключен к четвертому входу восьмого сумматора, последовательно соединенные первый датчик ускорения, установленный в третьей степени подвижности манипулятора, и восьмой блок умножения, девятый блок умножения, выход которого подключен к второму входу десятого сумматора, последовательно соединенные третий датчик скорости, установленный в первой степени подвижности манипулятора, и третий квадратор, выход которого соединен с вторым входом шестого блока умножения, пятый задатчик постоянного сигнала, последовательно соединенные второй усилитель и первый функциональный преобразователь, реализующий функцию sin, выход которого подключен ко второму входу седьмого блока умножения, а первый вход девятого блока умножения через второй функциональный преобразователь, реализующий функцию cos, подключен к выходу первого датчика положения и к входу второго усилителя, второй датчик ускорения, установленный на выходном валу двигателя, десятый блок умножения, первый вход которого подключен к выходу четвертого блока умножения, второй вход - к третьему входу первого сумматора и выходу второго датчика ускорения, а выход - к пятому входу восьмого сумматора, последовательно соединенные четвертый квадратор, одиннадцатый блок умножения, одиннадцатый сумматор и двенадцатый блок умножения, выход которого соединен с шестым входом восьмого сумматора, последовательно соединенные тринадцатый блок умножения, первый вход которого подключен к выходу третьего датчика скорости, четырнадцатый блок умножения, второй вход которого соединен с выходом третьего датчика ускорения, установленного в первой степени подвижности манипулятора, двенадцатый сумматор, пятнадцатый блок умножения, второй вход которого подключен к выходу девятого сумматора, и тринадцатый сумматор, выход которого соединен с седьмым входом восьмого сумматора, последовательно соединенные шестнадцатый, семнадцатый и восемнадцатый блоки умножения, последовательно соединенные третий функциональный преобразователь, реализующий функцию cos, вход которого подключен к выходу второго усилителя, девятнадцатый блок умножения, второй вход которого соединен с выходом третьего квадратора и вторым входом восемнадцатого блока умножения, и двадцатый блок умножения, выход которого подключен ко второму входу двенадцатого сумматора, последовательно соединенные четвертый функциональный преобразователь, реализующий функцию sin, вход которого подключен к выходу первого датчика положения, двадцать первый блок умножения, второй вход которого подключен к выходу шестого сумматора, к вторым входам восьмого и девятого блоков умножения и к первому входу шестнадцатого блока умножения, и двадцать второй блок умножения, второй вход которого соединен со вторыми входами двенадцатого и двадцатого блоков умножения, а также с выходом первого датчика скорости, а его выход - с третьим входом тринадцатого сумматора, второй вход которого подключен к выходу восемнадцатого блока умножения, последовательно соединенные двадцать третий блок умножения, первый вход которого подключен к выходу второго функционального преобразователя, и двадцать четвертый блок умножения, второй вход которого соединен с выходом второго датчика скорости, входом четвертого квадратора и вторым входом семнадцатого блока умножения, а его выход - с четвертым входом тринадцатого сумматора, четырнадцатый сумматор, первый вход которого подключен к выходу пятого задатчика постоянного сигнала, второй - к выходу датчика массы, а выход - к вторым входам одиннадцатого и двадцать третьего блоков умножения, причем второй вход шестнадцатого блока умножения соединен с выходом первого функционального преобразователя и вторым входом тринадцатого блока умножения, а второй вход одиннадцатого сумматора - с выходом восьмого блока умножения, последовательно соединенные третий датчик положения, установленный в первой степени подвижности манипулятора, пятый функциональный преобразователь, реализующий функцию cos, двадцать пятый блок умножения, второй вход которого через шестой функциональный преобразователь, реализующий функцию sin, подключен к выходу первого датчика положения, двадцать шестой блок умножения, второй вход которого подключен к выходу шестого сумматора и двадцать седьмой блок умножения, выход которого подключен к восьмому входу восьмого сумматора, последовательно соединенные четвертый датчик ускорения, установленный в четвертой степени подвижности манипулятора, первый дифференциатор, двадцать восьмой блок умножения, пятнадцатый сумматор и двадцать девятый блок умножения, второй вход которого подключен к выходу шестого сумматора, а выход - к девятому входу восьмого сумматора, последовательно соединенные седьмой функциональный преобразователь, реализующий функцию sin, вход которого подключен к выходу третьего датчика положения, тридцатый блок умножения, второй вход которого подключен к выходу шестого функционального преобразователя, тридцать первый блок умножения, второй вход которого подключен к выходу третьего датчика скорости, шестнадцатый сумматор и тридцать второй блок умножения, выход которого подключен ко второму входу пятнадцатого сумматора, тридцать третий блок умножения, первый вход которого подключен к выходу четвертого датчика ускорения, а также ко вторым входам седьмого и тридцать второго блоков умножения, а второй вход - к выходу двадцать пятого блока умножения и к второму входу двадцать восьмого блока умножения, последовательно соединенные тридцать четвертый блок умножения, первый вход которого подключен к выходу второго датчика скорости, и тридцать пятый блок умножения, второй вход которого подключен к выходу четырнадцатого сумматора, а выход - к десятому входу восьмого сумматора, последовательно соединенные тридцать шестой блок умножения, первый вход которого через восьмой функциональный преобразователь, реализующий функцию cos, подключен к выходу первого датчика положения, а второй - к выходу пятого функционального преобразователя, и тридцать седьмой блок умножения, второй вход которого подключен к выходу первого датчика скорости, а выход - ко второму входу шестнадцатого сумматора, дополнительно вводятся последовательно соединенные тридцать восьмой, тридцать девятый и сороковой блоки умножения, второй вход последнего подключен к выходу шестого сумматора, а выход - к одиннадцатому входу восьмого сумматора, сорок первый блок умножения, первый вход которого подключен к выходу седьмого функционального преобразователя и первому входу тридцать восьмого блока умножения, а второй вход - к выходу восьмого функционального преобразователя, последовательно соединенные семнадцатый сумматор и сорок второй блок умножения, выход которого подключен к третьему входу пятнадцатого сумматора, последовательно соединенные второй дифференциатор и сорок третий блок умножения, выход которого подключен к четвертому входу пятнадцатого сумматора, последовательно соединенные пятый датчика 96 ускорения, сорок четвертый блок умножения, второй вход которого подключен к выходу тридцать восьмого блока умножения и к второму входу сорок третьего блока умножения, и восемнадцатый сумматор, второй вход которого подключен к выходу тридцать третьего блока умножения, а выход - к второму входу тридцать четвертого блока умножения, причем вход второго дифференциатора и вторые входы тридцать девятого и сорок второго блоков умножения подключены к выходу пятого датчика ускорения, последовательно соединенные сорок пятый блок умножения, первый вход которого подключен к выходу третьего датчика скорости, а второй - к выходу пятого функционального преобразователя, сорок шестой блок умножения, второй вход которого подключен к выходу шестого функционального преобразователя и к второму входу тридцать восьмого блока умножения, а выход - к первому входу семнадцатого сумматора, второй вход которого через сорок седьмой блок умножения подключен к выходу сорок первого блока умножения, а второй вход сорок седьмого блока умножения подключен к выходу первого датчика скорости.
Сопоставительный анализ существенных признаков предлагаемого технического решения с существенными признаками аналога и прототипа свидетельствуют о его соответствии критерию «новизна».
При этом отличительные признаки формулы изобретения обеспечивают высокую точность и устойчивость работы электропривода рассматриваемого манипулятора в условиях существенного изменения его параметров нагрузки.
Сущность изобретения поясняется чертежами, где на фиг. 1 изображена блок-схема электропривода манипулятора, а на фиг. 2 - его кинематическая схема.
Самонастраивающийся электропривод манипулятора содержит последовательно соединенные первый блок 1 умножения и первый сумматор 2, соединенные усилитель 3 и двигатель 4, связанные с первым датчиком 5 скорости непосредственно и через редуктор 6 - с первым датчиком 7 положения, выход которого соединен с первым входом второго сумматора 8, подключенного вторым входом к входу устройства, последовательно соединенные второй датчик 9 положения, установленный в третьей степени подвижности манипулятора, третий сумматор 10, четвертый сумматор 12, первый квадратор 14 и второй блок 15 умножения, второй вход которого подключен к выходу датчика 16 массы и первому входу третьего блока 20 умножения, а выход - к первому входу пятого сумматора 17, соединенного вторым входом с выходом первого задатчика 11 постоянного сигнала, а третьим входом - с выходом второго квадратора 19, вход которого подключен к выходу третьего сумматора 10 и первому входу шестого сумматора 21, соединенного выходом с первым входом четвертого блока 22 умножения, а вторым входом - с выходом третьего блока 20 умножения, второй вход которого подключен к выходу четвертого сумматора 12, соединенного вторым входом с выходом второго задатчика 13 постоянного сигнала, выход третьего задатчика 18 постоянного сигнала подключен к второму входу третьего сумматора 10, а выход второго датчика 23 скорости, установленного в третьей степени подвижности манипулятора, соединен со вторым входом четвертого блока 22 умножения, выход которого подключен к первому входу пятого блока 24 умножения, последовательно соединенные релейный блок 26 и восьмой сумматор 27, второй вход которого подключен к выходу первого датчика 5 скорости, к первому входу седьмого сумматора 25, к входу релейного блока 26, к второму входу пятого блока 24 умножения, выход которого подключен к третьему входу восьмого сумматора 27, а выход - ко второму входу первого сумматора 2, выходом соединенного с входом усилителя 3, причем второй вход седьмого сумматора 25 соединен с выходом второго сумматора 8, а выход - с первым входом первого блока 1 умножения, подключенного вторым входом к выходу пятого сумматора 17, последовательно соединенные четвертый задатчик 28 постоянного сигнала, девятый сумматор 29, второй вход которого соединен с выходом пятого сумматора 17, шестой 30 и седьмой 31 блоки умножения и десятый сумматор 32, выход которого подключен к четвертому входу восьмого сумматора 27, последовательно соединенные первый датчик 33 ускорения, установленный в третьей степени подвижности манипулятора, и восьмой блок 34 умножения, девятый блок 35 умножения, выход которого подключен к второму входу десятого сумматора 32, последовательно соединенные третий датчик 36 скорости, установленный в первой степени подвижности манипулятора, и третий квадратор 37, выход которого соединен с вторым входом шестого блока 30 умножения, пятый задатчик 38 постоянного сигнала, последовательно соединенные второй усилитель 39 и первый функциональный преобразователь 40, реализующий функцию sin, выход которого подключен ко второму входу седьмого блока 31 умножения, а первый вход девятого блока 35 умножения через второй функциональный преобразователь 41, реализующий функцию cos, подключен к выходу первого датчика 7 положения и к входу второго усилителя 39, второй датчик 42 ускорения, установленный на выходном валу двигателя 4, десятый блок 43 умножения, первый вход которого подключен к выходу четвертого блока 22 умножения, второй вход - к третьему входу первого сумматора 2 и выходу второго датчика 42 ускорения, а выход - к пятому входу восьмого сумматора 27, последовательно соединенные четвертый квадратор 44, одиннадцатый блок 45 умножения, одиннадцатый сумматор 46 и двенадцатый блок 47 умножения, выход которого соединен с шестым входом восьмого сумматора 27, последовательно соединенные тринадцатый блок 48 умножения, первый вход которого подключен к выходу третьего датчика 36 скорости, четырнадцатый блок 49 умножения, второй вход которого соединен с выходом третьего датчика 50 ускорения, установленного в первой степени подвижности манипулятора, двенадцатый сумматор 51, пятнадцатый блок умножения 52, второй вход которого подключен к выходу девятого сумматора 29, и тринадцатый сумматор 53, выход которого соединен с седьмым входом восьмого сумматора 27, последовательно соединенные шестнадцатый 54, семнадцатый 55 и восемнадцатый 56 блоки умножения, последовательно соединенные третий функциональный преобразователь 57, реализующий функцию cos, вход которого подключен к выходу второго усилителя 39, девятнадцатый блок 58 умножения, второй вход которого соединен с выходом третьего квадратора 37 и вторым входом восемнадцатого блока 56 умножения, и двадцатый блок 59 умножения, выход которого подключен ко второму входу двенадцатого сумматора 51, последовательно соединенные четвертый функциональный преобразователь 60, реализующий функцию sin, вход которого подключен к выходу первого датчика 7 положения, двадцать первый блок 61 умножения, второй вход которого подключен к выходу шестого сумматора 21, к вторым входам восьмого 34 и девятого 35 блоков умножения и к первому входу шестнадцатого 54 блока умножения, и двадцать второй блок 62 умножения, второй вход которого соединен со вторыми входами двенадцатого 47 и двадцатого 59 блоков умножения, а также с выходом первого датчика 5 скорости, а его выход - с третьим входом тринадцатого сумматора 53, второй вход которого подключен к выходу восемнадцатого блока 56 умножения, последовательно соединенные двадцать третий блок 63 умножения, первый вход которого подключен к выходу второго функционального преобразователя 41, и двадцать четвертый блок 64 умножения, второй вход которого соединен с выходом второго датчика 23 скорости, входом четвертого квадратора 44 и вторым входом семнадцатого блока 55 умножения, а его выход - с четвертым входом тринадцатого сумматора 53, четырнадцатый сумматор 65, первый вход которого подключен к выходу пятого задатчика 38 постоянного сигнала, второй - к выходу датчика 16 массы, а выход - к вторым входам одиннадцатого 45 и двадцать третьего 63 блоков умножения, причем второй вход шестнадцатого блока 54 умножения соединен с выходом первого функционального преобразователя 40 и вторым входом тринадцатого блока 48 умножения, а второй вход одиннадцатого сумматора 46 - с выходом восьмого блока 34 умножения, последовательно соединенные третий датчик 66 положения, установленный в первой степени подвижности манипулятора, пятый функциональный преобразователь 67, реализующий функцию cos, двадцать пятый блок 68 умножения, второй вход которого через шестой функциональный преобразователь 69, реализующий функцию sin, подключен к выходу первого датчика 7 положения, двадцать шестой блок 70 умножения, второй вход которого подключен к выходу шестого сумматора 21 и двадцать седьмой блок 71 умножения, выход которого подключен к восьмому входу восьмого сумматора 27, последовательно соединенные четвертый датчик 72 ускорения, установленный в четвертой степени подвижности манипулятора, первый дифференциатор 73, двадцать восьмой блок 74 умножения, пятнадцатый сумматор 75 и двадцать девятый блок 76 умножения, второй вход которого подключен к выходу шестого сумматора 21, а выход - к девятому входу восьмого сумматора 27, последовательно соединенные седьмой функциональный преобразователь 77, реализующий функцию sin, вход которого подключен к выходу третьего датчика 66 положения, тридцатый блок 78 умножения, второй вход которого подключен к выходу шестого функционального преобразователя 69, тридцать первый блок 79 умножения, второй вход которого подключен к выходу третьего датчика 36 скорости, шестнадцатый сумматор 80 и тридцать второй блок 81 умножения, выход которого подключен ко второму входу пятнадцатого сумматора 75, тридцать третий блок 82 умножения, первый вход которого подключен к выходу четвертого датчика 72 ускорения, а также ко вторым входам седьмого 71 и тридцать второго блоков 81 умножения, а второй вход - к выходу двадцать пятого блока 68 умножения и к второму входу двадцать восьмого блока 74 умножения, последовательно соединенные тридцать четвертый блок 83 умножения, первый вход которого подключен к выходу второго датчика 23 скорости, и тридцать пятый блок 84 умножения, второй вход которого подключен к выходу четырнадцатого сумматора 65, а выход - к десятому входу восьмого сумматора 27, последовательно соединенные тридцать шестой блок 85 умножения, первый вход которого через восьмой функциональный преобразователь 86, реализующий функцию cos, подключен к выходу первого датчика 7 положения, а второй - к выходу пятого функционального преобразователя 67, и тридцать седьмой блок 87 умножения, второй вход которого подключен к выходу первого датчика 5 скорости, а выход - ко второму входу шестнадцатого сумматора 80, последовательно соединенные тридцать восьмой 88, тридцать девятый 89 и сороковой 90 блоки умножения, второй вход последнего подключен к выходу шестого сумматора 21, а выход - к одиннадцатому входу восьмого сумматора 27, сорок первый блок 91 умножения, первый вход которого подключен к выходу седьмого функционального преобразователя 77 и первому входу тридцать восьмого блока 88 умножения, а второй вход - к выходу восьмого функционального преобразователя 86, последовательно соединенные семнадцатый сумматор 92 и сорок второй блок 93 умножения, выход которого подключен к третьему входу пятнадцатого сумматора 75, последовательно соединенные второй дифференциатор 94 и сорок третий блок 95 умножения, выход которого подключен к четвертому входу пятнадцатого сумматора 75, последовательно соединенные пятый датчика 96 ускорения, сорок четвертый блок 97 умножения, второй вход которого подключен к выходу тридцать восьмого блока 88 умножения и к второму входу сорок третьего блока 95 умножения, и восемнадцатый сумматор 98, второй вход которого подключен к выходу тридцать третьего блока 82 умножения, а выход - к второму входу тридцать четвертого блока 83 умножения, причем вход второго дифференциатора 94 и вторые входы тридцать девятого 89 и сорок второго 93 блоков умножения подключены к выходу пятого датчика 96 ускорения, последовательно соединенные сорок пятый блок 99 умножения, первый вход которого подключен к выходу третьего датчика 36 скорости, а второй - к выходу пятого функционального преобразователя 67, сорок шестой блок 100 умножения, второй вход которого подключен к выходу шестого функционального преобразователя 69 и к второму входу тридцать восьмого блока 88 умножения, а выход - к первому входу семнадцатого сумматора 92, второй вход которого через сорок седьмой блок 101 умножения подключен к выходу сорок первого блока 91 умножения, а второй вход сорок седьмого блока 101 умножения подключен к выходу первого датчика 5 скорости. Объект управления 102.
На фиг. 1 и 2 введены следующие обозначения: αВХ - сигнал с выхода программного устройства; ε - сигнал ошибки привода; U*,U - соответственно усиливаемый сигнал и сигнал управления электродвигателем 4;
Figure 00000001
- обобщенные координаты манипулятора;
Figure 00000002
,
Figure 00000003
- скорости изменения соответствующих обобщенных координат;
Figure 00000004
- скорость вращения ротора электродвигателя;
Figure 00000005
Figure 00000006
- ускорения обобщенных координат; m1, m2, mГ - соответственно, массы первого, второго звеньев манипулятора и захваченного груза;
Figure 00000007
- расстояние от оси вращения второго звена до его центра масс при q3=0; l2 - расстояние от центра масс второго звена до средней точки схвата.
В изобретении рассматривается электропривод, который обеспечивает вращение относительно горизонтальной оси (координата q2) звена манипулятора робота типа «Юнимент» (Фиг. 2).
Рассматриваемый электропривод работает следующим образом. На его вход подается управляющее воздействие αВХ, обеспечивающее требуемый закон его управления. При этом на выходе сумматора 8 вырабатывается сигнал ошибки ε, который после коррекции в блоках 1, 2, 25, усиливаясь, поступает на электродвигатель 4, приводя его вал во вращательное движение с направлением, скоростью и ускорением, зависящими от величины сигнала ε, моментов трения и внешнего моментного воздействия MB.
Этот электропривод при работе с различными грузами с счетом взаимовлияний степеней подвижности манипулятора имеет переменные моментными характеристики, изменяющиеся в широких пределах. Это снижает качественные показатели его работы и даже приводит к потере устойчивости. Эти характеристики зависят от изменения фазовых координат его электроприводов. Для качественного управления координатой q2 необходимо точно компенсировать отрицательное влияние изменения указанных координат на динамические свойства рассматриваемого электропривода.
Первый положительный вход сумматора 25 (со стороны сумматора 8) имеет единичный коэффициент усиления, а его второй отрицательный вход - коэффициент усиления Kω/Ky. В результате на выходе сумматора 25 формируется сигнал
Figure 00000008
Положительные входы сумматоров 10 и 12 имеют единичные коэффициенты усиления. Задатчик 18 вырабатывает сигнал
Figure 00000007
, а задатчик 13 - сигнал l2. В результате на выходе сумматора 10 формируется сигнал
Figure 00000009
на выходе сумматора 12 - сигнал
Figure 00000010
на выходе блока 15 - сигнал
Figure 00000011
, а на выходе квадратора 19 - сигнал
Figure 00000012
.
С выхода задатчика 11 на второй положительный вход сумматора 17, имеющий единичный коэффициент усиления, поступает сигнал, равный
Figure 00000013
, где J - момент инерции якоря электродвигателя 4 и вращающихся частей редуктора 6, приведенных к валу электродвигателя 4; JN2 - момент инерции второго звена манипулятора относительно поперечной оси, проходящей через его центр масс, a ip - передаточное отношение редуктора 6. Поскольку первый (со стороны блока 15) и третий (со стороны квадратора 19) положительные входы этого сумматора, соответственно, имеют единичный коэффициент усиления и коэффициент усиления, равный m2, то на его выходе формируется сигнал
Figure 00000014
, а на выходе блока 1 - сигнал
Figure 00000015
На выходе блока 20 формируется сигнал
Figure 00000016
. Второй положительный вход сумматора 21 (со стороны сумматора 10) имеет коэффициент усиления 2m2, а его первый положительный вход - коэффициент усиления 2. В результате на выходе сумматора 21 формируется сигнал
Figure 00000017
, на выходе блока 22 - сигнал
Figure 00000018
, на выходе блока 24 - сигнал
Figure 00000019
, а на выходе блока 35 - сигнал
Figure 00000020
.
Задатчик 28 вырабатывает сигнал
Figure 00000021
, где JS2 - момент инерции второго звена манипулятора относительно его продольной оси. Первый отрицательный (со стороны задатчика 28) и второй положительный входы сумматора 29 имеют единичные коэффициенты усиления. Поэтому на выходе сумматора 29 формируется сигнал
Figure 00000022
.
Усилитель 39 имеет коэффициент усиления 2. В результате на выходе блока 31 формируется сигнал
Figure 00000023
Первый положительный вход сумматора 32 (со стороны блока 31) имеет единичный коэффициент усиления, а его второй положительный вход - коэффициент усиления g/2, где g - ускорение свободного падения. В результате на выходе этого сумматора формируется сигнал
Figure 00000024
На выходе блока 43 формируется сигнал
Figure 00000025
, на выходе блока 71 - сигнал
Figure 00000026
, на выходе блока 90 - сигнал
Figure 00000027
. В сумме сигнал на выходе блоков 71 и 90 равен
Figure 00000028
.
Выходной сигнал релейного блока 26 имеет вид
Figure 00000029
где MT - величина момента сухого трения при вращении электродвигателя.
На выходе задатчика 38 формируется сигнал m2, в результате на выходе сумматора 65, имеющего положительные входы с коэффициентами усиления, равными 2, формируется сигнал 2(m3+mГ), а на выходе сумматора 46, имеющего положительные входы с единичными коэффициентами усиления - сигнал
Figure 00000030
.
Первый (со стороны блока 49) и второй положительные входы сумматора 51 имеют единичный коэффициент усиления и коэффициент усиления, равный 1/iP, соответственно. Поскольку
Figure 00000031
, то на выходе сумматора 51 формируется сигнал
Figure 00000032
, а на выходе блока 52 - сигнал
Figure 00000033
.
На выходе блока 64 формируется сигнал
Figure 00000034
, на выходе блока 56 - сигнал
Figure 00000035
, а на выходе блока 62 - сигнал
Figure 00000036
.
Первый (со стороны блока 52), второй (со стороны блока 56) и четвертый (со стороны блока 64) положительные входы сумматора 53 имеют коэффициенты усиления 2, 1 и g/2, соответственно, а его третий отрицательный вход - коэффициент усиления g/(2ip). В результате на выходе сумматора 53 формируется сигнал
Figure 00000037
Первый отрицательный (со стороны блока 79) и второй положительный входы сумматора 80 имеют единичный коэффициент усиления и коэффициент усиления, равный 1/ip, соответственно. Первый (со стороны блока 101) и второй положительные входы сумматора 92 имеют коэффициент усиления, равный 1/ip, и единичный коэффициент усиления, соответственно. На выходе блока 74 формируется сигнал
Figure 00000038
, на выходе блока 81 - сигнал
Figure 00000039
, на выходе блока 82 - сигнал
Figure 00000040
, на выходе блока 95 - сигнал
Figure 00000041
, на выходе блока 93 - сигнал
Figure 00000042
, а на выходе блока 97 - сигнал
Figure 00000043
.
Первый (со стороны блока 74) и второй (со стороны блока 81) положительные, а также третий и четвертый отрицательные входы сумматора 75 имеют коэффициенты усиления 1/2. В результате на выходе блока 76 формируется сигнал
Figure 00000044
Figure 00000045
Первый отрицательный (со стороны блока 97) и второй положительный входы сумматора 98 имеют единичные коэффициенты усиления, поэтому на выходе блока 84 формируется сигнал
Figure 00000046
Первый (со стороны блока 26), второй (со стороны датчика 5), третий (со стороны блока 24), четвертый (со стороны сумматора 32), пятый (со стороны блока 43), шестой (со стороны блока 47), седьмой (со стороны сумматора 53), положительные, а также восьмой (со стороны блока 71), девятый (со стороны блока 76), десятый (со стороны блока 84) и одиннадцатый (со стороны блока 90) отрицательные входы сумматора 27, соответственно, имеют коэффициенты усиления: единичный,
Figure 00000047
,
Figure 00000048
,
Figure 00000049
Figure 00000050
L/(ipR), 1/(2ip), L/(ipR), L/(ipR) и L/(2ipR), где KB - коэффициент вязкого трения, KM - коэффициент крутящего момента, Kω - коэффициент противо-ЭДС, R - активное сопротивление и L - индуктивность якорной обмотки электродвигателя 4. В результате на выходе сумматора 27 формируется сигнал
Figure 00000051
где
Figure 00000052
Первый (со стороны блока 1), второй (со стороны сумматора 27) и третий положительные входы сумматора 2, соответственно, имеют коэффициенты усиления
Figure 00000053
R/(KMKy), LKB/(KMKy), где Ку - коэффициент усиления усилителя 3, JH - номинальное значение момента инерции, приведенного к валу электродвигателя.
Figure 00000054
На основе уравнений Лагранжа II рода можно записать, что моментное воздействие на выходной вал электропривода, управляющего координатой q2, при движении манипулятора (фиг. 2) с грузом имеет вид:
Figure 00000055
С учетом соотношения (2), а также уравнений механической
Figure 00000056
и электрической
Figure 00000057
цепей электродвигателя 4 постоянного тока с постоянными магнитами или независимого возбуждения рассматриваемый электропривод, управляющий координатой q2, можно описать дифференциальным уравнением
Figure 00000058
где i - ток якоря, МСТР - момент сухого трения.
Из выражения (3) видно, что параметры этого уравнения, а следовательно, и параметры электропривода, управляющего координатой q2, являются существенно переменными. В результате при работе меняются (и притом существенно) его динамические свойства. Для решения поставленной задачи необходимо сформировать такое корректирующее устройство, которое стабилизирует параметры этого электропривода так, чтобы он описывался дифференциальным уравнением с постоянными желаемыми коэффициентами.
Поскольку при движении электропривода
Figure 00000059
достаточно точно соответствует МСТР, то сигнал (1), как несложно убедиться, обеспечивает превращение уравнения (3) с существенно переменными параметрами в уравнение
Figure 00000060
с постоянными параметрами, обеспечивающими рассматриваемому электроприводу заданные динамические свойства и показатели качества за счет соответствующего выбора величин JH и Ky.

Claims (1)

  1. Самонастраивающийся электропривод манипулятора, содержащий последовательно соединенные первый блок умножения и первый сумматор, последовательно подключенные усилитель и двигатель, связанные с первым датчиком скорости непосредственно и через редуктор - с первым датчиком положения, выход которого соединен с первым входом второго сумматора, подключенного вторым входом к входу манипулятора, последовательно соединенные второй датчик положения, установленный в третьей степени подвижности манипулятора, третий сумматор, четвертый сумматор, первый квадратор и второй блок умножения, второй вход которого подключен к выходу датчика массы и первому входу третьего блока умножения, а выход - к первому входу пятого сумматора, соединенного вторым входом с выходом первого задатчика постоянного сигнала, а третьим входом - с выходом второго квадратора, вход которого подключен к выходу третьего сумматора и первому входу шестого сумматора, соединенного выходом с первым входом четвертого блока умножения, а вторым входом - с выходом третьего блока умножения, второй вход которого подключен к выходу четвертого сумматора, соединенного вторым входом с выходом второго задатчика постоянного сигнала, выход третьего задатчика постоянного сигнала подключен ко второму входу третьего сумматора, а выход второго датчика скорости, установленного в третьей степени подвижности манипулятора, соединен со вторым входом четвертого блока умножения, выход которого подключен к первому входу пятого блока умножения, последовательно соединенные релейный блок и восьмой сумматор, второй вход которого подключен к выходу первого датчика скорости, к первому входу седьмого сумматора, к входу релейного блока, к второму входу пятого блока умножения, выход которого подключен к третьему входу восьмого сумматора, а выход - ко второму входу первого сумматора, выходом соединенного с входом усилителя, причем второй вход седьмого сумматора соединен с выходом второго сумматора, а выход - с первым входом первого блока умножения, подключенного вторым входом к выходу пятого сумматора, последовательно соединенные четвертый задатчик постоянного сигнала, девятый сумматор, второй вход которого соединен с выходом пятого сумматора, шестой и седьмой блоки умножения и десятый сумматор, выход которого подключен к четвертому входу восьмого сумматора, последовательно соединенные первый датчик ускорения, установленный в третьей степени подвижности манипулятора, и восьмой блок умножения, девятый блок умножения, выход которого подключен ко второму входу десятого сумматора, последовательно соединенные третий датчик скорости, установленный в первой степени подвижности манипулятора, и третий квадратор, выход которого соединен со вторым входом шестого блока умножения, пятый задатчик постоянного сигнала, последовательно соединенные второй усилитель и первый функциональный преобразователь, реализующий функцию sin, выход которого подключен ко второму входу седьмого блока умножения, а первый вход девятого блока умножения через второй функциональный преобразователь, реализующий функцию cos, подключен к выходу первого датчика положения и к входу второго усилителя, второй датчик ускорения, установленный на выходном валу двигателя, десятый блок умножения, первый вход которого подключен к выходу четвертого блока умножения, второй вход - к третьему входу первого сумматора и выходу второго датчика ускорения, а выход - к пятому входу восьмого сумматора, последовательно соединенные четвертый квадратор, одиннадцатый блок умножения, одиннадцатый сумматор и двенадцатый блок умножения, выход которого соединен с шестым входом восьмого сумматора, последовательно соединенные тринадцатый блок умножения, первый вход которого подключен к выходу третьего датчика скорости, четырнадцатый блок умножения, второй вход которого соединен с выходом третьего датчика ускорения, установленного в первой степени подвижности манипулятора, двенадцатый сумматор, пятнадцатый блок умножения, второй вход которого подключен к выходу девятого сумматора, и тринадцатый сумматор, выход которого соединен с седьмым входом восьмого сумматора, последовательно соединенные шестнадцатый, семнадцатый и восемнадцатый блоки умножения, последовательно соединенные третий функциональный преобразователь, реализующий функцию cos, вход которого подключен к выходу второго усилителя, девятнадцатый блок умножения, второй вход которого соединен с выходом третьего квадратора и вторым входом восемнадцатого блока умножения, и двадцатый блок умножения, выход которого подключен ко второму входу двенадцатого сумматора, последовательно соединенные четвертый функциональный преобразователь, реализующий функцию sin, вход которого подключен к выходу первого датчика положения, двадцать первый блок умножения, второй вход которого подключен к выходу шестого сумматора, ко вторым входам восьмого и девятого блоков умножения и к первому входу шестнадцатого блока умножения, и двадцать второй блок умножения, второй вход которого соединен со вторыми входами двенадцатого и двадцатого блоков умножения, а также с выходом первого датчика скорости, а его выход - с третьим входом тринадцатого сумматора, второй вход которого подключен к выходу восемнадцатого блока умножения, последовательно соединенные двадцать третий блок умножения, первый вход которого подключен к выходу второго функционального преобразователя, и двадцать четвертый блок умножения, второй вход которого соединен с выходом второго датчика скорости, входом четвертого квадратора и вторым входом семнадцатого блока умножения, а его выход - с четвертым входом тринадцатого сумматора, четырнадцатый сумматор, первый вход которого подключен к выходу пятого задатчика постоянного сигнала, второй - к выходу датчика массы, а выход - ко вторым входам одиннадцатого и двадцать третьего блоков умножения, причем второй вход шестнадцатого блока умножения соединен с выходом первого функционального преобразователя и вторым входом тринадцатого блока умножения, а второй вход одиннадцатого сумматора - с выходом восьмого блока умножения, последовательно соединенные третий датчик положения, установленный в первой степени подвижности манипулятора, пятый функциональный преобразователь, реализующий функцию cos, двадцать пятый блок умножения, второй вход которого через шестой функциональный преобразователь, реализующий функцию sin, подключен к выходу первого датчика положения, двадцать шестой блок умножения, второй вход которого подключен к выходу шестого сумматора, и двадцать седьмой блок умножения, выход которого подключен к восьмому входу восьмого сумматора, последовательно соединенные четвертый датчик ускорения, установленный в четвертой степени подвижности манипулятора, первый дифференциатор, двадцать восьмой блок умножения, пятнадцатый сумматор и двадцать девятый блок умножения, второй вход которого подключен к выходу шестого сумматора, а выход - к девятому входу восьмого сумматора, последовательно соединенные седьмой функциональный преобразователь, реализующий функцию sin, вход которого подключен к выходу третьего датчика положения, тридцатый блок умножения, второй вход которого подключен к выходу шестого функционального преобразователя, тридцать первый блок умножения, второй вход которого подключен к выходу третьего датчика скорости, шестнадцатый сумматор и тридцать второй блок умножения, выход которого подключен ко второму входу пятнадцатого сумматора, тридцать третий блок умножения, первый вход которого подключен к выходу четвертого датчика ускорения, а также ко вторым входам седьмого и тридцать второго блоков умножения, а второй вход - к выходу двадцать пятого блока умножения и ко второму входу двадцать восьмого блока умножения, последовательно соединенные тридцать четвертый блок умножения, первый вход которого подключен к выходу второго датчика скорости, и тридцать пятый блок умножения, второй вход которого подключен к выходу четырнадцатого сумматора, а выход - к десятому входу восьмого сумматора, последовательно соединенные тридцать шестой блок умножения, первый вход которого через восьмой функциональный преобразователь, реализующий функцию cos, подключен к выходу первого датчика положения, а второй - к выходу пятого функционального преобразователя, и тридцать седьмой блок умножения, второй вход которого подключен к выходу первого датчика скорости, а выход - ко второму входу шестнадцатого сумматора, отличающийся тем, что в него дополнительно введены последовательно соединенные тридцать восьмой, тридцать девятый и сороковой блоки умножения, второй вход последнего подключен к выходу шестого сумматора, а выход - к одиннадцатому входу восьмого сумматора, сорок первый блок умножения, первый вход которого подключен к выходу седьмого функционального преобразователя и первому входу тридцать восьмого блока умножения, а второй вход - к выходу восьмого функционального преобразователя, последовательно соединенные семнадцатый сумматор и сорок второй блок умножения, выход которого подключен к третьему входу пятнадцатого сумматора, последовательно соединенные второй дифференциатор и сорок третий блок умножения, выход которого подключен к четвертому входу пятнадцатого сумматора, последовательно соединенные пятый датчик ускорения, сорок четвертый блок умножения, второй вход которого подключен к выходу тридцать восьмого блока умножения и ко второму входу сорок третьего блока умножения, и восемнадцатый сумматор, второй вход которого подключен к выходу тридцать третьего блока умножения, а выход - ко второму входу тридцать четвертого блока умножения, причем вход второго дифференциатора и вторые входы тридцать девятого и сорок второго блоков умножения подключены к выходу пятого датчика ускорения, последовательно соединенные сорок пятый блок умножения, первый вход которого подключен к выходу третьего датчика скорости, а второй - к выходу пятого функционального преобразователя, сорок шестой блок умножения, второй вход которого подключен к выходу шестого функционального преобразователя и ко второму входу тридцать восьмого блока умножения, а выход - к первому входу семнадцатого сумматора, второй вход которого через сорок седьмой блок умножения подключен к выходу сорок первого блока умножения, а второй вход сорок седьмого блока умножения подключен к выходу первого датчика скорости.
RU2019118748A 2019-06-17 2019-06-17 Самонастраивающийся электропривод манипулятора RU2725447C1 (ru)

Priority Applications (1)

Application Number Priority Date Filing Date Title
RU2019118748A RU2725447C1 (ru) 2019-06-17 2019-06-17 Самонастраивающийся электропривод манипулятора

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
RU2019118748A RU2725447C1 (ru) 2019-06-17 2019-06-17 Самонастраивающийся электропривод манипулятора

Publications (1)

Publication Number Publication Date
RU2725447C1 true RU2725447C1 (ru) 2020-07-02

Family

ID=71510089

Family Applications (1)

Application Number Title Priority Date Filing Date
RU2019118748A RU2725447C1 (ru) 2019-06-17 2019-06-17 Самонастраивающийся электропривод манипулятора

Country Status (1)

Country Link
RU (1) RU2725447C1 (ru)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2646119A1 (fr) * 1989-04-25 1990-10-26 Shinko Electric Co Ltd Procede de commande de deplacement, dispositif de commande de deplacement, et robot mobile pour des systemes de robots mobiles
RU2489250C1 (ru) * 2012-02-22 2013-08-10 Федеральное Государственное Автономное Образовательное Учреждение Высшего Профессионального Образования "Дальневосточный Федеральный Университет" (Двфу) Электропривод робота
RU2562403C1 (ru) * 2014-12-10 2015-09-10 Федеральное государственное бюджетное учреждение науки Институт автоматики и процессов управления Дальневосточного отделения Российской академии наук (ИАПУ ДВО РАН) Самонастраивающийся электропривод манипулятора
RU2608005C1 (ru) * 2015-07-29 2017-01-11 Федеральное Государственное Автономное Образовательное Учреждение Высшего Профессионального Образования "Дальневосточный Федеральный Университет" (Двфу) Самонастраивающийся электропривод манипулятора

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2646119A1 (fr) * 1989-04-25 1990-10-26 Shinko Electric Co Ltd Procede de commande de deplacement, dispositif de commande de deplacement, et robot mobile pour des systemes de robots mobiles
RU2489250C1 (ru) * 2012-02-22 2013-08-10 Федеральное Государственное Автономное Образовательное Учреждение Высшего Профессионального Образования "Дальневосточный Федеральный Университет" (Двфу) Электропривод робота
RU2562403C1 (ru) * 2014-12-10 2015-09-10 Федеральное государственное бюджетное учреждение науки Институт автоматики и процессов управления Дальневосточного отделения Российской академии наук (ИАПУ ДВО РАН) Самонастраивающийся электропривод манипулятора
RU2608005C1 (ru) * 2015-07-29 2017-01-11 Федеральное Государственное Автономное Образовательное Учреждение Высшего Профессионального Образования "Дальневосточный Федеральный Университет" (Двфу) Самонастраивающийся электропривод манипулятора

Similar Documents

Publication Publication Date Title
RU2394674C2 (ru) Самонастраивающийся электропривод робота
RU2372186C1 (ru) Самонастраивающийся электропривод манипуляционного робота
RU2725447C1 (ru) Самонастраивающийся электропривод манипулятора
RU2593735C1 (ru) Самонастраивающийся электропривод манипуляционного робота
RU2608005C1 (ru) Самонастраивающийся электропривод манипулятора
RU2355563C2 (ru) Устройство для управления приводом робота
RU2489250C1 (ru) Электропривод робота
RU2725449C1 (ru) Самонастраивающийся электропривод манипулятора
RU2487008C1 (ru) Электропривод манипулятора
RU2312007C1 (ru) Устройство для управления приводом робота
RU2562403C1 (ru) Самонастраивающийся электропривод манипулятора
RU2325268C1 (ru) Устройство для управления приводом робота
RU2688448C1 (ru) Самонастраивающийся электропривод манипулятора
RU2423225C1 (ru) Электропривод робота
RU2577204C2 (ru) Самонастраивающийся электропривод манипулятора
RU2705734C1 (ru) Самонастраивающийся электропривод манипулятора
RU2688449C1 (ru) Самонастраивающийся электропривод манипуляционного робота
RU2606372C1 (ru) Самонастраивающийся электропривод манипулятора
RU2425746C2 (ru) Электропривод робота
RU2335389C2 (ru) Устройство для управления приводом робота
RU2705739C1 (ru) Самонастраивающийся электропривод манипулятора
RU2551044C1 (ru) Электропривод манипулятора
RU2434736C1 (ru) Электропривод робота
RU2312006C1 (ru) Устройство для управления приводом робота
RU2054350C1 (ru) Устройство для управления приводом робота