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

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

Иллюстрации

Показать все

Реферат

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

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

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

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

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

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

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

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

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

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

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

Самонастраивающийся электропривод манипулятора содержит последовательно соединенные первый сумматор 1, первый блок 2 умножения, второй сумматор 3, первый усилитель 4 и электродвигатель 5, связанный с первым датчиком 6 скорости непосредственно и через редуктор 7 - с шестерней 8, приводящей в движение рейку, закрепленную неподвижно на втором телескопическом звене манипулятора, и первый датчик 9 положения, измеряющий положение этого второго звена относительно его горизонтальной оси вращения, последовательно соединенные релейный блок 10 и третий сумматор 11, второй вход которого подключен к выходу первого датчика 6 скорости, входу релейного блока 10 и второму входу первого сумматора 1, а выход - ко второму входу второго сумматора 3, третий вход которого соединен с выходом первого сумматора 1, последовательно соединенные первый задатчик 12 сигнала, четвертый сумматор 13, второй вход которого соединен с выходом первого датчика 9 положения и с первым входом пятого сумматора 14, подключенного вторым входом к входу устройства, а выходом - к первому входу первого сумматора 1, шестой сумматор 15, ко второму входу которого подключен второй задатчик 16 сигнала, второй блок 17 умножения, седьмой сумматор 18, второй вход которого подключен к выходу четвертого сумматора 13, и третий блок 19 умножения, второй вход которого через первый квадратор 20 подключен к выходу второго датчика 21 скорости, а выход - к третьему входу третьего сумматора 11, а также датчик 22 массы, выход которого подключен ко вторым входам первого 2 и второго 17 блоков умножения, последовательно соединенные третий датчик 23 скорости, четвертый блок 24 умножения, второй квадратор 25 и пятый блок 26 умножения, второй вход которого подключен к выходу седьмого сумматора 18, а выход - к четвертому входу третьего сумматора 11, последовательно соединенные второй датчик 27 положения, первый синусный функциональный преобразователь 28, шестой блок 29 умножения, второй вход которого подключен к выходу датчика 22 массы, и восьмой сумматор 30, второй вход которого подключен к выходу первого синусного функционального преобразователя 28, а выход - к пятому входу третьего сумматора 11, второй вход четвертого блока 24 умножения через второй косинусный функциональный преобразователь 31 подключен к выходу второго датчика 27 положения, первый датчик 32 ускорения, выход которого подключен к шестому входу третьего сумматора 11, последовательно соединенные девятый сумматор 33, первый и второй входы которого подключены, соответственно, к выходам первого 20 и второго 25 квадраторов, седьмой блок 34 умножения и десятый сумматор 35, второй и третий входы которого, соответственно, через восьмой 36 и девятый 37 блоки умножения подключены к выходам второго датчика 21 скорости и седьмого сумматора 18, а выход - к седьмому входу третьего сумматора 11, последовательно соединенные второй усилитель 38, вход которого подключен к выходу второго датчика 27 положения, третий синусный функциональный преобразователь 39, десятый блок 40 умножения, второй вход которого через третий квадратор 41 подключен к выходу третьего датчика 23 скорости, одиннадцатый сумматор 42, второй вход которого подключен к выходу второго датчика 43 ускорения, одиннадцатый блок 44 умножения, второй вход которого подключен к выходу второго датчика 21 скорости, и двенадцатый сумматор 45, второй вход которого через двенадцатый блок 46 умножения подключен к выходу третьего датчика 47 ускорения, а его выход - ко второму входу девятого блока 37 умножения, последовательно соединенные третий задатчик 48 сигнала, тринадцатый сумматор 49, второй вход которого подключен к выходу датчика 22 массы, и тринадцатый блок 50 умножения, второй вход которого подключен к выходу второго косинусного функционального преобразователя 31, а выход - ко второму входу восьмого блока 36 умножения, причем второй вход двенадцатого блока 46 умножения через четырнадцатый блок 51 умножения соединен с выходом четвертого блока 24 умножения, а второй вход четырнадцатого блока 51 умножения подключен к выходу второго косинусного функционального преобразователя 31, второй вход седьмого блока 34 умножения через пятнадцатый блок 52 умножения соединен с выходом тринадцатого сумматора 49, а второй вход пятнадцатого блока 52 умножения подключен к выходу первого датчика 6 скорости, последовательно соединенные четвертый датчик 53 ускорения и шестнадцатый блок 54 умножения, выход которого подключен к восьмому входу третьего сумматора 11, а второй вход - к выходу восьмого сумматора 30 и первому входу семнадцатого блока 55 умножения, второй вход которого через дифференциатор 56 подключен к выходу четвертого датчика 53 ускорения и первому входу восемнадцатого блока 57 умножения, второй вход которого подключен к выходу восьмого 36 блока умножения, а выход - к четвертому входу десятого сумматора 35, пятый вход которого соединен с выходом семнадцатого блока 55 умножения.

На рисунках приведены следующие обозначения: q_вх - сигнал с выхода программного устройства; ε - сигнал ошибки электропривода; U*, U - соответственно усиливаемый сигнал и сигнал управления двигателем; q_i - обобщенные координаты соответствующих степеней подвижности манипулятора ; m_i, m_г - массы соответствующих звеньев манипулятора и груза ; - расстояние от оси вращения второго звена до его центра масс при q₃=0; l₂ - расстояние от центра масс второго звена до средней точки схвата; - скорости изменения соответствующих обобщенных координат манипулятора; - скорость вращения ротора электродвигателя третьей степени подвижности манипулятора; - ускорения в соответствующих степенях подвижности манипулятора.

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

На вход подается воздействие q_вх, обеспечивающее требуемый закон управления третьей обобщенной координатой q₃ манипулятора (фиг. 2). На выходе сумматора 14 вырабатывается сигнал ошибки ε, который после коррекции в элементах 1-3, усиливаясь, поступает на вход электродвигателя 5 с редуктором 7, приводя его вал во вращательное движение с направлением и скоростью (ускорением), зависящими от величины поступающего сигнала U и внешнего моментного воздействия М_в на привод.

Второе звено манипулятора перемещается с помощью электропривода посредством передачи шестерня-рейка. Рейка установлена вдоль второго звена, а шестерня - на выходном валу редуктора 7 электропривода и имеет радиус r.

В процессе движения манипулятора, на его второе звено со стороны привода действует сила

где g - ускорение свободного падения.

Сила Р₃ при движении исполнительного органа манипулятора создает на выходном валу редуктора 7 момент, равный

С учетом соотношения (1), а также уравнения электрической

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

где

R, L - соответственно, активное сопротивление и индуктивность якорной цепи электродвигателя; J - момент инерции якоря электродвигателя 5 и вращающихся частей редуктора, приведенных к его валу; К_M - коэффициент крутящего момента; К_ω - коэффициент противо ЭДС электродвигателя; К_B - коэффициент вязкого трения; i_p - передаточное отношение редуктора 7; М_CTP - момент сухого трения; К_у - коэффициент усиления усилителя 5; i - ток якоря электродвигателя.

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

Датчики 27 и 9 установлены соответственно во второй и третьей степенях подвижности манипулятора (фиг. 2) и измеряют обобщенные координаты q₂ и q₃, соответственно. Датчики 23, 21 и 6 установлены в первой, второй и третьей степенях подвижности манипулятора (фиг. 2) и измеряют скорости и , соответственно, а датчики 47, 43, 32 и 53 - в его первой, второй, третьей и четвертой степенях подвижности и измеряют ускорения , соответственно.

Первый отрицательный (со стороны датчика 9) и второй положительный входы сумматора 14 имеют единичные коэффициенты усиления. Поэтому на его выходе формируется сигнал ε=q_вх-q₃. Первый положительный вход сумматора 1 (со стороны сумматора 14) имеет единичный коэффициент усиления, а его второй отрицательный вход - коэффициент усиления К_ω/К_у. В результате на выходе сумматора 1 формируется сигнал Первые и вторые положительные входы сумматоров 13 и 15 имеют единичные коэффициенты усиления. На выходах первого 12 и второго 16 задатчиков, соответственно, формируются сигналы , l₂=const. В результате на выходе сумматора 13 формируется сигнал , а на выходе сумматора 15 - сигнал .

Первый (со стороны блока 17) и второй положительные входы сумматора 18, соответственно, имеют коэффициенты усиления г/i_P, rm₂/i_P. В результате на выходе сумматора 18 формируется сигнал на выходе блока 19 - сигнал а на выходе блока 26 - сигнал

Первый (со стороны блока 29) и второй положительные входы сумматора 30, соответственно, имеют коэффициенты усиления rg/i_P и m₂rg/i_P. В результате на выходе сумматора 30 формируется сигнал а на выходе блока 54 - сигнал

Выходной сигнал релейного блока 10 имеет вид

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

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

На выходе задатчика 48 формируется сигнал m₂. Первый и второй положительные входы сумматора 49 имеют единичные коэффициенты усиления. В результате на его выходе формируется сигнал m₂+m_г, на выходе блока 34 - сигнал на выходе блока 36 - сигнал на выходе блока 55 - сигнал , а на выходе блока 57 - сигнал

Коэффициент усиления усилителя 38 равен 2 в результате на выходе блока 40 формируется сигнал Первый отрицательный (со стороны блока 40) вход сумматора 42 имеет единичный коэффициент усиления, а второй положительный - коэффициент усиления, равный 2. В результате на выходе блока 44 формируется сигнал

На выходе блока 46 формируется сигнал . Первый (со стороны блока 44) и второй положительные входы сумматора 45 имеют единичный коэффициент усиления и коэффициент усиления, равный 2, соответственно. В результате на выходе сумматора 45 формируется сигнал а на выходе блока 37 - сигнал

Первый (со стороны блока 34) отрицательный вход сумматора 35 имеет коэффициент усиления, равный 1/i_P, второй положительный (со стороны блока 36) - коэффициент усиления, равный g, третий отрицательный (со стороны блока 37) - коэффициент усиления, равный i_P/r, В результате на выходе сумматора 35 формируется сигнал (3).

Первый (со стороны блока 10), пятый (со стороны сумматора 30) и восьмой (со стороны блока 54) положительные, третий (со стороны блока 19) и четвертый (со стороны блока 26) отрицательные входы сумматора 11 имеют единичные коэффициенты усиления, второй положительный (со стороны датчика 6) - коэффициент усиления, равный шестой положительный (со стороны датчика 32) - коэффициент усиления, равный а седьмой положительный (со стороны сумматора 35) - коэффициент усиления, равный Lr/(Ri_p). В результате на выходе сумматора 11 формируется сигнал

Первый положительный вход сумматора 3 (со стороны блока 2) имеет коэффициент усиления его второй положительный вход (со стороны сумматора 11) - коэффициент усиления а третий положительный - коэффициент усиления В результате на выходе сумматора 3 формируется сигнал

Несложно показать, что поскольку при движении электропривода достаточно точно соответствует М_CTP, то, подставив полученное значение U* (3) в соотношение (2), получим уравнение, которое имеет постоянные желаемые параметры

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

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