RU2731741C1 - Устройство формирования программных сигналов управления - Google Patents

Устройство формирования программных сигналов управления Download PDF

Info

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

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B15/00—Systems controlled by a computer
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00—Programme-control systems

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • General Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Feedback Control In General (AREA)

Abstract

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

Description

Изобретение относится к области автоматического управления динамическими объектами и обеспечивает формирование программных законов перемещения этих объектов с заданной скоростью и пространственной ориентацией.
Известно устройство формирования программных сигналов управления, содержащее последовательно соединенные первый задатчик сигнала, первый сумматор, первый интегратор, последовательно соединенные нелинейный элемент, вход которого соединен с выходом первого интегратора, ключ, второй вход которого соединен с выходом второго задатчика сигнала, блок деления, второй интегратор, второй сумматор, второй вход которого соединен с первым выходом навигационной системы, первый квадратор, третий сумматор, второй вход которого через второй квадратор соединен с выходом четвертого сумматора, а третий вход через третий квадратор - с выходом пятого сумматора, и первый блок извлечения корня, выход которого соединен со вторым входом первого сумматора, последовательно соединенные первый функциональный преобразователь, вход которого соединен с выходом второго интегратора, с входом второго функционального преобразователя, с входом первой следящей системы, через третий функциональный преобразователь - с первым входом четвертого сумматора, второй вход которого соединен со вторым выходом навигационной системы, с входом второй следящей системы и через четвертый функциональный преобразователь - с входом третьей следящей системы и с первым входом пятого сумматора, второй вход которого соединен с третьим выходом навигационной системы, четвертый квадратор, шестой сумматор, второй вход которого через пятый квадратор соединен с выходом второго функционального преобразователя, а третий вход - с выходом третьего задатчика сигнала, и второй блок извлечения корня, выход которого соединен со вторым входом блока деления (патент RU №2453891, кл. G05B 13/02. Бюл. №17, 2012).
Недостатком этого устройства является невозможность задания пространственной ориентации движущихся объектов в процессе их перемещения по сложным пространственным траекториям.
Известно также устройство формирования программных сигналов управления, содержащее навигационную систему, первую, вторую и третью следящие системы управления динамическими объектами, и последовательно соединенные первый сумматор, первый квадратор, второй сумматор, второй вход которого через второй квадратор подключен к выходу третьего сумматора, а третий вход через третий квадратор - к выходу четвертого сумматора, и блок извлечения квадратного корня, последовательно соединенные пятый сумматор, первый вход которого подключен к первому выходу навигационной системы, к первому входу шестого сумматора и к первому входу седьмого сумматора, а второй вход - ко второму выходу навигационной системы и ко второму входу шестого сумматора, восьмой сумматор, второй вход которого подключен к третьему выходу навигационной системы и к третьему входу шестого сумматора, а третий вход - к четвертому выходу навигационной системы, первый блок умножения, выход которого подключен к первому входу первого сумматора, девятый сумматор, второй вход которого подключен ко второму входу первого сумматора и к выходу пятого сумматора, а третий - к третьему входу первого сумматора и выходу второго блока умножения, третий блок умножения, выход которого подключен ко второму входу седьмого сумматора, соединенного выходом со входом первой следящей системы, последовательно соединенные десятый сумматор, первый вход которого подключен к пятому выходу навигационной системы, и первым входам одиннадцатого и двенадцатого сумматоров, а второй вход - к шестому выходу навигационной системы и второму входу одиннадцатого сумматора, тринадцатый сумматор, второй вход которого подключен к седьмому выходу навигационной системы и третьему входу одиннадцатого сумматора, а третий вход - к восьмому выходу навигационной системы, четвертый блок умножения, выход которого подключен к первому входу третьего сумматора, четырнадцатый сумматор, второй вход которого подключен ко второму входу третьего сумматора и к выходу десятого сумматора, а третий вход - к третьему входу третьего сумматора и к выходу пятого блока умножения, и шестой блок умножения, подключенный выходом ко второму входу двенадцатого сумматора, выход которого подключен ко входу второй следящей системы, последовательно соединенные пятнадцатый сумматор, первый вход которого подключен к девятому выходу навигационной системы, первому входу шестнадцатого сумматора и первому входу семнадцатого сумматора, а второй вход - к десятому выходу навигационной системы и второму входу шестнадцатого сумматора, восемнадцатый сумматор, второй вход которого соединен с одиннадцатым выходом навигационной системы и третьим входом шестнадцатого сумматора, а третий вход - с двенадцатым выходом навигационной системы, седьмой блок умножения, выход которого подключен к первому входу четвертого сумматора, девятнадцатый сумматор, второй вход которого подключен ко второму входу четвертого сумматора, и к выходу пятнадцатого сумматора, а третий вход - к третьему входу четвертого сумматора и к выходу восьмого блока умножения, девятый блок умножения, выход которого подключен ко второму входу семнадцатого сумматора, подключенного выходом к входу третьей следящей системы, последовательно соединенные блок деления, вход делителя которого подключен к выходу блока извлечения квадратного корня, а вход делимого - к выходу задатчика сигнала, интегратор и четвертый квадратор, вход которого подключен также ко вторым входам третьего, шестого и девятого блоков умножения, и к первым входам второго, пятого и восьмого блоков умножения, вторые входы которых подключены, соответственно, к выходам шестого, одиннадцатого и шестнадцатого сумматоров, а выход четвертого квадратора подключен ко вторым входам первого, четвертого и седьмого блоков умножения (патент RU №2626437, кл. G05B 13/02. Бюл. №21, 2017). Это устройство по своей технической сущности является наиболее близким к заявляемому изобретению и принято за прототип.
Его недостатком является то, что оно также не позволяет задавать пространственную ориентацию движущихся объектов в процессе их перемещения по сложным пространственным траекториям.
Задачей заявляемого технического решения является формирование с помощью предложенного устройства в каждый момент времени заданной ориентации в пространстве динамических объектов, уже перемещаемых по произвольным программным траекториям.
Технический результат заключается в формировании таких программных сигналов, которые помимо задания скорости перемещения динамических объектов по пространственным траекториям будут обеспечивать в каждый момент времени и их требуемую ориентацию в пространстве.
Поставленная задача решается тем, что в устройство формирования программных сигналов управления, содержащее навигационную систему, первую, вторую и третью следящие системы управления, последовательно соединенные первый сумматор, первый квадратор, второй сумматор, второй вход которого через второй квадратор подключен к выходу третьего сумматора, а третий вход через третий квадратор - к выходу четвертого сумматора и блок извлечения квадратного корня, последовательно соединенные пятый сумматор, первый вход которого подключен к первому выходу навигационной системы, к первому входу шестого сумматора и к первому входу седьмого сумматора, а второй вход - ко второму выходу навигационной системы и ко второму входу шестого сумматора, восьмой сумматор, второй вход которого подключен к третьему выходу навигационной системы и к третьему входу шестого сумматора, а третий вход - к четвертому выходу навигационной системы, первый блок умножения, выход которого подключен к первому входу первого сумматора, девятый сумматор, второй вход которого подключен ко второму входу первого сумматора и к выходу пятого сумматора, а третий - к третьему входу первого сумматора и выходу второго блока умножения, третий блок умножения, выход которого подключен ко второму входу седьмого сумматора, соединенного выходом со входом первой следящей системы, последовательно соединенные десятый сумматор, первый вход которого подключен к пятому выходу навигационной системы, и первым входам одиннадцатого и двенадцатого сумматоров, а второй вход - к шестому выходу навигационной системы и второму входу одиннадцатого сумматора, тринадцатый сумматор, второй вход которого подключен к седьмому выходу навигационной системы и третьему входу одиннадцатого сумматора, а третий вход - к восьмому выходу навигационной системы, четвертый блок умножения, выход которого подключен к первому входу третьего сумматора, четырнадцатый сумматор, второй вход которого подключен ко второму входу третьего сумматора и к выходу десятого сумматора, а третий вход - к третьему входу третьего сумматора и к выходу пятого блока умножения, и шестой блок умножения, подключенный выходом ко второму входу двенадцатого сумматора, выход которого подключен ко входу второй следящей системы, последовательно соединенные пятнадцатый сумматор, первый вход которого подключен к девятому выходу навигационной системы, к первому входу шестнадцатого сумматора и к первому входу семнадцатого сумматора, а второй вход - к десятому выходу навигационной системы и к второму входу шестнадцатого сумматора, восемнадцатый сумматор, второй вход которого соединен с одиннадцатым выходом навигационной системы и третьим входом шестнадцатого сумматора, а третий вход - с двенадцатым выходом навигационной системы, седьмой блок умножения, выход которого подключен к первому входу четвертого сумматора, девятнадцатый сумматор, второй вход которого подключен ко второму входу четвертого сумматора, и к выходу пятнадцатого сумматора, а третий вход - к третьему входу четвертого сумматора и к выходу восьмого блока умножения, девятый блок умножения, выход которого подключен ко второму входу семнадцатого сумматора, подключенного выходом к входу третьей следящей системы, последовательно соединенные блок деления, вход делителя которого подключен к выходу блока извлечения квадратного корня, а вход делимого - к выходу задатчика сигнала, интегратор и четвертый квадратор, вход которого подключен также ко вторым входам третьего, шестого и девятого блоков умножения, и к первым входам второго, пятого и восьмого блоков умножения, вторые входы которых подключены, соответственно, к выходам шестого, одиннадцатого и шестнадцатого сумматоров, а выход четвертого квадратора подключен ко вторым входам первого, четвертого и седьмого блоков умножения, дополнительно вводятся последовательно соединенные двадцатый сумматор, первый вход которого подключен к тринадцатому выходу навигационной системы, первому входу двадцать первого сумматора и первому входу двадцать второго сумматора, а второй вход - к четырнадцатому выходу навигационной системы и второму входу двадцать первого сумматора, двадцать третий сумматор, второй вход которого соединен с пятнадцатым выходом навигационной системы и третьим входом двадцать первого сумматора, а третий вход - с шестнадцатым выходом навигационной системы, десятый блок умножения, двадцать четвертый сумматор, второй вход которого подключен к выходу двадцатого сумматора, а третий вход - к выходу одиннадцатого блока умножения, двенадцатый блок умножения, выход которого подключен ко второму входу двадцать второго сумматора, подключенного выходом к входу четвертой следящей системы, последовательно соединенные двадцать пятый сумматор, первый вход которого подключен к семнадцатому выходу навигационной системы, к первому входу двадцать шестого сумматора и к первому входу двадцать седьмого сумматора, а второй вход - к восемнадцатому выходу навигационной системы и к второму входу двадцать шестого сумматора, двадцать восьмой сумматор, второй вход которого соединен с девятнадцатым выходом навигационной системы и третьим входом двадцать шестого сумматора, а третий вход - с двадцатым выходом навигационной системы, тринадцатый блок умножения, двадцать девятый сумматор, второй вход которого подключен к выходу двадцать пятого сумматора, а третий вход - к выходу четырнадцатого блока умножения, пятнадцатый блок умножения, выход которого подключен ко второму входу двадцать седьмого сумматора, подключенного выходом к входу пятой следящей системы, последовательно соединенные тридцатый сумматор, первый вход которого подключен к двадцать первому выходу навигационной системы, первому входу тридцать первого сумматора и первому входу тридцать второго сумматора, а второй вход - к двадцать второму выходу навигационной системы второму входу тридцать первого сумматора, тридцать третий сумматор, второй вход которого соединен с двадцать третьим выходом навигационной системы и третьим входом тридцать первого сумматора, а третий вход - с двадцать четвертым выходом навигационной системы, шестнадцатый блок умножения, второй вход которого подключен ко вторым входам десятого и тринадцатого блоков умножения, а также к выходу четвертого квадратора, тридцать четвертый сумматор, второй вход которого подключен к выходу тридцатого сумматора, а третий вход - к выходу семнадцатого блока умножения, восемнадцатый блок умножения, второй вход которого подключен к выходу интегратора, ко вторым входам двенадцатого и пятнадцатого блоков умножения и к первым входам одиннадцатого, четырнадцатого и семнадцатого блоков умножения, вторые входы которых подключены, соответственно, к выходам двадцать первого, двадцать шестого и тридцать первого сумматоров, а выход - ко второму входу тридцать второго сумматора, подключенного выходом ко входу шестой следящей системы.
Сопоставительный анализ существенных признаков предлагаемого технического решения с существенными признаками аналогов и прототипа свидетельствуют о его соответствии критерию «новизна».
При этом отличительные признаки формулы изобретения обеспечивают возможность применения описанного устройства не только для формирования требуемой скорости движения программной точки по сформированным траекториям, задаваемым параметрическими сплайнами Безье, но и для реализации заданной пространственной ориентации произвольных динамических объектов.
Сущность изобретения поясняется чертежами, где на фиг. 1 приведена блок-схема предлагаемого устройства формирования программных сигналов управления; на фиг. 2 схематично показано движение динамического объекта вдоль сформированной параметрическими сплайнами траектории с изменяемой пространственной ориентацией.
Устройство содержит навигационную систему 1, первую 2, вторую 3 и третью 4 следящие системы управления динамическими объектами, и последовательно соединенные первый сумматор 5, первый квадратор 6, второй сумматор 7, второй вход которого через второй квадратор 8 подключен к выходу третьего сумматора 9, а третий вход через третий квадратор 10 - к выходу четвертого сумматора 11, и блок 12 извлечения квадратного корня, последовательно соединенные пятый сумматор 13, первый вход которого подключен к первому выходу навигационной системы 1, к первому входу шестого сумматора 14 и к первому входу седьмого сумматора 15, а второй вход - ко второму выходу навигационной системы 1 и ко второму входу шестого сумматора 14, восьмой сумматор 16, второй вход которого подключен к третьему выходу навигационной системы 1 и к третьему входу шестого сумматора 14, а третий вход - к четвертому выходу навигационной системы 1, первый блок 17 умножения, выход которого подключен к первому входу первого сумматора 5, девятый сумматор 18, второй вход которого подключен ко второму входу первого сумматора 5 и к выходу пятого сумматора 13, а третий - к третьему входу первого сумматора 5 и выходу второго блока 19 умножения, третий блок 20 умножения, выход которого подключен ко второму входу седьмого сумматора 15, соединенного выходом со входом первой следящей системы 2, последовательно соединенные десятый сумматор 21, первый вход которого подключен к пятому выходу навигационной системы 1, и первым входам одиннадцатого 22 и двенадцатого 23 сумматоров, а второй вход - к шестому выходу навигационной системы 1 и второму входу одиннадцатого сумматора 22, тринадцатый сумматор 24, второй вход которого подключен к седьмому выходу навигационной системы 1 и третьему входу одиннадцатого сумматора 22, а третий вход - к восьмому выходу навигационной системы 1, четвертый блок 25 умножения, выход которого подключен к первому входу третьего сумматора 9, четырнадцатый сумматор 26, второй вход которого подключен ко второму входу третьего сумматора 9 и к выходу десятого сумматора 21, а третий вход - к третьему входу третьего сумматора 9 и к выходу пятого блока 27 умножения, и шестой блок 28 умножения, подключенный выходом ко второму входу двенадцатого сумматора 23, выход которого подключен ко входу второй следящей системы 3, последовательно соединенные пятнадцатый сумматор 29, первый вход которого подключен к девятому выходу навигационной системы 1, первому входу шестнадцатого сумматора 30 и первому входу семнадцатого сумматора 31, а второй вход - к десятому выходу навигационной системы 1 и второму входу шестнадцатого сумматора 30, восемнадцатый сумматор 32, второй вход которого соединен с одиннадцатым выходом навигационной системы 1 и третьим входом шестнадцатого сумматора 30, а третий вход - с двенадцатым выходом навигационной системы 1, седьмой блок 33 умножения, выход которого подключен к первому входу четвертого сумматора 11, девятнадцатый сумматор 34, второй вход которого подключен ко второму входу четвертого сумматора 11, и к выходу пятнадцатого сумматора 29, а третий вход - к третьему входу четвертого сумматора 11 и к выходу восьмого блока 35 умножения, девятый блок 36 умножения, выход которого подключен ко второму входу семнадцатого сумматора 31, подключенного выходом к входу третьей следящей системы 4, последовательно соединенные блок 37 деления, вход делителя которого подключен к выходу блока 12 извлечения квадратного корня, а вход делимого - к выходу задатчика 38 сигнала, интегратор 39 и четвертый квадратор 40, вход которого подключен также ко вторым входам третьего 20, шестого 28 и девятого 36 блоков умножения, и к первым входам второго 19, пятого 27 и восьмого 35 блоков умножения, вторые входы которых подключены, соответственно, к выходам шестого 14, одиннадцатого 22 и шестнадцатого 30 сумматоров, а выход четвертого квадратора 40 подключен ко вторым входам первого 17, четвертого 25 и седьмого 33 блоков умножения, последовательно соединенные двадцатый сумматор 41, первый вход которого подключен к тринадцатому выходу навигационной системы 1, первому входу двадцать первого сумматора 42 и первому входу двадцать второго сумматора 43, а второй вход - к четырнадцатому выходу навигационной системы 1 и второму входу двадцать первого сумматора 42, двадцать третий сумматор 44, второй вход которого соединен с пятнадцатым выходом навигационной системы 1 и третьим входом двадцать первого сумматора 42, а третий вход - с шестнадцатым выходом навигационной системы 1, десятый блок 45 умножения, двадцать четвертый сумматор 46, второй вход которого подключен к выходу двадцатого сумматора 41, а третий вход - к выходу одиннадцатого блока 47 умножения, двенадцатый блок 48 умножения, выход которого подключен ко второму входу двадцать второго сумматора 43, подключенного выходом к входу четвертой следящей системы 49, последовательно соединенные двадцать пятый сумматор 50, первый вход которого подключен к семнадцатому выходу навигационной системы 1, первому входу двадцать шестого сумматора 51 и первому входу двадцать седьмого сумматора 52, а второй вход - к восемнадцатому выходу навигационной системы 1 и второму входу двадцать шестого сумматора 51, двадцать восьмой сумматор 53, второй вход которого соединен с девятнадцатым выходом навигационной системы 1 и третьим входом двадцать шестого сумматора 51, а третий вход - с двадцатым выходом навигационной системы 1, тринадцатый блок 54 умножения, двадцать девятый сумматор 55, второй вход которого подключен к выходу двадцать пятого сумматора 50, а третий вход - к выходу четырнадцатого блока 56 умножения, пятнадцатый блок 57 умножения, выход которого подключен ко второму входу двадцать седьмого сумматора 52, подключенного выходом к входу пятой следящей системы 58, последовательно соединенные тридцатый сумматор 59, первый вход которого подключен к двадцать первому выходу навигационной системы 1, первому входу тридцать первого сумматора 60 и первому входу тридцать второго сумматора 61, а второй вход - к двадцать второму выходу навигационной системы 1 и второму входу тридцать первого сумматора 60, тридцать третий сумматор 62, второй вход которого соединен с двадцать третьим выходом навигационной системы 1 и третьим входом тридцать первого сумматора 60, а третий вход - с двадцать четвертым выходом навигационной системы 1, шестнадцатый блок 63 умножения, второй вход которого подключен ко вторым входам десятого блока 45 умножения и тринадцатого блока 54 умножения и к выходу четвертого квадратора 40, тридцать четвертый сумматор 64, второй вход которого подключен к выходу тридцатого сумматора 59, а третий вход - к выходу семнадцатого блока 65 умножения, восемнадцатый блок 66 умножения, второй вход которого подключен к выходу интегратора 39, ко вторым входам двенадцатого 48 и пятнадцатого 57 блоков умножения и к первым входам одиннадцатого 47, четырнадцатого 56 и семнадцатого 65 блоков умножения, вторые входы которых подключены, соответственно, к выходам двадцать первого 42, двадцать шестого 51 и тридцать первого 60 сумматоров, выход которого подключен ко второму входу тридцать второго сумматора 61, подключенного выходом к входу шестой следящей системы 67.
На фиг. 1 и фиг. 2 введены следующие обозначения: xki, yk,i, zk,i
Figure 00000001
- координаты точек, используемых при построении k-го сплайна Безье; ψk,i, θk,j, ϕk;i
Figure 00000002
- угловые координаты (углы Эйлера), определяющие закон изменения пространственной ориентации динамического объекта при его отслеживании программной точки, перемещающейся по k-му сплайну Безье;
Figure 00000003
- скорость изменения параметра τ k-го сплайна Безье, по которому в текущий момент времени движется программная точка; К - количество используемых сплайнов Безье; vd - желаемая скорость движения программной точки объекта управления по всей траектории, состоящей из К сплайнов Безье; х*, у*, z* - формируемые координаты, задающие положение программной точки на сплайне Безье в абсолютной системе координат (СК) Oxyz; ψ*, θ*, ϕ* - сформированные угловые координаты (углы Эйлера), задающие текущую пространственную ориентацию управляемого объекта при перемещении его программной точки по сплайну Безье, соответствующие углам поворота осей связанной с объектом СК O'x'y'z' относительно осей другой полусвязанной с объектом СК, оси которой параллельны осям абсолютной СК, а центр совпадает с центром СК O'x'y'z'; Pk,i (xk,i, yk,i, zk,i, ψk,i, θk,i, ϕk,i)T - векторы, элементы которых используются при построении k-го сплайна Безье
Figure 00000004
где xk,i, yk,i, zk,i - координаты соответствующих точек, ψk,i, θk,i, ϕk,i - углы ориентации объекта в этих точках; Ak,x, Ak,y, Ak,z, Bk,х, Bk,у, Bk,z, Ck,x, Ck,y, Ck,z, Dk.х, Dk,у, Dk,z, Ak,ψ, Akθ, Ak,ϕ, Bk;ψ Bk,θ, Bk,ϕ, Ck,ψ, Ck,θ, Ck,ϕ, Dk,ψ, Dk,θ, Dk,ϕ - коэффициенты, назначения которых будут пояснены ниже; Fx, Fy, Fz - сигналы, назначения которых будут пояснены ниже. Каждая k-ая кривая берет начало в точке (xk,0, yk,0, zk,0) и заканчивается в точке (xk,3, yk,3, zk,3), а ориентация объекта управления в этих точках задается углами (ψk,0, θk,0, ϕk,0) и (ψk,3, θk,3, ϕk,3), соответственно. Кривизна k-ого сплайна определяется точками (xk,1, yk,1, zk,1) и (xk,2, yk,2, zk,2), а ориентация движущегося объекта в этих точках определяется углами (ψk,1, θk,1, ϕk,1) и (ψk,2, θk,2, ϕk,2).
Заявляемое устройство работает следующим образом.
В начальный момент времени индексу k присваивается значение 1 и на соответствующих выходах навигационной системы 1 формируются сигналы xk,i, yk,i, zk,i, ψk,i, θk,i, ϕk,i,
Figure 00000005
Первые отрицательные входы сумматоров 13, 21, 29, 41, 50, 59 имеют единичные коэффициенты усиления, а их вторые положительные входы - коэффициенты усиления, равные 3. В результате на выходах этих сумматоров формируются сигналы Ck,x=-xk,0+3xk,1, Ck,y=-yk,0+3yk,1, Ck,z=-zk,0+3zk,1, Ck,ψ=-ψk,0+3ψk,1, Ck,θ=-θk,0+3θk,1, Ck,ϕ=-ϕk,0+3ϕk,1, соответственно.
Первые и третьи положительные входы сумматоров 14, 22, 30, 42, 51, 60, соответственно, имеют коэффициенты усиления, равные 3, а их вторые отрицательные входы - коэффициенты усиления, равные 6. В результате на выходах этих сумматоров формируются сигналы Bk,x=3xk,0-6xk,1+3xk,2, Bk,y=3yk,0-6yk,1+3yk,2, Bk,Z=3zk,0-6zk,1+3zk,2, Bk,ψ=3ψk,0-6ψk,1+3ψk,2, Bk,0=3θk,0-6θk,1+3θk,2, Bk,ϕ=3ϕk,0-6ϕk,1+3ϕk,2, соответственно.
Первые и третьи положительные входы сумматоров 16, 24, 32, 44, 53, 62 имеют единичные коэффициенты усиления, а их вторые отрицательные входы - коэффициенты усиления, равные 3. В результате на их выходах, соответственно, формируются сигналы Ak,x=-xk,0+3xk,1-3xk,2+xk,3, Ak,y=-yk,0+3yk,1-3yk,2+yk,3, Ak,z=-zk,0+3zk,1-3zk,2+zk,3, Ak,ψ=-ψk,0+3ψk,1-3ψk,2+ψk,3, Ak,θ=-θk,0+3θk,1-3θk,2+θk,3, Ak,ϕ=-ϕk,0+3ϕk,1-3ϕk,2+ϕk,3, соответственно.
В начале работы устройства на выходе интегратора 39 формируется сигнал τ=0, τ∈ [0,1], который представляет собой параметр k-го сплайна Безье. Его суть будет пояснена ниже. При выполнении условия τ=1 интегратор обнуляется, а индексу k присваивается следующее значение k+1. На выходе квадратора 40 формируется сигнал τ2, на выходах блоков 19, 27, 35, 47, 56, 65 - соответственно, сигналы Bk,хτ, Bk,yτ, Bk,zτ, Bk,ψτ, Bk,θτ, Bk,ϕτ, а на выходах блоков 17, 25, 33, 45, 54, 63 - соответственно, сигналы Ak,xτ2, Ak,yτ2, Ak,zτ2, Akψτ2, Ak,θτ2, Ak,ϕτ2.
Все положительные входы сумматоров 18, 26, 34, 46, 55, 64 имеют единичные коэффициенты усиления. В результате на выходах этих сумматоров формируются, соответственно, сигналы (Ak,хτ2+Bk,хτ+Ck,x), (Ak,yτ2+Bk,yτ+Ck,y), (Ak,zτ2+Bk,zτ+Ck,z), (Ak,ψτ2+Bk,ψτ+Ck,ψ), (Ak,θτ2+Bk,θτ +Ck,θ), (Ak,ϕτ2+Bk,ϕτ+Ck,ϕ), а на выходах блоков 20, 28, 36, 48, 57, 66 - соответственно, сигналы (Ak,xτ3+Bk,xτ2+Ck,xτ), (Ak,yτ3+Bk,yτ2+Ck,yτ), (Ak,zτ3+Bk,zτ2+Ck,zτ), (Ak,ψτ3+Bk,ψτ2+Ck,ψτ), (Ak,θτ3+Bk,θτ2+Ckθτ), (Ak,ϕτ3+Bk,ϕτ2+Ck,ϕτ).
Положительные входы сумматоров 15, 23, 31, 43, 52, 61 имеют коэффициенты усиления 1, поэтому на входах первой 2, второй 3, третьей 4, четвертой 49, пятой 58 и шестой 67 следящих систем, соответственно, формируются сигналы х*=Ak,xτ3+Bk,xτ2+Ck,xτ+Dk,x, у*=Ak,yτ3+Bk,yτ2+Ck,yτ+Dk,y, z*=Ak,zτ3+Bk,zτ2+Ck,zτ+Dk,z, ψ*=Ak;ψτ3+Bk,ψτ2+Ck,ψτ+Dk,ψ, θ*=Ak,θτ3+Bk,θτ2+Ck,θτ+Dk,θ, ϕ*=Ak,ϕτ3+Bk,ϕτ2+Ck,ϕτ+Dk,ϕ.
Первые (со стороны блоков 17, 25 и 33), вторые (со стороны сумматоров 13, 21 и 29), и третьи положительные входы сумматоров 5, 9 и 11 имеют коэффициенты усиления, равные 3, 1 и 2, соответственно. В результате на выходах этих сумматоров, соответственно, формируются сигналы Fx(τ)=3Ak,xτ2+2Bk,xτ+Ck,x, Fy(τ)=3Ak,yτ2+2Bk,yτ+Ck,y, Fz(τ)=3Ak,zτ2+2Bk,zτ+Ck,z, которые через квадраторы 6, 8, 10 поступают, соответственно, на положительные входы сумматора 7, имеющего единичные коэффициенты усиления. В результате на выходе этого сумматора формируется сигнал
Figure 00000006
Задатчик 38 формирует сигнал vd, поэтому на выходе блока 37 формируется сигнал
Figure 00000007
Траекторию движения программной точки для управляемого объекта, состоящую из К сплайнов Безье, можно описать параметрическими полиномами третьей степени (см. Rogers D.F., Adams J.A. Mathematical elements for computer graphics. - McGraw-Hill, 1976. - 239 p.)
Figure 00000008
где Ak,x, Ak,y, Bk,x, Bk,y, Bk,z, Ck,x, Ck,y, Ck,z, Dk;x, Dk,y, Dk,z - коэффициенты при соответствующих степенях параметра τ∈[0,1], изменяющегося во времени и определяющего положение программной точки, перемещающейся по k-ому сплайну Безье от его начала (при τ=0) до конца (при τ=1) со скоростью, однозначно определяемой только скоростью изменения параметра τ.
Для перемещения программной точки вдоль траектории (2) с желаемой скоростью vd необходимо определить ее зависимость от
Figure 00000009
которую можно получить, продифференцировав уравнение (2) по времени
Figure 00000010
где Fx(τ)=dx*(τ)/dτ=(3Ak,хτ2+2Bk,хτ+Ck,x),
Fy(τ)=dy*(τ)/dτ=(3Ak,yτ2+2Bk,yτ+Ck,y),
Fz(τ)=dz*(τ)/dτ=(3Ak,zτ2+2Bk,zτ+Ck,z).
Учитывая, что
Figure 00000011
можно записать
Figure 00000012
а в итоге получить закон формирования
Figure 00000013
с учетом желаемого значения vd в виде выражения (1).
Закон изменения пространственной ориентации объекта управления при его перемещении по сплайнам Безье при известном τ имеет вид:
Figure 00000014
где Ak,ψ, Ak,θ, Ak,ϕ, Bk,ψ, Bk,θ, Bk,ϕ, Ck,ψ, Ck,θ, Ck,ϕ, Dk,ψ, Dkθ, Dk,ϕ - коэффициенты при соответствующих степенях параметра τ∈[0,1] k-го сплайна Безье.
В результате отработки с заданным качеством типовыми следящими системами 2-4, 49, 58, 67 сформированных программных входных воздействий x*, y*, z*, ψ*, θ*, ϕ*, соответственно, обеспечивает точное перемещение объекта управления по задаваемым сплайнами траекториям с заданной ориентацией.
Таким образом, за счет введения дополнительных элементов и новых связей между ними удалось создать новое устройство, обеспечивающее не только точное перемещение объектов вдоль траекторий, задаваемых параметрическими сплайнами, со скоростью vd, которая в процессе движения указанных объектов может целенаправленно изменяться в зависимости от выполнения конкретных задач производственного цикла или миссий, но и обеспечивать их заданную ориентацию в пространстве при этих перемещениях.
Практическая реализация предлагаемого устройства не вызывает затруднений, так как в нем использованы только типовые электронные элементы.

Claims (1)

  1. Устройство формирования программных сигналов управления, содержащее навигационную систему, первую, вторую и третью следящие системы управления, последовательно соединенные первый сумматор, первый квадратор, второй сумматор, второй вход которого через второй квадратор подключен к выходу третьего сумматора, а третий вход через третий квадратор - к выходу четвертого сумматора, и блок извлечения квадратного корня, последовательно соединенные пятый сумматор, первый вход которого подключен к первому выходу навигационной системы, к первому входу шестого сумматора и к первому входу седьмого сумматора, а второй вход - ко второму выходу навигационной системы и ко второму входу шестого сумматора, восьмой сумматор, второй вход которого подключен к третьему выходу навигационной системы и к третьему входу шестого сумматора, а третий вход - к четвертому выходу навигационной системы, первый блок умножения, выход которого подключен к первому входу первого сумматора, девятый сумматор, второй вход которого подключен ко второму входу первого сумматора и к выходу пятого сумматора, а третий - к третьему входу первого сумматора и выходу второго блока умножения, третий блок умножения, выход которого подключен ко второму входу седьмого сумматора, соединенного выходом со входом первой следящей системы, последовательно соединенные десятый сумматор, первый вход которого подключен к пятому выходу навигационной системы и первым входам одиннадцатого и двенадцатого сумматоров, а второй вход - к шестому выходу навигационной системы и второму входу одиннадцатого сумматора, тринадцатый сумматор, второй вход которого подключен к седьмому выходу навигационной системы и третьему входу одиннадцатого сумматора, а третий вход - к восьмому выходу навигационной системы, четвертый блок умножения, выход которого подключен к первому входу третьего сумматора, четырнадцатый сумматор, второй вход которого подключен ко второму входу третьего сумматора и к выходу десятого сумматора, а третий вход - к третьему входу третьего сумматора и к выходу пятого блока умножения, и шестой блок умножения, подключенный выходом ко второму входу двенадцатого сумматора, выход которого подключен ко входу второй следящей системы, последовательно соединенные пятнадцатый сумматор, первый вход которого подключен к девятому выходу навигационной системы, к первому входу шестнадцатого сумматора и к первому входу семнадцатого сумматора, а второй вход - к десятому выходу навигационной системы и к второму входу шестнадцатого сумматора, восемнадцатый сумматор, второй вход которого соединен с одиннадцатым выходом навигационной системы и третьим входом шестнадцатого сумматора, а третий вход - с двенадцатым выходом навигационной системы, седьмой блок умножения, выход которого подключен к первому входу четвертого сумматора, девятнадцатый сумматор, второй вход которого подключен ко второму входу четвертого сумматора и к выходу пятнадцатого сумматора, а третий вход - к третьему входу четвертого сумматора и к выходу восьмого блока умножения, девятый блок умножения, выход которого подключен ко второму входу семнадцатого сумматора, подключенного выходом к входу третьей следящей системы, последовательно соединенные блок деления, вход делителя которого подключен к выходу блока извлечения квадратного корня, а вход делимого - к выходу задатчика сигнала, интегратор и четвертый квадратор, вход которого подключен также ко вторым входам третьего, шестого и девятого блоков умножения и к первым входам второго, пятого и восьмого блоков умножения, вторые входы которых подключены соответственно к выходам шестого, одиннадцатого и шестнадцатого сумматоров, а выход четвертого квадратора подключен ко вторым входам первого, четвертого и седьмого блоков умножения, отличающееся тем, что в него дополнительно введены последовательно соединенные двадцатый сумматор, первый вход которого подключен к тринадцатому выходу навигационной системы, первому входу двадцать первого сумматора и первому входу двадцать второго сумматора, а второй вход - к четырнадцатому выходу навигационной системы и второму входу двадцать первого сумматора, двадцать третий сумматор, второй вход которого соединен с пятнадцатым выходом навигационной системы и третьим входом двадцать первого сумматора, а третий вход - с шестнадцатым выходом навигационной системы, десятый блок умножения, двадцать четвертый сумматор, второй вход которого подключен к выходу двадцатого сумматора, а третий вход - к выходу одиннадцатого блока умножения, двенадцатый блок умножения, выход которого подключен ко второму входу двадцать второго сумматора, подключенного выходом к входу четвертой следящей системы, последовательно соединенные двадцать пятый сумматор, первый вход которого подключен к семнадцатому выходу навигационной системы, к первому входу двадцать шестого сумматора и к первому входу двадцать седьмого сумматора, а второй вход - к восемнадцатому выходу навигационной системы и к второму входу двадцать шестого сумматора, двадцать восьмой сумматор, второй вход которого соединен с девятнадцатым выходом навигационной системы и третьим входом двадцать шестого сумматора, а третий вход - с двадцатым выходом навигационной системы, тринадцатый блок умножения, двадцать девятый сумматор, второй вход которого подключен к выходу двадцать пятого сумматора, а третий вход - к выходу четырнадцатого блока умножения, пятнадцатый блок умножения, выход которого подключен ко второму входу двадцать седьмого сумматора, подключенного выходом к входу пятой следящей системы, последовательно соединенные тридцатый сумматор, первый вход которого подключен к двадцать первому выходу навигационной системы, первому входу тридцать первого сумматора и первому входу тридцать второго сумматора, а второй вход - к двадцать второму выходу навигационной системы второму входу тридцать первого сумматора, тридцать третий сумматор, второй вход которого соединен с двадцать третьим выходом навигационной системы и третьим входом тридцать первого сумматора, а третий вход - с двадцать четвертым выходом навигационной системы, шестнадцатый блок умножения, второй вход которого подключен ко вторым входам десятого и тринадцатого блоков умножения, а также к выходу четвертого квадратора, тридцать четвертый сумматор, второй вход которого подключен к выходу тридцатого сумматора, а третий вход - к выходу семнадцатого блока умножения, восемнадцатый блок умножения, второй вход которого подключен к выходу интегратора, ко вторым входам двенадцатого и пятнадцатого блоков умножения и к первым входам одиннадцатого, четырнадцатого и семнадцатого блоков умножения, вторые входы которых подключены соответственно к выходам двадцать первого, двадцать шестого и тридцать первого сумматоров, а выход - ко второму входу тридцать второго сумматора, подключенного выходом ко входу шестой следящей системы.
RU2019141719A 2019-12-12 2019-12-12 Устройство формирования программных сигналов управления RU2731741C1 (ru)

Priority Applications (1)

Application Number Priority Date Filing Date Title
RU2019141719A RU2731741C1 (ru) 2019-12-12 2019-12-12 Устройство формирования программных сигналов управления

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
RU2019141719A RU2731741C1 (ru) 2019-12-12 2019-12-12 Устройство формирования программных сигналов управления

Publications (1)

Publication Number Publication Date
RU2731741C1 true RU2731741C1 (ru) 2020-09-08

Family

ID=72421910

Family Applications (1)

Application Number Title Priority Date Filing Date
RU2019141719A RU2731741C1 (ru) 2019-12-12 2019-12-12 Устройство формирования программных сигналов управления

Country Status (1)

Country Link
RU (1) RU2731741C1 (ru)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS61229102A (ja) * 1985-04-03 1986-10-13 Hironobu Sato 自動制御装置
WO2009055123A1 (en) * 2007-10-21 2009-04-30 Ge Fanuc Automation North America, Inc. Method and system for meeting end conditions in a motion control system
RU2453891C1 (ru) * 2010-11-30 2012-06-20 Учреждение Российской академии наук Институт автоматики и процессов управления Дальневосточного отделения РАН (ИАПУ ДВО РАН) Устройство формирования программных сигналов управления
RU2522856C1 (ru) * 2013-06-07 2014-07-20 Федеральное Государственное Автономное Образовательное Учреждение Высшего Профессионального Образования "Дальневосточный Федеральный Университет" (Двфу) Устройство для формирования программных сигналов управления пространственным движением динамических объектов
RU2626437C1 (ru) * 2016-04-04 2017-07-27 Федеральное государственное бюджетное учреждение науки Институт автоматики и процессов управления Дальневосточного отделения Российской академии наук (ИАПУ ДВО РАН) Устройство формирования программных сигналов управления

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS61229102A (ja) * 1985-04-03 1986-10-13 Hironobu Sato 自動制御装置
WO2009055123A1 (en) * 2007-10-21 2009-04-30 Ge Fanuc Automation North America, Inc. Method and system for meeting end conditions in a motion control system
RU2453891C1 (ru) * 2010-11-30 2012-06-20 Учреждение Российской академии наук Институт автоматики и процессов управления Дальневосточного отделения РАН (ИАПУ ДВО РАН) Устройство формирования программных сигналов управления
RU2522856C1 (ru) * 2013-06-07 2014-07-20 Федеральное Государственное Автономное Образовательное Учреждение Высшего Профессионального Образования "Дальневосточный Федеральный Университет" (Двфу) Устройство для формирования программных сигналов управления пространственным движением динамических объектов
RU2626437C1 (ru) * 2016-04-04 2017-07-27 Федеральное государственное бюджетное учреждение науки Институт автоматики и процессов управления Дальневосточного отделения Российской академии наук (ИАПУ ДВО РАН) Устройство формирования программных сигналов управления

Similar Documents

Publication Publication Date Title
Gao et al. Online safe trajectory generation for quadrotors using fast marching method and bernstein basis polynomial
CN108189036B (zh) 力矩控制方法、装置、机器人及存储介质
EP2188685B1 (en) Inverse kinematics
WO2019184179A1 (zh) 控制自主式移动机器移动的方法、装置、机器及存储介质
Filaretov et al. The formation of motion laws for mechatronics objects along the paths with the desired speed
CN105353725A (zh) 用于工业机器人的过辅助点姿态空间圆弧插补方法
CN103176409A (zh) 一种快速准确实现混凝土泵车臂架运动轨迹的方法
CN107844058A (zh) 一种运动曲线离散动态规划方法
CN106406098A (zh) 一种机器人系统在未知环境下的人机交互控制方法
CN115047763B (zh) 一种多无人机系统的最小能量控制方法
RU2731741C1 (ru) Устройство формирования программных сигналов управления
Burlacu et al. Predictive control architecture for real-time image moments based servoing of robot manipulators
CN109857108A (zh) 基于内模控制算法的移动机器人轨迹跟踪方法及系统
CN104369875B (zh) 基于非线性轨道计算的航天器制导控制方法及系统
CN110716451B (zh) 一种基于实时操作系统和fpga的仿真转台前馈控制方法
CN103294522A (zh) 舰船雷达天线设备数值风洞仿真流程的简化方案
RU2626437C1 (ru) Устройство формирования программных сигналов управления
RU2523187C1 (ru) Устройство для формирования программных сигналов управления пространственным движением динамических объектов
CN110879614A (zh) 无人机速度规划方法
CN115589528A (zh) 一种移动目标跟踪方法及相关装置
RU2453891C1 (ru) Устройство формирования программных сигналов управления
Copot et al. Visual predictive control architecture based on image moments for manipulator robots
RU2523186C1 (ru) Устройство для формирования программных сигналов управления пространственным движением динамических объектов
RU2522856C1 (ru) Устройство для формирования программных сигналов управления пространственным движением динамических объектов
CN108427269A (zh) 无人机高度控制方法、油门计算模块及无人机