Электропривод манипулятора



Электропривод манипулятора
Электропривод манипулятора
Электропривод манипулятора
Электропривод манипулятора
Электропривод манипулятора
Электропривод манипулятора

 


Владельцы патента RU 2489251:

Федеральное государственное автономное образовательное учреждение высшего профессионального образования "Дальневосточный федеральный университет" (ДВФУ) (RU)

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

 

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

Известен электропривод манипулятора, содержащий последовательно соединенные первый сумматор, первый блок умножения, второй сумматор, усилитель, электродвигатель, связанный с первым датчиком скорости непосредственно и через редуктор - с шестерней и первым датчиком положения, выход которого подключен к первому входу первого сумматора, второй вход которого соединен с входом устройства, последовательно соединенные первый задатчик сигнала, третий сумматор и второй блок умножения, второй вход которого подключен к выходу первого датчика скорости, второму входу второго сумматора и через релейный элемент - к третьему входу второго сумматора, а выход - к четвертому входу второго сумматора, пятый вход которого через четвертый сумматор подключен к выходу первого датчика ускорения, второй вход первого блока умножения соединен с выходом третьего сумматора, последовательно соединенные второй датчик положения, пятый сумматор, первый синусный функциональный преобразователь, третий блок умножения, шестой сумматор и четвертый блок умножения, последовательно соединенные второй задатчик сигнала, седьмой сумматор и пятый блок умножения, выход которого подключен ко второму входу шестого сумматора, последовательно соединенные третий задатчик сигнала, восьмой сумматор, второй вход которого соединен с выходом датчика массы груза и вторым входом седьмого сумматора, последовательно соединенные второй косинусный функциональный преобразователь, шестой блок умножения, второй вход которого соединен с выходом восьмого сумматора, девятый сумматор и седьмой блок умножения, последовательно соединенные третий датчик положения, третий косинусный функциональный преобразователь и восьмой блок умножения, причем выход третьего датчика положения соединен также со входом четвертого синусного функционального преобразователя и вторым входом пятого сумматора, последовательно соединенные второй датчик ускорения и девятый блок умножения, последовательно соединенные третий датчик ускорения, десятый блок умножения, десятый сумматор, второй вход которого подключен к выходу девятого блока умножения, и одиннадцатый блок умножения, последовательно соединенные второй датчик скорости, двенадцатый блок умножения, одиннадцатый сумматор и тринадцатый блок умножения, последовательно соединенные первый квадратор и четырнадцатый блок умножения, последовательно соединенные пятнадцатый и шестнадцатый блоки умножения, двенадцатый сумматор и семнадцатый блок умножения, последовательно соединенные восемнадцатый и девятнадцатый блоки умножения, последовательно подключенные двадцатый и двадцать первый блоки умножения, последовательно соединенные двадцать второй блок умножения, тринадцатый сумматор и двадцать третий блок умножения, последовательно соединенные четырнадцатый сумматор и двадцать четвертый блок умножения, последовательно соединенные пятый синусный функциональный преобразователь и двадцать пятый блок умножения (см. патент РФ №2164859, БИ №10, 2001).

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

Известен также электропривод манипулятора, содержащий последовательно соединенные первый сумматор, первый блок умножения, второй сумматор, усилитель, электродвигатель, связанный с первым датчиком скорости непосредственно и через редуктор - с шестерней и первым датчиком положения, выход которого подключен к первому входу первого сумматора, второй вход которого соединен с входом устройства, последовательно соединенные первый задатчик сигнала, третий сумматор и второй блок умножения, второй вход которого подключен к выходу первого датчика скорости, второму входу второго сумматора и через релейный элемент - к третьему входу второго сумматора, а выход - к четвертому входу второго сумматора, пятый вход которого через четвертый сумматор подключен к выходу первого датчика ускорения, второй вход первого блока умножения соединен с выходом третьего сумматора, последовательно соединенные второй датчик положения, пятый сумматор, первый синусный функциональный преобразователь, третий блок умножения, шестой сумматор и четвертый блок умножения, последовательно соединенные второй задатчик сигнала, седьмой сумматор и пятый блок умножения, выход которого подключен ко второму входу шестого сумматора, последовательно соединенные третий задатчик сигнала, восьмой сумматор, второй вход которого соединен с выходом датчика массы груза и вторым входом седьмого сумматора, последовательно соединенные второй косинусный функциональный преобразователь, шестой блок умножения, второй вход которого соединен с выходом восьмого сумматора, девятый сумматор и седьмой блок умножения, последовательно соединенные третий датчик положения, третий косинусный функциональный преобразователь и восьмой блок умножения, причем выход третьего датчика положения соединен также со входом четвертого синусного функционального преобразователя и вторым входом пятого сумматора, последовательно соединенные второй датчик ускорения и девятый блок умножения, последовательно соединенные третий датчик ускорения, десятый блок умножения, десятый сумматор, второй вход которого подключен к выходу девятого блока умножения, и одиннадцатый блок умножения, последовательно соединенные второй датчик скорости, двенадцатый блок умножения, одиннадцатый сумматор и тринадцатый блок умножения, последовательно соединенные первый квадратор и четырнадцатый блок умножения, последовательно соединенные пятнадцатый и шестнадцатый блоки умножения, двенадцатый сумматор и семнадцатый блок умножения, последовательно соединенные восемнадцатый и девятнадцатый блоки умножения, последовательно подключенные двадцатый и двадцать первый блоки умножения, последовательно соединенные двадцать второй блок умножения, тринадцатый сумматор и двадцать третий блок умножения, последовательно соединенные четырнадцатый сумматор и двадцать четвертый блок умножения, последовательно соединенные пятый синусный функциональный преобразователь и двадцать пятый блок умножения, последовательно соединенные шестой косинусный функциональный преобразователь, вход которого подключен к выходу четвертого датчика положения и входу пятого функционального преобразователя, и двадцать шестой блок умножения, второй вход которого подключен к выходу шестого блока умножения и ко второму входу двадцать пятого блока умножения, а выход - ко вторым входам одиннадцатого и двадцать третьего блоков умножения, последовательно подключенные двадцать седьмой блок умножения, первый вход которого соединен с выходом шестого сумматора, двадцать восьмой блок умножения и пятнадцатый сумматор, второй, третий, четвертый и пятый входы которого подключенный соответственно к выходам девятнадцатого, двадцать первого, двадцать третьего и двадцать четвертого блоков умножения, а выход - с шестым входом второго сумматора, последовательно соединенные двадцать девятый блок умножения, первый вход которого подключен к выходу шестого функционального преобразователя, и ко вторым входам седьмого и двадцать седьмого блоков умножения, и тридцатый блок умножения, выход которого подключен к шестому входу пятнадцатого сумматора, последовательно соединенные тридцать первый блок умножения и тридцать второй блок умножения, второй вход которого подключен к выходу четвертого и второму входу тринадцатого блоков умножения, а выход - к седьмому входу пятнадцатого сумматора, последовательно подключенные тридцать третий блок умножения, первый вход которого соединен с выходом третьего блока умножения и вторым входом двадцать девятого блока умножения, а второй вход - с выходом пятого функционального преобразователя, вторым входом четвертого блока умножения и первым входом восемнадцатого блока умножения, тридцать четвертый блок умножения и шестнадцатый сумматор, выход которого соединен со вторым входом четвертого сумматора, второй и третий входы - соответственно, с выходом одиннадцатого и тринадцатого блоков умножения, четвертый вход - с выходом семнадцатого блока умножения, второй вход которого соединен с выходом двадцать пятого блока умножения, последовательно соединенные четвертый датчик ускорения и тридцать пятый блок умножения, последовательно соединенные тридцать шестой блок умножения, семнадцатый сумматор, второй вход которого подключен у выходу тридцать пятого блока умножения, тридцать седьмой блок умножения, второй вход которого подключен к выходу седьмого блока умножения и второму входу двадцать четвертого блока умножения, а выход - к пятому входу шестнадцатого сумматора, последовательно соединенные третий датчик скорости и тридцать восьмой блок умножения, выход которого подключен ко второму входу одиннадцатого сумматора, последовательно соединенные тридцать девятый блок умножения и восемнадцатый сумматор, последовательно соединенные четвертый датчик скорости и сороковой блок умножения, выход которого через второй вход восемнадцатого сумматора подключен ко второму входу тридцать четвертого блока умножения, последовательно соединенные второй квадратор и сорок первый блок умножения, выход которого подключен к второму входу двенадцатого сумматора, последовательно соединенные третий квадратор, сорок второй блок умножения, девятнадцатый сумматор и сорок третий блок умножения, второй вход которого подключен к выходу двадцать девятого блока умножения, а выход - к шестому входу шестнадцатого сумматора, причем второй, третий и четвертый входы девятнадцатого сумматора подключены соответственно к выходам четырнадцатого, сорок четвертого и сорок пятого блоков умножения, а пятый вход - к выходу первого дифференциатора, третий вход десятого сумматора подключен к выходу сорок шестого блока умножения, последовательно соединенные сорок седьмой блок умножения, двадцатый сумматор и сорок восьмой блок умножения, второй вход которого подключен к выходу восемнадцатого блока умножения, а выход - к седьмому входу шестнадцатого сумматора, причем второй вход двадцатого сумматора через второй дифференциатор подключен к выходу четвертого датчика ускорения, а его третий вход - к выходу сорок девятого блока умножения, последовательно соединенные пятидесятый блок умножения, двадцать первый сумматор и пятьдесят первый блок умножения, второй вход которого подключен к выходу двадцать седьмого блока умножения, а выход - к восьмому входу шестнадцатого сумматора, причем второй вход двадцать первого сумматора через третий дифференциатор соединен с выходом третьего датчика ускорения, первым входом тридцать шестого и вторыми входами двенадцатого и двадцать восьмого блоков умножения, а его третий вход через пятьдесят второй блок умножения - с выходом третьего квадратора и первыми входами четырнадцатого сумматора и сорок седьмого блока умножения, второй вход третьего сумматора соединен с выходом датчика массы груза, второй вход третьего блока умножения подключен к выходу восьмого сумматора, второй вход пятого блока умножения соединен с выходом четвертого функционального преобразователя, вход второго функционального преобразователя соединен с выходом пятого сумматора, вход первого квадратора соединен с выходом третьего датчика скорости, первыми входами пятнадцатого, двадцать второго и сорок четвертого, а также со вторыми входами девятого, тридцать первого, тридцать шестого, пятидесятого и пятьдесят второго блоков умножения, а его выход - с первым входом пятидесятого и вторым входом сорок девятого блоков умножения, а так же со вторым входом четырнадцатого сумматора, второй вход восемнадцатого блока умножения соединен с выходом девятого сумматора, второй вход которого подключен к выходу восьмого блока умножения, второй вход которого соединен с выходом седьмого сумматор, второй вход девятнадцатого блока умножения подключен к выходу четвертого датчика ускорения и вторым входам тридцать восьмого и сорокового блоков умножения, первый вход двадцатого блока умножения соединен с выходом тридцать третьего блока умножения, а его второй вход - с выходом второго датчика скорости, входом третьего квадратора, первыми входами тридцать первого, тридцать девятого и сорок девятого, а также со вторыми входами шестнадцатого, тридцать пятого, сорок первого и сорок седьмого блоков умножения, вход второго квадратора соединен с выходом четвертого датчика скорости, первыми входами сорок пятого и сорок шестого, а также вторыми входами десятого, четырнадцатого, пятнадцатого, двадцать первого, двадцать второго и сорок второго блоков умножения, а выход - со вторыми входами тринадцатого сумматора, а также сорок четвертого и сорок пятого блоков умножения, выход второго датчика ускорения соединен с входом первого дифференциатора и вторыми входами тридцатого, тридцать девятого и сорок шестого блоков умножения (см. патент РФ №2355563, БИ №14, 2009).

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

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

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

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

Сопоставительный анализ заявляемого технического решения с его аналогами и прототипом свидетельствует о его соответствии критерию "новизна".

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

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

Электропривод манипулятора содержит первый сумматор 1, первый блок 2 умножения, второй сумматор 3, усилитель 4, электродвигатель 5, первый датчик 6 скорости, редуктор 7, шестерню 8, первый датчик 9 положения, первый задатчик 10 сигнала, третий сумматор 11, второй блок 12 умножения, релейный элемент 13, четвертый сумматор 14, первый датчик 15 ускорения, второй датчик 16 положения, пятый сумматор 17, первый синусный функциональный преобразователь 18, третий блок 19 умножения, шестой сумматор 20, четвертый блок 21 умножения, второй задатчик 22 сигнала, седьмой сумматор 23, пятый блок 24 умножения, третий задатчик 25 сигнала, восьмой сумматор 26, датчик 27 массы груза, второй косинусный функциональный преобразователь 28, шестой блок 29 умножения, девятый сумматор 30, седьмой блок 31 умножения, третий датчик 32 положения, третий косинусный функциональный преобразователь 33, восьмой блок 34 умножения, четвертый синусный функциональный преобразователь 35, второй датчик 36 ускорения, девятый блок 37 умножения, третий датчик 38 ускорения, десятый блок 39 умножения, десятый сумматор 40, одиннадцатый блок 41 умножения, второй датчик 42 скорости, двенадцатый блок 43 умножения, одиннадцатый сумматор 44, тринадцатый блок 45 умножения, первый квадратор 46, четырнадцатый блок 47 умножения, пятнадцатый 48 и шестнадцатый блоки 49 умножения, двенадцатый сумматор 50, семнадцатый блок 51 умножения, восемнадцатый 52, девятнадцатый 53, двадцатый 54, двадцать первый 55 и двадцать второй блоки 56 умножения, тринадцатый сумматор 57, двадцать третий блок 58 умножения, четырнадцатый сумматор 59, двадцать четвертый блок 60 умножения, пятый синусный функциональный преобразователь 61, двадцать пятый блок 62 умножения, шестой косинусный функциональный преобразователь 63, четвертый датчик 64 положения, двадцать шестой 65, двадцать седьмой 66 и двадцать восьмой 67 блоки умножения, пятнадцатый сумматор 68, двадцать девятый 69, тридцатый 70, тридцать первый 71, тридцать второй 72, тридцать третий 73 и тридцать четвертый 74 блоки умножения, шестнадцатый сумматор 75, четвертый датчик 76 ускорения, тридцать пятый 77 и тридцать шестой 78 блоки умножения, семнадцатый сумматор 79, тридцать седьмой блок 80 умножения, третий датчик 81 скорости, тридцать восьмой 82 и тридцать девятый блоки 83 умножения, восемнадцатый сумматор 84, четвертый датчик 85 скорости, сороковой блок 86 умножения, второй квадратор 87, сорок первый блок 88 умножения, третий квадратор 89, сорок второй блок 90 умножения, девятнадцатый сумматор 91, сорок третий 92, сорок четвертый 93 и сорок пятый 94 блоки умножения, первый дифференциатор 95, сорок шестой 96 и сорок седьмой блоки 97 умножения, двадцатый сумматор 98, сорок восьмой блок 99 умножения, второй дифференциатор 100, сорок девятый 101 и пятидесятый блоки 102 умножения, двадцать первый сумматор 103, пятьдесят первый блок 104 умножения, третий дифференциатор 105 и пятьдесят второй блок 106 умножения.

На указанных чертежах введены следующие обозначения: αBX - сигнал с выхода программного устройства; ε - сигнал ошибки; U*, U - усиливаемый сигнал и сигнал управления двигателем соответственно; q1, q2, q3, q4, q5 - обобщенные координаты пяти степеней подвижности; m1, m2, m3, mГ - массы соответствующих звеньев манипулятора и груза; l2, l3 - длины соответствующих звеньев; l 2 * , l 3 * - расстояния от осей вращения соответствующих звеньев до их центров масс; q ˙ 1 , q ˙ 2 , q ˙ 3 - скорости изменения соответствующих обобщенных координат; α ˙ 5 - скорость вращения ротора двигателя пятой степени подвижности; q ¨ 1 , q ¨ 2 , q ¨ 3 - ускорения изменения соответствующих обобщенных координат; α ¨ 5 - ускорение вращения ротора двигателя пятой степени подвижности; Jsi - моменты инерции соответствующих звеньев манипулятора относительно их продольных осей ( i = 1,3 ¯ ) ; Jni - моменты инерции соответствующих звеньев манипулятора относительно поперечных осей, проходящих через их центры масс ( i = 1,3 ¯ ) .

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

Рассматриваемый электропривод управляет обобщенной координатой q5. Данная степень подвижности, перпендикулярная координате q4, позволяет осуществить горизонтальное прямолинейное перемещение манипулятора, схема которого представлена на фиг.2.

Манипулятор в горизонтальной плоскости перемещается с помощью передачи шестерня-рейка (координата q5). Причем рейка установлена на основании, по которому перемещается манипулятор, а шестерня 8 - на выходном валу редуктора 7 и имеет радиус r.

Датчики 64, 32 и 16 установлены соответственно в первой, второй и третьей степенях подвижности манипулятора (см. фиг.2.) и измеряют соответственно обобщенные координаты q1, q2 и q3. Сумматор 17 имеет положительные входы с единичными коэффициентами усиления, поэтому на его выходе формируется сигнал q2+q3. На выходе задатчика 25 формируется сигнал m 3 l 3 * , а на выходе датчика 27 - mГ. Первый (со стороны задатчика 25) положительный вход сумматора 26 имеет единичный коэффициент усиления, а его второй положительный вход - коэффициент усиления, равный l3. В результате на выходе сумматора 26 формируется сигнал A = m 3 l 3 * + m Г l 3 . На выходе задатчика 22 сигнала формируется сигнал m 2 l 2 * + m 3 l 2 . Первый (со стороны задатчика 22) и второй положительные входы сумматора 23 соответственно имеют единичный коэффициент усиления и коэффициент усиления, равный l2. В результате на выходе сумматора 23 формируется сигнал B = m 2 l 2 * + m 3 l 2 + m Г l 2 . Таким образом, на выходе блоков 29, 19, 34 и 24 умножения соответственно формируются сигналы Acos(q2+q3), Asin(q2+q3), Bcosq2 и Bsinq2.

Положительные входы сумматоров 20 и 30 имеют единичные коэффициенты усиления. Поэтому на выходах блоков 52, 31, 21 и 66 умножения соответственно формируются сигналы:

а=cosq1(Acos(q2+q3)+Bcosq2), b=sinq1(Acos(q2+q3)+Bcosq2),

c=cosq1(Asin(q2+q3)+Bsinq2) и d=sinq1(Asin(q2+q3)+Bsinq2).

На выходах блоков 62, 65, 73 и 69 умножения соответственно формируются сигналы: е=Acosq1cos(q2+q3), k=Asinq1cos(q2+q3), f=Acosq1sin(q2+q3) и m=Asinq1sin(q2+q3).

Датчики 42, 81 и 85 скорости устанавливаются соответственно в первой, второй и третьей степенях подвижности манипулятора (см. фиг.2.) и измеряют соответственно q ˙ 1 , q ˙ 2 , q ˙ 3 . Положительные входы сумматора 59 имеют единичные коэффициенты усиления. Поэтому на выходе блока 60 умножения формируется сигнал b = ( q ˙ 1 2 + q ˙ 2 2 ) , а на выходах блоков 71 и 54 умножения - сигналы q ˙ 1 q ˙ 2 и f q ˙ 1 соответственно. В результате на выходах блоков 72 и 55 умножения соответственно формируются сигналы c q ˙ 1 q ˙ 2 и f q ˙ 1 q ˙ 3 .

На выходе блока 56 умножения формируется сигнал q ˙ 2 q ˙ 3 . Поэтому, поскольку первый (со стороны блока 56) положительный вход сумматора 57 имеет коэффициент усиления, равный 2, а его второй положительный вход - единичный коэффициент усиления, то на выходе блока 58 умножения формируется сигнал k = ( 2 q ˙ 2 q ˙ 3 + q ˙ 3 2 ) .

На выходах датчиков 76, 38, 36 и 15 ускорения, установленных соответственно в первой, второй, третьей и четвертой степенях подвижности манипулятора соответственно формируются сигналы q ¨ 1 , q ¨ 2 , q ¨ 3 и α ¨ 5 , а на выходах блоков 53, 67 и 70 умножения - сигналы a q ¨ 1 , d q ¨ 2 и m q ¨ 3 соответственно.

Первый (со стороны блока 67), четвертый (со стороны блока 58), пятый (со стороны блока 60) и шестой (со стороны блока 70) отрицательные входы сумматора 68 и второй (со стороны блока 53) положительный вход сумматора 68 имеют единичные коэффициенты усиления, а седьмой (со стороны блока 72) и третий (со стороны блока 55) имеют коэффициент усиления, равный 2. В результате на выходе сумматора 68 формируется сигнал

C = a q ¨ 1 d q ¨ 2 m q ¨ 3 b ( q ˙ 1 2 + q ˙ 2 2 ) 2 f q ˙ 1 q ˙ 3 2 c q ˙ 1 q ˙ 2 k ( 2 q ˙ 2 q ˙ 3 + q ˙ 3 2 ) .

На выходе задатчика 10 формируется сигнал J i p 2 + ( m 1 + m 2 + m 3 ) r 2 , где J - момент инерции ротора электродвигателя и вращающихся частей редуктора (приведены к валу двигателя), i - передаточное отношение редуктора. Первый (со стороны задатчика 10) и второй положительные входы сумматора 11 имеют соответственно единичный коэффициенты усиления и коэффициент усиления, равный r2. В результате на выходе этого сумматора формируется сигнал J i p 2 + ( m 1 + m 2 + m 3 ) r 2 = J i p 2 + H .

На выходе блоков 77 и 78 умножения соответственно формируются сигналы q ¨ 1 q ˙ 1 и q ¨ 2 q ˙ 2 . Поскольку оба положительных входа сумматора 79 имеют единичные коэффициенты усиления, то на выходе блока 80 умножения формируется сигнал b ( q ¨ 1 q ˙ 1 + q ¨ 2 q ˙ 2 ) .

На выходе блоков 43 и 82 умножения соответственно формируются сигналы q ¨ 2 q ˙ 1 и q ¨ 1 q ˙ 2 . Поскольку положительные входы сумматора 44 имеют единичные коэффициенты усиления, то на выходе блока 45 умножения образуется сигнал c ( q ¨ 1 q ˙ 1 + q ¨ 2 q ˙ 1 ) . На выходах блоков 48, 49 и 88 умножения соответственно формируются сигналы q ˙ 2 q ˙ 3 , q ˙ 1 q ˙ 2 q ˙ 3 и q ˙ 1 q ˙ 3 2 . Первый (со стороны блока 49) положительный вход сумматора 50 имеет коэффициент усиления, равный 2, а его второй положительный вход - единичный коэффициент усиления. В результате на выходе блока 51 умножения формируется сигнал e ( q ˙ 1 q ˙ 3 2 + 2 q ˙ 1 q ˙ 2 q ˙ 3 ) . На выходе блоков 86 и 83 умножения соответственно формируются сигналы q ¨ 1 q ˙ 3 и q ¨ 3 q ˙ 1 . Поскольку оба положительных входа сумматора 84 имеют единичные коэффициенты усиления, то на выходе блока 74 умножения формируется сигнал f ( q ¨ 1 q ˙ 3 + q ¨ 3 q ˙ 1 ) .

На выходе дифференциатора 100 формируется сигнал q ¨ 1 , а на выходах блоков 97 и 101 умножения - сигналы q ˙ 1 3 и q ˙ 2 2 q ˙ 1 соответственно. Первый отрицательный (со стороны блока 97) и второй (со стороны дифференциатора 100) положительный входы сумматора 98 соответственно имеют единичные коэффициенты усиления, а его третий отрицательный вход - коэффициент усиления, равный 3. В результате на выходе блока 99 умножения формируется сигнал a ( q 1 q ˙ 1 3 3 q ˙ 2 2 q ˙ 1 ) . На выходе блоков 102, 106 умножения соответственно формируются сигналы q ˙ 2 3 и q ˙ 1 2 q ˙ 2 . На выходе дифференциатора 105 формируется сигнал q 2 . Первый (со стороны блока 102) положительный и второй (со стороны дифференциатора 105) отрицательный входы сумматора 103 имеют единичные коэффициенты усиления, а его третий положительный вход - коэффициент усиления, равный 3. В результате на выходе блока 104 умножения формируется сигнал d ( q ˙ 2 3 q 2 + 3 q ˙ 1 2 q ˙ 2 ) .

На выходе блоков 39, 37 и 96 умножения соответственно формируются сигналы q ¨ 2 q ˙ 3 , q ¨ 3 q ˙ 2 и q ¨ 3 q ˙ 3 . Три положительных входа сумматора 40 имеют единичные коэффициенты усиления. Поэтому на выходе блока 41 умножения формируется сигнал k ( q ¨ 2 q ˙ 3 + q ¨ 3 q ˙ 2 + q ¨ 3 q ˙ 3 ) .

На выходе дифференциатора 95 формируется сигнал q 3 . На выходах блоков 90, 47, 93 и 94 умножения соответственно формируются сигналы q ˙ 1 2 q ˙ 3 , q ˙ 2 2 q ˙ 3 , q ˙ 3 2 q ˙ 2 и q ˙ 3 3 . Первый (со стороны блока 90), второй (со стороны блока 47) и третий (со стороны блока 93) положительные входы сумматора 91 имеют коэффициенты усиления, равные 3, его четвертый положительный (со стороны блока 94) и пятый отрицательный входы имеют единичные коэффициенты усиления. В результате на выходе блока 92 умножения формируется сигнал m ( 3 q ˙ 1 2 q ˙ 3 + 3 q ˙ 2 2 q ˙ 3 + 3 q ˙ 3 2 q ˙ 2 + q ˙ 3 3 q 3 ) .

Первый (со стороны блока 74), второй (со стороны блока 41), третий (со стороны блока 45), четвертый (со стороны блока 51) и пятый (со стороны блока 80) отрицательные входы сумматора 75 имеют коэффициенты усиления, равные 3, а остальные положительные входы - коэффициенты усиления, равные единице. В результате на выходе сумматора 75 формируется сигнал

D = a ( q 1 q ˙ 1 3 3 q ˙ 2 2 q ˙ 1 ) 3 b ( q ¨ 1 q ˙ 1 + q ¨ 2 q ˙ 2 ) 3 c ( q ¨ 1 q ˙ 2 + q ¨ 2 q ˙ 1 ) + 3 f ( q ¨ 1 q ˙ 3 + q ¨ 3 q ˙ 1 ) + d ( q ˙ 2 3 q 2 + 3 q ˙ 1 2 q ˙ 2 ) 3 k ( q ¨ 2 q ˙ 3 + q ¨ 3 q ˙ 2 + q ¨ 3 q ˙ 3 ) + m ( 3 q ˙ 1 2 q ˙ 3 + 3 q ˙ 2 2 q ˙ 3 + 3 q ˙ 3 2 q ˙ 2 + q ˙ 3 3 q 3 ) 3 e ( q ˙ 1 q ˙ 3 2 + 2 q ˙ 1 q ˙ 2 q ˙ 3 ) . .

Первый положительный вход сумматора 14 (со стороны датчика 15) имеет коэффициент усиления КВ, а его второй положительный вход - коэффициент усиления r / i p . В результате на выходе сумматора 14 формируется сигнал: K B α ¨ 5 + D r / i p .

На первый положительный вход сумматора 3 (со стороны блока 2) с коэффициентом усиления 1 / J H i p 2 поступает сигнал ( H + J i p 2 ) ε (где JH - суммарный номинальный момент инерции), на его второй положительный вход с коэффициентом усиления K ω / K у + K B R / ( K у K м ) поступает сигнал α ˙ 5 , на третий положительный вход (со стороны релейного элемента 13) с коэффициентом усиления R / ( K м K у ) - сигнал:

U 13 = { M T α ˙ 5 > 0 M T п р и α ˙ 5 < 0 0 α ˙ 5 = 0 ,

на четвертый отрицательный вход (со стороны блока 12) с коэффициентом усиления K ω / ( K у J H i p 2 ) - сигнала ( H + J i p 2 ) α ˙ 5 , на пятый положительный вход (со стороны сумматора 14) с коэффициентом усиления L / ( K м K у ) - сигнал K B α ¨ 5 + D r / i p , а на шестой положительный вход (со стороны сумматора 68) с коэффициентом усиления R r / ( K м K у i p ) сигнал С, где R - активное сопротивление якорной обмотки электродвигателя, КВ - коэффициент вязкого трения, Ку - коэффициент усиления усилителя 4, Км - коэффициент крутящего момента, Кω - коэффициент противоЭДС, МТ=const>0 - величина момента сухого трения при движении электродвигателя, L -индуктивность якорной обмотки электродвигателя.

В результате на выходе сумматора 3 формируется сигнал

U * = H / i p 2 + J J H ( ε K ω K у α ˙ 5 ) + R K м K у M T s i g n α ˙ 5 + ( K ω K у + K B R K м K у ) α ˙ 5 + + r R K м K у i p C + L K м K у ( K B α ¨ 5 + D r / i p ) . ( 1 )

Кинетическая энергия всех движущихся масс манипулятора имеет вид:

T = 1 2 q ˙ 1 2 ( J s 1 + m 2 l 2 * 2 cos 2 q 2 + J S 2 sin 2 q 2 + J n 2 cos 2 q 2 + m 3 l 2 2 cos 2 q 2 + + m 3 l 3 * 2 cos 2 ( q 2 + q 3 ) + J s 3 sin 2 ( q 2 + q 3 ) + J n 3 cos 2 ( q 2 + q 3 ) + m Г l 2 2 cos 2 q 2 + + m Г l 3 2 cos 2 ( q 2 + q 3 ) + 2 ( l 2 l 3 * m 3 + l 2 l 3 m Г ) cos q 2 cos ( q 2 + q 3 ) ) + + 1 2 q ˙ 2 2 ( m 2 l 2 * 2 + J n 2 + m 3 l 2 2 + m 3 l 3 * 2 + 2 m 3 l 2 l 3 * cos q 3 + J n 3 + + m Г l 2 2 + m Г l 3 2 + 2 m Г l 2 l 3 cos q 3 ) + 1 2 q ˙ 3 2 ( m 3 l 3 * 2 + m Г l 3 2 + J n 3 ) + + 1 2 q ˙ 4 2 ( m 1 + m 2 + m 3 + m Г ) + q ˙ 2 q ˙ 3 ( m 3 l 3 * 2 + m 3 l 2 l 3 * cos q 3 + J n 3 + + m Г l 3 2 + m Г l 2 l 3 cos q 3 ) q ˙ 1 q ˙ 4 ( m 2 l 2 * sin q 1 cos q 2 + m 3 l 3 * sin q 1 cos ( q 2 + q 3 ) + + m 3 l 2 sin q 1 cos q 2 + m Г l 3 sin q 1 cos ( q 2 + q 3 ) + m Г l 2 sin q 1 cos q 2 ) q ˙ 2 q ˙ 4 ( m 2 l 2 * cos q 1 sin q 2 + m 3 l 3 * cos q 1 sin ( q 2 + q 3 ) + m 3 l 2 cos q 1 sin q 2 + + m Г l 3 cos q 1 sin ( q 2 + q 3 ) + m Г l 2 cos q 1 sin q 2 ) q ˙ 3 q ˙ 4 ( m 3 l 3 * cos q 1 sin ( q 2 + q 3 ) + m Г l 3 cos q 1 sin ( q 2 + q 3 ) + + q ˙ 1 q ˙ 5 ( m 2 l 2 * cos q 1 cos q 2 + m 3 l 3 * cos q 1 cos ( q 2 + q 3 ) + m 3 l 2 cos q 1 cos q 2 + + m Г l 3 cos q 1 cos ( q 2 + q 3 ) + m Г l 2 cos q 1 cos 2 ) q ˙ 2 q ˙ 5 ( m 2 l 2 * sin q 1 sin q 2 + + m 3 l 3 * sin q 1 sin ( q 2 + q 3 ) + m 3 l 2 sin q 1 sin q 2 + m Г l 3 sin q 1 sin ( q 2 + q 3 ) + + m Г l 2 sin q 1 sin q 2 ) q ˙ 3 q ˙ 5 ( m 3 l 3 * sin q 1 sin ( q 2 + q 3 ) + m Г l 3 sin q 1 sin ( q 2 + q 3 ) ) ,

а его потенциальная энергия вид:

П = g [ m 2 l 2 * sin q 2 + m 3 ( l 2 sin q 2 + l 3 * sin ( q 2 + q 3 ) ) + m Г ( l 2 sin q 2 + l 3 sin ( q 2 + q 3 ) ) ] ,

где g - ускорение свободного падения. Учитывая, что

δ ( Т П ) δ q 5 = 0

δ ( Т П ) δ q ¨ 5 = ( m 1 + m 2 + m 3 + m Г ) q ˙ 5 + { cos q 2 [ m 2 l 2 * + m 3 l 2 + m Г l 2 ] + + cos ( q 2 + q 3 ) [ m 3 l 3 * + m Г l 3 ] } q ˙ 1 cos q 1 { sin q 2 [ m 2 l 2 * + m 3 l 2 + m Г l 2 ] + + sin ( q 2 + q 3 ) [ m 3 l 3 * + m Г l 3 ] } q ˙ 2 sin q 1 { m 3 l 3 * + m Г l 3 } q ˙ 3 sin ( q 2 + q 3 ) sin q 1 ,

из уравнения Лагранжа 2 рода можно получить силу F, действующую на линейную горизонтальную степень подвижности манипулятора в процессе его движения:

d d t [ δ ( Т П ) δ q ˙ 5 ] = F = ( m 1 + m 2 + m 3 + m Г ) q ¨ 5 + C ,

которая создает на выходном валу редуктора 7 момент, равный

M = F r . ( 2 )

С учетом соотношения (2), а также уравнения механической i K м = ( J + H / i p 2 ) α ¨ 5 + K B α ˙ 5 + M T s i g n α ˙ 5 + C r / i p и электрической U = d i d t L + i R + K ω α ˙ 5 цепей электродвигателей постоянного тока с постоянными магнитами или независимого возбуждения несложно показать, что рассматриваемый электропривод, управляющий координатой q5 манипулятора, можно описать дифференциальным уравнением (здесь D = C ˙ ):

K м K у U * = L ( J + H / i p 2 ) α 5 + ( L K B + R ( J + H / i p 2 ) ) α ¨ 5 + ( R K B + K м K ω ) α ˙ 5 + R ( M T s i g n α ˙ 5 + C r / i p ) + L D r / i p . ( 3 )

Сформированный сигнал U* (1), как несложно убедиться, обеспечивает превращение уравнения (3) с существенно переменными параметрами в уравнение K м K у ε = L J H α 5 + R J H α ¨ 5 + K м K ω α ˙ 5 с постоянными желаемыми параметрами, обеспечивающими электроприводу, управляющему координатой q5, заданные динамические свойства и качественные показатели работы за счет выбора желаемых постоянных значений JH и Ку.

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

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



 

Похожие патенты:

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

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

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

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

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

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

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

Изобретение относится к вычислительной технике. .

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

Изобретение относится к области оказывающих минимальное инвазивное вмешательство медицинских процедур, включая хирургическое вмешательство и диагностические процедуры. Более точно, изобретение затрагивает способ и систему для оценки усилия и позволяет определять прилагаемые к пациенту усилия, прежде всего, кончиком инструмента минимального инвазивного вмешательства, но также на уровне отверстия доступа для инструмента в тело пациента. 2 н. и 12 з.п. ф-лы, 8 ил., 1 табл.

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

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

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

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

Изобретение относится к области автоматического управления динамическими объектами. Для стабилизации подводного аппарата в режиме зависания включают подачу сигналов управления на входы его движителей и компенсируют силовые и моментные воздействия на аппарат, которые вызывают его отклонение от исходного положения. Сигналы определяют линейное и угловое смещение аппарата от его исходного положения на два движителя каждой из трех пар движителей подводного аппарата. Одновременно подают сигналы управления, которые пропорциональны линейному смещению подводного аппарата параллельно продольным осям движителей конкретной пары и угловому смещению подводного аппарата относительно оси, которая перпендикулярна плоскости. Плоскость образует продольные оси этой пары движителей. Достигается высокая точность стабилизации подводного аппарата в режиме зависания в заданной точке пространства с помощью управляющих систем. 1 з.п. ф-лы, 2 ил.

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

Изобретение относится к способу и устройству для выбора и захвата объекта из неструктурированной области робота, а также к машиночитаемому носителю, на котором хранится компьютерная программа, содержащая код для управления процессором для выполнения способа. Устройство принимает первые данные от первого датчика и определяет целевое положение, включающее положение в пространстве или ориентацию захватного устройства в роботизированной руке. Для перемещения захватного устройства в целевое положение подают первые команды роботизированной руке или захватному устройству. Данные силовой обратной связи принимают от первых датчиков или от датчиков силовой обратной связи, связанных или с роботизированной рукой или с захватным устройством. Определяют неудачу при выполнении первых команд. Принимают вторые данные датчика от первого датчика. По вторым данным датчика определяют успешный захват объекта. В ответ на определение успешного захвата принимают данные верификации от второго датчика и подают вторые команды роботизированной руке для перемещения руки в заранее заданное положение с отпусканием захвата захватного устройства. Изобретение обеспечивает повышение качества выбора объектов в рабочем пространстве робота. 3 н. и 11 з.п. ф-лы, 3 ил.

Группа изобретений относится к области животноводства. Технический результат - повышение безопасности процесса доения. Система доения содержит доильный робот (10). Робот содержит первое звено (L1), второе звено (L2), третье звено (L3), рабочий орган (Е), датчик (16) и блок управления (15). Первое звено может поворачиваться до первого угла в пределах первого углового сектора (α1) через первое соединение (11). Второе звено может поворачиваться до второго угла в пределах второго углового сектора (α2) через второе соединение (12). Третье звено может поворачиваться до третьего угла в пределах третьего углового сектора (α3) через третье соединение (13). Звенья (L1, L2, L3) могут поворачиваться так, что рабочий орган (Е) может двигаться внутри трехмерного рабочего пространства (W) доильного робота (10). Каждое положение рабочего органа (Е) в пределах рабочего пространства (W) соответствует отдельному сочетанию первого, второго и третьего углов. 2 н. и 14 з.п. ф-лы, 10 ил.
Наверх