Способ управления подвижным объектом и устройство для его реализации

Способ управления подвижным объектом и устройство для его реализации

Иллюстрации

Показать все

Реферат

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

Известен способ управления мобильным роботом на основе следящих систем, описанный в работе [С.Ф.Бурдаков, Р.Э.Стельмаков, С.В.Штайнле "Синтез траекторий и управление мобильными роботами в условиях неопределенности". Материалы VIII научно-технической конференции "Экстремальная робототехника". Под научной редакцией проф. Е.И.Юревича. - СПб, изд-во СПбГТУ, 1997, 439 с. - с.198-209]. Этот способ предполагает аппроксимацию сложной траектории более простыми геометрическими образами, измерение внешних и внутренних координат объекта управления, пересчет требуемой траектории из пространства внешних координат в пространство внутренних координат и изменение внутренних координат таким образом, чтобы внешние координаты приближались к требуемым.

Признаками этого аналога, совпадающими с признаками заявляемого способа, являются измерение внешних и внутренних координат объекта управления.

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

Известен также способ управления движением манипуляционного робота, приведенный в описании устройства, защищенного патентом РФ №2146606, кл. G05B 11/10, G05B 25, G05J 13/10, 2000 г. Этот способ содержит измерение обобщенных координат манипуляционного робота и их производных, преобразование их во внешние координаты, формирование вектора нелинейных элементов, формирование матрицы коэффициентов управления, формирование матриц квадратичных и линейных форм внешних координат, формирование первой и второй диагональных матриц постоянных коэффициентов, формирование вектора внешних скоростей и расчет, на основе сформированных матриц и векторов, матричных коэффициентов и вектора управления.

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

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

Наиболее близким по технической сущности к заявляемому (прототипом) является способ управления подвижным объектом, описанный в работе [В.Х.Пшихопов "Аналитический синтез синергетических регуляторов для позиционно-траекторных систем управления мобильными роботами". Материалы XI научно-технической конференции " Экстремальная робототехника". Под научной редакцией проф. Е.И.Юревича. СПб, издательство СПбГТУ, 2000].

Этот способ заключается в следующем.

Измеряют внутренние координаты управляемого объекта. Измеряют его внешние координаты и их производные. Формируют вектор F и матрицу В нелинейного преобразования внутренних координат.Формируют вектор М внешних скоростей. Формирую матрицу - производную R вектор-столбца внешних скоростей по вектор-строке внутренних координат. Формируют матрицу - производную L вектор-столбца внешних скоростей по вектор-строке внешних координат. Формируют матрицы N_1j, N_2j и N_3j квадратичных форм и линейных форм внешних координат, где , a n - число измеряемых внутренних координат управляемого объекта. Формируют первую А и вторую С диагональные матрицы постоянных коэффициентов размерностью ПХП. Формируют первый матричный коэффициент k-₁ в соответствии с уравнением:

где D_i=2Y^T·N_1i+N_2i - первая вспомогательная матрица,

Y - вектор измеряемых внешних координат, размерностью 6≥m≥n,

Е - единичная матрица размерностью m×m;

- производная по времени вектора измеряемых внешних координат, характеризующих положение центра тяжести управляемого объекта;

Т - символ операции транспонирования,

Формируют второй матричный коэффициент K₂ в соответствии с уравнением:

где D_j -вторая вспомогательная матрица,

0₁ - вектор нулевых элементов размерностью n.

Формируют третий матричный коэффициент K₃ в соответствии с уравнением:

,

где V_k - заданная траекторная (контурная) скорость.

Формируют вектор управления U в соответствии с уравнением:

Все перечисленные признаки (действия) прототипа совпадают с существенными признаками заявляемого способа.

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

Наиболее близким к заявляемому устройству (устройству, реализующему заявляемый способ) является устройство управления, защищенное патентом РФ №2146606, кл. G05B 11/10, G05B 25, G05J 13/10, 2000 г. Оно содержит планировщик траектории, три вычислителя матричных коэффициентов, вычислитель сигнала управления, блок транспонирования матриц, вычислитель решения прямой задачи кинематики, вычислитель матрицы Якоби, вычислитель матрицы Якоби решения прямой задачи кинематики, блок формирования вектора нелинейных элементов, блок формирования матрицы коэффициентов управления и блок датчиков информации.

Признаками этого устройства (прототипа), совпадающего с существенными признаками заявляемого устройства являются все перечисленные элементы, кроме вычислителя решения прямой задачи кинематики и вычислителя матрицы Якоби этого решения.

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

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

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

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

Технический результат в способе достигается тем, что в известном способе управления подвижным объектом, основанном на измерении внутренних координат подвижного объекта, измерении его внешних координат и их производных, формировании вектора F и матрицы В нелинейного преобразования внутренних координат, формировании вектора М внешних скоростей, формировании матрицы - производной R вектор-столбца внешних скоростей по вектор-строке внутренних координат, формировании матрицы - производной L вектор-столбца внешних скоростей по вектор-строке внешних координат, формировании матриц N_1j, N_2j, N_3j - квадратичных форм от внешних координат, где , a n - число измеряемых внутренних координат, формировании первой А и второй С диагональных матриц постоянных коэффициентов размерностью n×n, формировании первого матричного коэффициента K₁ в соответствии с уравнением:

где D_i=2Y^T·N_1i+N_2i - первая вспомогательная матрица,

Y - вектор измеряемых внешних координат размерностью 6 ≥ m ≥ n,

Е - единичная матрица размерностью mxm;

- производная по времени вектора измеряемых внешних координат, характеризующих положение центра тяжести управляемого объекта;

Т - символ операции транспонирования,

формировании второго матричного коэффициента K₂ в соответствии с уравнением:

где D_j - вторая вспомогательная матрица,

0₁ - вектор нулевых элементов размерностью n,

формировании третьего матричного коэффициента K₃ в соответствии с уравнением:

,

где V_k - заданная траекторная (контурная) скорость,

и формировании вектора управления U в соответствии с уравнением:

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

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

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

Сущность изобретения поясняется чертежами, на которых приведены:

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

- на фиг.2 - структурная схема первого вычислителя матричного коэффициента;

- на фиг.3 - структурная схема второго вычислителя матричного коэффициента;

-на фиг.4 - структурная схема третьего вычислителя матричного коэффициента;

- на фиг.5 - структурная схема вычислителя сигнала управления.

Устройство управления подвижным объектом содержит планировщик 1 траектории, первый 2, второй 3 и третий 4 вычислители матричных коэффициентов, вычислитель 5 сигнала управления, первый 6 и второй 7 блоки транспонирования матриц, блок 8 датчиков информации, блок 9 сенсорного обеспечения, блок 10 формирования вектора нелинейных элементов, блок 11 формирования матрицы коэффициентов управления, блок 12 формирования матрицы - производной вектор-столбца внешних скоростей по вектор-строке внутренних координат, блок 13 формирования матрицы - производной вектор-столбца внешних скоростей по вектор-строке внешних координат, блок 14 формирования вектора внешних скоростей, пороговое устройство 15, электронный переключатель 16 и инвертор 17 знака определения матриц.

Первый, второй, третий и четвертый выходы планировщика 1 соединены соответственно с первым, вторым, третьим и четвертым входами вычислителя 4. Пятый выход планировщика 1 соединен с третьими входами вычислителей 2 и 3. Первый и второй входы вычислителя 3 соединены соответственно со вторым и третьим выходами планировщика 1, первый вход которого соединен с выходом блока 8 и первыми входами блоков 10, 11, 12, 13 и 14, а второй - с первым выходом блока 9, входом блока 6, вторыми входами блоков 12, 13 и 14 и пятым входом вычислителя 4. Выход блока 6 соединен с шестым входом вычислителя 4 и пятым входом вычислителя 3. Вход блока 7 соединен со вторым выходом блока 9, а выход - с шестым входом вычислителя 3 и вторым входом вычислителя 2, первый и пятый входы которого соединены соответственно со вторым и третьим выходами вычислителя 3.

Вход порогового устройства 15 соединен с третьим выходом блока 9, а выход - с управляющим входом электронного переключателя 16. Первый сигнальный вход электронного переключателя 16 соединен с шестым выходом планировщика 1 и входом инвертора 17 знака определения матриц, второй - с выходом инвертора 17 знака определения матриц, а выход - с четвертыми входами вычислителей 2 и 3.

Выход вычислителя 2, второй выход вычислителя 3 и выход вычислителя 4 соединены соответственно с первым, вторым и третьим входами вычислителя 5, четвертый, пятый, шестой, седьмой и восьмой входы которого соединены с выходами блоков 10, 11, 12, 13 и 14 соответственно. Выход вычислителя 5 соединен со входом управления входящего в состав управляемого объекта исполнительного устройства 18, выход которого соединен со входом блока 8 и входом входящей в состав управляемого объекта механической системы 19, которая через внешнюю среду 20 соединена со входом блока 9.

Вычислитель 2 содержит регистр 21, блок 22 умножения на два, перемножитель 23, сумматор 24, регистр 25 и перемножитель 26. Выход регистра 21 соединен с первым входом перемножителя 23, второй вход которого соединен с выходом блока 22, соединенного своим входом со вторым входом вычислителя 2. Первый вход сумматора 24 соединен с выходом перемножителя 23, второй вход - с пятым входом вычислителя 2, а выход - со вторым входом регистра 25, первый вход которого соединен с первым входом вычислителя 2, а выход - с первым входом перемножителя 26. Второй и третий входы перемножителя 26 соединены соответственно с третьим и четвертым входами вычислителя 2, а выход - с его выходом.

Вычислитель 3 содержит блоки 27 и 28 умножения на два, перемножители 29, 30, 31 и 32, регистр 33 и сумматоры 34, 35 и 36. Первый вход вычислителя 3 соединен с первыми входами перемножителей 29 и 30, вторые входы которых соединены с выходами блоков 27 и 28 соответственно, соединенных своими входами с шестым и пятым входами вычислителя 3 соответственно. Первый вход регистра 33 соединен с выходом перемножителя 29, второй заземлен, а выход соединен с третьим входом перемножителя 31, первый вход которого соединен с первым входом сумматора 35 и четвертым входом вычислителя 3, а выход - со вторым входом сумматора 36. Первый вход сумматора 34 соединен со вторым входом и третьим выходом вычислителя 3. Второй - с выходом перемножителя 30, а выход - со вторым выходом вычислителя 3 и первым входом перемножителя 32, второй вход которого соединен с выходом сумматора 35. Первый вход сумматора 36 соединен с выходом перемножителя 32, а выход - с первым выходом вычислителя 3.

Вычислитель 4 содержит перемножители 37, 38, 39 и 40, сумматор 41, инвертор 42, регистр 43 и блок 44 транспонирования матриц. Первый, второй и третий входы перемножителя 37 соединены соответственно со вторым, пятым и шестым входами вычислителя, а выход - с первым входом сумматора 41. Первый вход перемножителя 38 соединен с пятым входом вычислителя 4, второй - с третьим входом вычислителя 4, а выход - со вторым входом сумматора 41. Входы перемножителя 39 соединены с первым входом вычислителя 4, а выход - со входом инвертора 42. Выход инвертора 42 соединен со вторым входом регистра 43, первый вход которого заземлен, а выход соединен со входом блока 44 транспонирования матриц. Первый и второй входы перемножителя 40 соединены соответственно с выходом блока 44 и седьмым входом вычислителя 4, а выход - с четвертым входом сумматора 41, третий вход которого соединен с четвертым входом вычислителя 4, а выход является выходом вычислителя 4.

Вычислитель 5 содержит перемножители 45, 46, 47, 48 и 49, сумматоры 50 и 51 и блок 52 обращения матриц. Первый вход вычислителя соединен с первыми входами перемножителей 45, 46 и 47. Второй вход перемножителя 45 соединен со вторым входом перемножителя 46 и шестым входом вычислителя 5, третий вход - с пятым входом вычислителя 5, а выход - со входом блока 52. Третий вход перемножителя 46 соединен с четвертым входом вычислителя 5, а выход - с первым инверсным входом сумматора 51. Второй вход перемножителя 47 соединен с седьмым входом вычислителя 5, а выход - с первым входом сумматора 50, второй вход которого соединен со вторым входом вычислителя 5, а выход - с первым входом перемножителя 49. Второй вход перемножителя 49 соединен с восьмым входом вычислителя 5, а выход - со вторым инверсным входом сумматора 51, третий инверсный вход которого соединен с третьим входом вычислителя 5. Первый вход перемножителя 48 соединен с выходом блока 52, второй - с выходом сумматора 51, а выход является выходом вычислителя 5.

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

Сформированный вычислителем 5 сигнал управления U поступает на управляющий вход исполнительного устройства 18 управляемого объекта (порядок формирования управляющего сигнала будет изложен ниже). Устройство 18 и подключенные к его выходу механическая система 19 и блок 8 датчиков отрабатывают этот сигнал. Блок 8 осуществляет измерение внутренних координат управляемого объекта (углов поворота руля, ведущих колес и т.д.). На его выходах формируется вектор Z внутренних координат размерностью "n", который поступает на первый вход планировщика 1 траекторий и входы блоков 10, 11, 12, 13 и 14. С выхода механической системы 19 через внешнюю среду 20 результаты отработки поступают на вход блока 9 сенсорного обеспечения. Этот блок осуществляет измерение внешних координат управляемого объекта - координат его центра тяжести и ориентации корпуса. На первом выходе блока 9 формируется вектор Y внешних координат управляемого объекта размерностью "m". Размерность m удовлетворяет условию n≤m≤6. На втором выходе блока 9 формируется вектор производной вектора Y, причем только для тех значений Y вектора Y, которые являются координатами центра тяжести управляемого объекта. Координаты вектора Y с первого выхода блока 9 поступают на второй вход планировщика 1 и на вход блока 6, а те из значений Y^*, которые являются координатами центра тяжести управляемого объекта, поступают кроме того на входы блоков 12, 13, 14 и на пятый вход вычислителя 4. На третьем выходе блока 9 формируется сигнал, соответствующий расстоянию r между управляемым объектом и ближайшим препятствием на пути его движения. Этот сигнал поступает на вход порогового устройства 15.

Планировщик 1, представляющий собой управляющую вычислительную машину, под действием управляющих сигналов Z и Y формирует на своих выходах следующие управляющие сигналы:

- траекторную (контурную) скорость V_k объекта управления;

- матрицы N_1j, N_2j и N_3j] квадратичных форм от внешних координат,

где ;

- диагональные матрицы С и А постоянных коэффициентов размерностью n×n.

Сигнал V_k формируется на первом выходе планировщика 1 и поступает оттуда на первый вход вычислителя 4. Сигнал N_1j формируется на втором выходе планировщика 1 и поступает оттуда на первый вход вычислителя 3 и на второй вход вычислителя 4. Сигнал N_2j формируется на третьем выходе планировщика 1 и поступает оттуда на второй вход вычислителя 3 и третий вход вычислителя 4. Сигнал N_3j формируется на четвертом выходе планировщика 1 и поступает оттуда на четвертый вход вычислителя 4. Матрица С формируется на пятом выходе планировщика 1 и поступает оттуда на третьи входы вычислителей 2 и 3. Матрица А формируется на шестом выходе планировщика 1 и поступает оттуда на первый сигнальный вход переключателя 16 и на вход инвертора 17.

В блоке 10 формируется вектор F нелинейного преобразования внутренних координат Z. Этот вектор - нелинейная функция - своя для каждого конкретного объекта управления. С выхода блока 10 вектор F поступает на четвертый вход вычислителя 5.

Аналогично в блоке 11 формируется матрица В нелинейного преобразования внутренних координат Z. Она представляет собой матрицу коэффициентов управления и так же, как и вектор F, является специфичной для каждого конкретного объекта управления. С выхода блока 11 матрица В поступает на пятый вход вычислителя 5.

В блоке 12 формируется матрица R - производная вектор-столбца внешних скоростей по вектор-стр