Научная статья на тему 'Система управления автономного робота на основе метода обратных задач динамики'

Система управления автономного робота на основе метода обратных задач динамики Текст научной статьи по специальности «Электротехника, электронная техника, информационные технологии»

CC BY
248
34
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
ПЕЛЕНГАЦИЯ / АКУСТИЧЕСКИЙ СИГНАЛ / АВТОНОМНЫЙ РОБОТ / ОБРАТНАЯ ЗАДАЧА ДИНАМИКИ / РЕГУЛЯТОР С ДВОЙ-НЫМ ДИФФЕРЕНЦИРОВАНИЕМ / ЭТАЛОННАЯ МОДЕЛЬ / АДАПТИВНАЯ СИСТЕМА УПРАВЛЕНИЯ РОБОТОМ / BEARING / ACOUSTIC SIGNAL / AUTONOMOUS ROBOT / INVERSE DYNAMICS PROBLEM / DOUBLE DIFFERENTIATION CONTROLLER / REFERENCE MODEL / ADAPTIVE ROBOT CONTROL SYSTEM

Аннотация научной статьи по электротехнике, электронной технике, информационным технологиям, автор научной работы — Антошкин С. Б., Баканов М. В., Сизых В. Н.

В статье рассматривается алгоритм ориентации транспортных роботов по акустическому сигналу стационарного маяка или маяка, ведущего транспортное средство. Выделены особенности фильтрации сигнала для извест-ных способов пеленгации. Проанализирован пеленг сигнала при наличии шумов. Разработан и смоделирован алгоритм для одно-временного устранения неоднозначности и минимизации погрешностей измерения пеленга. Проанализированы результаты моделирования. Данный алгоритм может быть реализован на относительно несложном и недорогом микропроцессоре. При применении системы как минимум трех маяков возможна модернизация алгоритма для определения координат ведущего ро-бота в рабочем пространстве. Для решения задачи управления ведомым роботом разработана его нелинейная математиче-ская модель, которая реализована в среде программирования MATLAB / Simulink. На основе принципа динамической компенса-ции обосновывается методика построения пропорциональных с двойным дифференцированием регуляторов ведомого авто-номного робота. Законы управления колесной парой синтезированы на основе эталонных моделей по простой градиентной схеме метода обратных задач динамики в формулировке П. Д. Крутько для задачи стабилизации (гашения) угловых скоростей движения трехколесного мобильного робота. Разработана имитационная модель управления, включающая блок углового по-ложения и траекторного движения робота, многомерную многосвязную математическую модель углового движения робота, блок регулятора на основе эталонных моделей. Разработана «Simulink-модель» движения ведомого робота за ведущим, вы-полнен анализ результатов моделирования.

i Надоели баннеры? Вы всегда можете отключить рекламу.

Похожие темы научных работ по электротехнике, электронной технике, информационным технологиям , автор научной работы — Антошкин С. Б., Баканов М. В., Сизых В. Н.

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.
i Надоели баннеры? Вы всегда можете отключить рекламу.

AN AUTONOMOUS ROBOT CONTROL SYSTEM BASED ON AN INVERSE PROBLEMS METHOD IN DYNAMICS

The article discusses the algorithm of orientation of transport robots according to the acoustic signal of a stationary beacon or beacon of a leading vehicle. Signal filtering features for known bearing methods are identified. Signal bearing is analyzed in the presence of noise. An algorithm is given to simultaneously eliminate ambiguity and minimize errors of the acoustic signal bearing. An algorithm was developed and modeled to simultaneously eliminate ambiguity and minimize bearing measurement errors. Simulation results are analyzed. This algorithm can be implemented with a relatively simple and inexpensive microprocessor. When using a system of at least three beacons, it is possible to upgrade the algorithm to determine the coordinates of the lead robot in the working space. To solve the problem of controlling the slave robot, its non-linear mathematical model has been developed, which is implemented in the MATLAB / Simulink programming environment. The method of building proportional regulators with double differentiation (PDD) for a slave autonomous robot is justified on the basis of the dynamic compensation principle. The laws of wheelset control are synthesized on the basis of reference models according to a simple gradient scheme of the method of inverse problems of dynamics in the formulation of P. D. Krut'ko for the problem of stabilizing (damping) the angular velocities of a three-wheeled mobile robot. A simulation control model has been developed, including a block of angular position and trajectory movement of the robot, a multidimensional multiply connected mathematical model of angular motion of the robot, a PDD regulator unit based on reference models. A Simulink model of the slave robot moving behind the master robot has been developed. The analysis of the simulation results has been performed.

Текст научной работы на тему «Система управления автономного робота на основе метода обратных задач динамики»

Modern technologies. System analysis. Modeling, 2019, Vol. 62, No. 2

11. Pogodin V.K. et al. Opredelenie trebuemykh silovykh vozdeistvii dlya obespecheniya germetichnosti v truboprovodnoi armature na vysokie parametry [The determination of the required power effects to ensure tightness in pipeline fittings for high parameters]. Sis-temy. Metody. Tekhnologii [Systems. Methods. Technologies], 2013. No. 3 (19). Pp.76-83.

12. Pogodin V.K., Ogar P.M., Vainapel' Yu.L. Eksperimental'naya otsenka bezopasnogo resursa raboty zatvornogo uzla truboprovodnoi armatury po kriteriyu germetichnosti [Experimental assessment of the safe service life of the valve assembly of the pipeline fittings by the tightness criterion]. Sistemy. Metody. Tekhnologii [Systems. Methods. Technologies], 2014. No. 1 (21). Pp. 33-37.

13. Livshits V.I. Issledovanie i razrabotka norm rascheta i konstruirovaniya del'ta-zatvora dlya sosudov vysokogo davleniya : dis. ... kand. tekhn. nauk [Research and development of standards for the calculation and designing of the delta-gate for high-pressure vessels: a Ph.D. (Engineering) diss.]. Moscow: 1975, 168 p.

14. Pogodin V. K. Zapornye klapany na vysokie parametry ekspluatatsii. Issledovanie i proektirovanie [Shut-off valves for high parameters of operation. Research and designing]. Bratsk: BrGU Publ., 2016. 362 p.

15. Dolotov A.M., Gozbenko V.E., Belogolov Yu.I. Uplotnitel'nye soedineniya s ispol'zovaniem tonkostennykh elementov [Sealing joints using thin-walled elements]. Irkutsk, 2011. Dep. v VINITI 22.11.2011, No. 508-V2011.

16. Gozbenko V.E., Kargapoltsev S.K., Minaev N.V., Karlina A.I. Simulation of the vibration of the carriage asymmetric parameters in Mathcad. International Journal of Applied Engineering Research, 2016. Vol. 11. No. 23. Pp. 11132-11136.

17. Birger I.A. Iosilevich G.V. Rez'bovye i flantsevye soedineniya [Threaded and flanged connections]. Moscow: Mashinostroenie Publ., 1990. 365 p.

18. Klyus V.P. Issledovanie osevoi zatyazhki krepezhnykh detalei zatvorov agregatov khimicheskikh proizvodstv: dis. ... kand. tekhn. nauk [Research of axial tightening of fasteners for valves in chemical industry: a Ph.D. (Engineering) diss.]. Moscow, 1980. 212 p.

Информация об авторах

Authors

Погодин Валерий Константинович - д. т. н., профессор, АО ИркутскНИИхиммаш, г. Иркутск, e-mail: v.pogodin@himmash.ru

Белоголов Юрий Игоревич - к. т. н., доцент кафедры управление эксплуатационной работой, Иркутский государственный университет путей сообщения, г. Иркутск, e-mail: pr-mech@mail.ru

Valerii Konstantinovich Pogodin - Doctor of Engineering Science, Professor, JSC IrkutskNIIkhimmash, Irkutsk, e-mail: v.pogodin@himmash.ru

Yurii Igorevich Belogolov - Ph.D. in Engineering Science, Associate Professor at the Subdepartment of Management of Operational Work, Irkutsk State Transport University, Irkutsk, e-mail: pr-mech@mail.ru

Для цитирования

For citation

Погодин В. К. Расчет усилия герметизации запорных клапанов / В. К. Погодин, Ю. И. Белоголов // Современные технологии. Системный анализ. Моделирование. - 2019. - Т. 62, № 2. - С. 8-15. - DOI: 10.26731/1813-9108.2019.2(62).8-15

Pogodin V. K., Belogolov Yu. I. Raschet usilii germetizatsii za-pornykh klapanov [Calculation of sealing pressures of shut-off valves]. Sovremennye tekhnologii. Sistemnyi analiz. Modelirovanie [Modern Technologies. System Analysis. Modeling], 2019. Vol. 62, No. 2, pp.8-15. DOI: 10.26731/1813-9108.2019.2(62).8-15

УДК 681.5 БОГ: 10.26731/1813-9108.2019.2(62).15-23

С. Б. Антошкин, М. В. Баканов, В. Н. Сизых

Иркутский государственный университет путей сообщения, г. Иркутск, Российская Федерация Дата поступления: 18 марта 2019 г.

СИСТЕМА УПРАВЛЕНИЯ АВТОНОМНОГО РОБОТА НА ОСНОВЕ МЕТОДА ОБРАТНЫХ ЗАДАЧ ДИНАМИКИ

Аннотация. В статье рассматривается алгоритм ориентации транспортных роботов по акустическому сигналу стационарного маяка или маяка, ведущего транспортное средство. Выделены особенности фильтрации сигнала для известных способов пеленгации. Проанализирован пеленг сигнала при наличии шумов. Разработан и смоделирован алгоритм для одновременного устранения неоднозначности и минимизации погрешностей измерения пеленга. Проанализированы результаты моделирования. Данный алгоритм может быть реализован на относительно несложном и недорогом микропроцессоре. При применении системы как минимум трех маяков возможна модернизация алгоритма для определения координат ведущего робота в рабочем пространстве. Для решения задачи управления ведомым роботом разработана его нелинейная математическая модель, которая реализована в среде программирования MATLAB / Simulink. На основе принципа динамической компенсации обосновывается методика построения пропорциональных с двойным дифференцированием регуляторов ведомого автономного робота. Законы управления колесной парой синтезированы на основе эталонных моделей по простой градиентной схеме метода обратных задач динамики в формулировке П. Д. Крутько для задачи стабилизации (гашения) угловых скоростей движения трехколесного мобильного робота. Разработана имитационная модель управления, включающая блок углового положения и траекторного движения робота, многомерную многосвязную математическую модель углового движения робота, блок регулятора на основе эталонных моделей. Разработана «Simulink-модель» движения ведомого робота за ведущим, выполнен анализ результатов моделирования.

© С. Б. Антошкин, М. В. Баканов, В. Н. Сизых, 2019

15

ИРКУТСКИЙ ГОСУДАРСТВЕННЫЙ УНИВЕРСИТЕТ ПУТЕЙ СООБЩЕНИЯ

Современные технологии. Системный анализ. Моделирование № 2 (62) 2019

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

S. B. Antoshkin, M. V. Bakanov, V. N. Sizykh

Irkutsk State Transport University, Irkutsk, the Russian Federation Received: March 18, 2019

AN AUTONOMOUS ROBOT CONTROL SYSTEM BASED ON AN INVERSE PROBLEMS METHOD IN DYNAMICS

Abstract. The article discusses the algorithm of orientation of transport robots according to the acoustic signal of a stationary beacon or beacon of a leading vehicle. Signal filtering features for known bearing methods are identified. Signal bearing is analyzed in the presence of noise. An algorithm is given to simultaneously eliminate ambiguity and minimize errors of the acoustic signal bearing. An algorithm was developed and modeled to simultaneously eliminate ambiguity and minimize bearing measurement errors. Simulation results are analyzed. This algorithm can be implemented with a relatively simple and inexpensive microprocessor. When using a system of at least three beacons, it is possible to upgrade the algorithm to determine the coordinates of the lead robot in the working space. To solve the problem of controlling the slave robot, its non-linear mathematical model has been developed, which is implemented in the MATLAB / Simulink programming environment. The method of building proportional regulators with double differentiation (PDD) for a slave autonomous robot is justified on the basis of the dynamic compensation principle. The laws of wheelset control are synthesized on the basis of reference models according to a simple gradient scheme of the method of inverse problems of dynamics in the formulation of P. D. Krut'ko for the problem of stabilizing (damping) the angular velocities of a three-wheeled mobile robot. A simulation control model has been developed, including a block of angular position and trajectory movement of the robot, a multidimensional multiply connected mathematical model of angular motion of the robot, a PDD regulator unit based on reference models. A Simulink model of the slave robot moving behind the master robot has been developed. The analysis of the simulation results has been performed.

Keywords: bearing, acoustic signal, autonomous robot, inverse dynamics problem, double differentiation controller, reference model, adaptive robot control system.

Алгоритм пеленгации акустического

маяка для транспортных роботов

В настоящее время получают распространение ведомые роботизированные транспортные средства доставки груза, следующие за ведущим устройством или определяющие место нахождения по опорным маячкам [1]. Для определения направления на ведущее устройство обычно устанавливается оптическая система, однако в случае малопрозрачной среды (туман, дым в воздухе или замутнение в водной среде) ориентация на оптический маячок ведущего будет осложняться или даже станет невозможной. Для определения направления в таких случаях применяются акустические сигналы [2, 3].

Известны амплитудный, фазовый и корреляционный способы пеленгации источника электромагнитного или акустического сигнала [4]. Амплитудный способ акустической пеленгации требует сенсора со сканирующей диаграммой направленности на ведомом роботе и обладает низкой помехоустойчивостью к акустическим шумам. [5] Фазовый способ требует применения гармонического сигнала или пакетов с гармоническим заполнением, но позволяет с минимальными аппаратными затратами отфильтровывать полезный сигнал и определять направление. Корреляционный способ обладает высокой помехоустой-

чивостью, но требует более сложной обработки сигнала. Как в фазовом, так и корреляционном способе для определения направления на источник сигнала требуется минимум три сенсора с целью устранения неоднозначности пеленга (рис. 1).

Рис. 1. Схема расположения сенсоров акустического пеленгатора

Сенсоры 8о - 82 образуют две взаимно перпендикулярные базы пеленгатора 8о - 81 и 8о - 82 с одинаковой измерительной базой Ь, что делает расчеты более простыми. Акустический сигнал приходит под углом а относительно оси пеленгатора 8о - X. Линия АВ, проходящая через сенсор 8о, совпадающая с центром координат пеленгатора, в определенный момент времени ¿о сходится с фронтом акустического сигнала. Относительные задержки прихода фронта сигнала до сенсоров 81 и 82 определяются следующими выражениями:

Modern technologies. System analysis. Modeling, 2019, Vol. 62, No. 2

L ■

A^ = tx -10 = — sim, L

At2 = t2 -t0 = — cosa,

(1)

где и (2 - моменты прихода фронта к соответствующим сенсорам, С - скорость звука в среде (~ 330 м/с для воздуха и 1 440 м/с для воды).

Таким образом, азимут источника сигнала определяется по относительным задержкам

а = агс81и| — Д^ | (2)

или

а = arccoS — At

L

C

(3)

Пределы Знак

а Ati At2

0..ж/ 2 + +

%/ 2..ж + -

-%..-%/ 2 - -

-л/ 2..0 - +

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

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

Так как при измерении задержек неизбежны погрешности, то следует учитывать, что при вычислении обратных тригонометрических функций результат будет иметь максимальную погрешность при абсолютных значениях аргумента, близких к единице (0,8-1). Предлагается выбирать (2) или (3) из сравнения абсолютных величин |Д^| и |Д2|.

Т а б л и ц а 1

Для одновременного устранения неоднозначности и минимизации погрешностей измерения пеленга разработан алгоритм (рис. 2). Величина Kb в алгоритме - нормализующий множитель, зависящий от скорости звука, измерительной базы и разрядности оцифровки At, рассчитывается так, чтобы аргумент функций (2) и (3) не выходил за пределы ± 1 с учетом погрешностей измерений.

По сравнительной оценке, абсолютной величины временных задержек ti и t2 выбирается требуемая обратная тригонометрическая функция и задается бит 2 флага (Flag), применяемого для определения октанта (1/8 полного круга) прихода сигнала. Знаки задержек, если требуется, устанавливают биты 0 и 1 флага (соответственно для правой - левой и верхней - нижней полуплоскостей). В зависимости от значения битов флага рассчиты-

Рис. 2. Алгоритм расчета пеленга акустического сигнала

Динамическая модель ведомого мобильного робота

Рассмотрим трехколесный мобильный робот с двумя независимыми ведущими колесами. Считаем, что колеса движутся без проскальзывания, поэтому вращающий момент т может быть определен через силу ^ = хг- / Р относительно радиуса р двух ведущих колес [5].

2

ИРКУТСКИЙ ГОСУДАРСТВЕННЫЙ УНИВЕРСИТЕТ ПУТЕЙ СООБЩЕНИЯ

Современные технологии. Системный анализ. Моделирование № 2 (62) 2019

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

Нелинейная математическая модель робота имеет вид [6]:

х = Vcosф, у = Vsmф, ф = ш, (4)

1

У = —(тк + ть), рт

1

где х, у, ф - обобщенные линейные и угловые координаты положения платформы; V, ш - линейная и угловая скорости перемещения платформы; m -масса; р - радиус двух ведущих колес; ]с - момент инерции платформы относительно центра масс; TR, ть - электромагнитные моменты, развиваемые электродвигателями (ЭД).

Уравнения движения робота (4) дополняются уравнениями динамики следящих приводов: х = ^оэф,

у = Vsinф,

ф = ю,

= — (т я + т - ),

(5)

рт

ю = (тя -т7 ),

2рЗ с

Я

т - =- 7т --

Я

т„ =--т

я 7

КмКш*

Р7

КМКШ1

V -

р

ю1 )+ км

т , ) 7

ю1Л |+ Км

~2 , ) 7

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

иТ.,

ик,

где Я, Ь — активное сопротивление и индуктивность в цепи якоря; и, I — напряжение питания и ток в обмотке якоря; 1р — передаточные числа редукторов; Км, Кш - конструктивные постоянные ЭД по электромагнитному моменту и угловой скорости; I - расстояние между колесами.

Модель динамики (5) представляет собой систему нелинейных дифференциальных уравнений седьмого порядка с фазовым вектором (х,уУ,ф,ю,ть ,тк) и вектором управления (и ,ид), и непосредственно используется при синтезе законов управления мобильным роботом. Однако при этом необходимы другие формы представления его математической модели [7-9]. Алгоритмы управления мобильным роботом по методу обратных задач динамики

Так как в системе уравнений (5) первые три уравнения представляют собой уравнения связи,

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

Через дифференцирование шестого и седьмого уравнений в системе (5) и после подстановки в них четвертого и пятого уравнений получим

Г

1

1

2 Л

а,.

+

а

1

1

рт 4р/с

(

рт 4р/с

2 Л

Т7 = Ь11иь

а

1

1

2 Л

+

1

а

рт 4р/

рт 4рJ су

12 ^

= Я

(6)

Здесь обозначены Я

с

КМКШ1р

Ь = Км Ь11

11 7 12 р7 11 7 иь, ип — управляющие воздействия (скорости изменения напряжения питания).

Далее представлены конструктивные параметры мобильного робота (табл. 2).

При синтезе законов управления по методу обратных задач динамики [12-14] математическая модель

робота (6) принимается за объект управления.

В матричном виде система уравнений (6) принимает вид

Х + СХ + ВХ = Ви, (7)

где X = (т£ ,тд) — вектор состояния (электромагнитных моментов); и = (Ц-,&к) — вектор управляющих воздействий;

с =

В =

а11 0

0 а11

"Ьц 0

0 Ьц

= &ае{а11

= Ш^{Ь11 ,Ьц}

диагональные матрицы;

1 12

Б =

рт 1

4/с

12

1

рт 1

12

4/с

12

рт 4р/с рт 4р/с — симметрическая матрица (в= ВТ).

В скалярной форме система уравнений (7) принимает вид

+ ацть + йцть + й12Тк = Ьц01

тк + ацТк + йцТв + ^2ТЬ = Ьцик Анализ уравнений (7) и (8) показывает, что мобильный робот как объект управления является многосвязной (т = 2) и многомерной (п = 2) системой.

Т7 + а11Т7 +

Т Я +

ТЯ + а11т Я +

Т Я +

а

12

оо оо I

Modern technologies. System analysis. Modeling, 2019, Vol. 62, No. 2

Задача синтеза управлений для стабилизации [10] (гашения) угловых скоростей робота на интервале времени [^, ^ ] (^ - нефиксированная

величина) формулируется следующим образом: пусть в текущий момент времени t = ^ = 0 состояние управляемой по моментам Т=Т, т2 = тк системы (6) определяется значениями Т(0) = тг0, г = 1,2.

Необходимо определить управляющие воздействия и{(ц = иь, Ц = Цг), при которых система

(6) переходит из состояния тг0 в новое состояние

Т г зад , где Т зад = Т зад (1) ~~ зЗДанные моменТЫ вращения [11]. Необходимо чтобы вращающиеся моменты управляемого движения по каждой степени свободы с требуемой точностью следовали за моментами, определяемыми эталонной моделью

Хэтг + С1Х31г + Ц,ХЗТг = Цт,зап , г = 1,2, (9)

с вычисленными ранее коэффициентами С, и В,.

Заданное изменение напряжения питания на зажимах обмотки якоря правого и левого ЭД определяет заданное эталонное движение

»¿¿¿зад = 0^,1 = 1,23 (10) С помощью ШИМ-регулятора осуществляется изменение напряжения питания.

Эталонное движение устойчиво при

Хэтг ^ тгзад, при 1 .

Представим эталонную модель (9) в скалярном виде

1этЬ

+ &11Тэт1 + di 1 t^J — d^-\T

111 этЬ

41 1 Ьзад,

U = —11Т

L зад 1 L зад

bu

U = Т

UR зад , Т R зад Ь11

Через минимизацию функционала с(и)=1?111[Хэт1 -х1(1,иь)]

По схеме градиентного метода определяются законы управления Ц {(х) по каждой степени

свободы вращения колес дЩ(Х)

dt

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

— -ZUn

— Ui(x) —

dG(U)

,rii — const (14)

'¿1 дй} "¿1

Из формул (9), (13) определяются компоненты градиента в (14)

^ = -Ьц(Хэт]- - Х,),] = 1, 2. (15) Отсюда следует, что

Щ (X) = 22=1 г^ЬЦ(Хэт,- - Х}) (16) Требуемый закон управления (регулирования напряжения в цепи обмотки якоря ЭД) определяется через интегрирование по времени обеих частей выражения (16)

V

i(x) — ^ ГцЬц(Хэтj - Xj) 1=1

(17)

Здесь требуемые значения моментов х

вычисляются по формуле (9).

Законы управления (17) колесной парой робота в скалярной форме имеют вид

иь = ГпЪп (тэ^ -Т£ )+ Г12Ь11 (тэт К -тп ) , ЦК = Г21Ъ11 (тэт£ -ТЬ )+ Г22Ъ11 (тэтК -ТК ) ,

а в матричном виде определяют известную процедуру аналитического конструирования регуляторов в форме

и = -ЯВДт, (19)

iэтR + ^1l'tэтR + d11тэтR = dllTRзад. ( )

Из формулы (10) изменение напряжения питания на зажимах обмотки якоря правого и левого колеса в скалярной форме перепишется как

где At =

Тв -т„

вектор изменения моментов,

(12)

= 1[Лэт¿ -л¿(^■,иLJ] (13)

оценивается степень приближения управляемого процесса к эталонной модели хэтг ^) ^ тзад.

Функционал характеризует изменение момента вращения колес мобильного робота в окрестности изменения эталонного момента вращения [15].

развиваемых ЭД; В = diag(Ъп,Ъп), структура матрицы К = у определяется характером перекрестных связей по переменной х в формулах

г г

(16) или (17) К = 11 12 , причем г12 = г21 .

_Г21 Г22 _

Принимается К = К > 0. Тогда о(Ц)< 0 и замкнутая регулятором (17) система (5) асимптотически устойчива по Ляпунову: X . ^ X при t

Конструктивные параметры мобильного робота

Т а б л и ц а 2

Параметр Jc Р m l KW R L 1Р

Единица измерения 2 кг • см м кг м - Ом Гн -

Числовое значение 25-10-5 0,0325 1 0,135 0,0080 0,36 1,23 •Ю-3 55,74

Т L Т эт L

ИРКУТСКИЙ ГОСУДАРСТВЕННЫЙ УНИВЕРСИТЕТ ПУТЕЙ СООБЩЕНИЯ

Современные технологии. Системный анализ. Моделирование № 2 (62) 2019

«Simulink-модель» мобильного робота, по методу обратных задач динамики [16-18]. Име-

синтезированная по методу обратных ется общая структура «8тиНпк-модели» робота

задач динамики (рис. 3). Модель состоит из следующих основных

На основе уравнений (8), (11), (12), (18) со- блоков: ставляется математическая модель системы 1. Блок, реализующий угловое положение и

управления автономного робота, синтезированной траекторное движение робота (рис. 3).

Рис. 3. Общая структура «Simulink-модели» мобильного робота

Тгвп^ЕГ I

Рис. 4. Многомерная математическая модель углового движения робота

Рис. 5. ПДД-регулятор на основе эталонной модели

оо оо I

Modern technologies. System analysis. Modeling, 2019, Vol. 62, No. 2

2. Блок многомерной математической модели углового движения робота (рис. 4).

3. Блок, реализующий регулятор с двойным дифференцированием (ПДД-регулятор) [19, 20], на основе эталонных моделей колесной пары (рис. 5).

Результаты моделирования

Приведены результаты сравнительного анализа определения пеленга сигнала с уровнем шума приблизительно в 5 % (рис. 6). На верхнем графике пеленг определяется только по выражению (2), а на нижнем графике с учетом сравнения абсолютных величин Д | и |Д^ |. Наглядно видно значительное увеличение погрешностей верхнего графика, рассчитанного только по функции arcsin при значениях углов, близких к ± л/2 .

Анализ результатов показывает, что при синтезе системы управления на основе ПДД-регуляторов обеспечивается высокая синхронность отклонения колес колесной пары. Согласно пятой формуле системы (4), угловая скорость в

режиме стабилизации движения робота (ш = 0)

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

Заключение

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

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

БИБЛИОГРАФИЧЕСКИЙ СПИСОК

1. Подураев Ю.В. Основы мехатроники: Учебное пособие. М. : Станкин, 2000. 80с.

2. Воротников С.А. Информационные устройства робототехнических систем. М. : Изд-во МГТУ им. Н.Э. Баумана, 2005. 384 с.

3. Автономные подводные роботы: системы и технологии/ М.Д. Агеев, Л.В. Киселев, Ю.В. Матвиенко и др.; Ин-т проблем морских технологий. М. : Наука. 2005. 398 с.

4. Радиотехнические системы / Ю.П. Гришин, В.П. Ипатов, Ю.М. Казаринов и др. М. : Высш. шк., 1990. 496 с.

5. Сизых В.Н., М.В. Баканов Математическая модель для адаптивного управления трёхколёсным мобильным роботом // Транспортное, горное и строительное машиностроение: наука и производство : материалы междунар. науч.-практ. конф. СПб. : СПбФ НИЦ МС, 2018. № 1. С. 9-18.

6. Методы классической и современной теории автоматического управления. Т.3: Синтез регуляторов систем автоматического управления / под ред. К.А. Пупкова, Н.Д. Егупова. М. : Изд-во МГТУ им. Н.Э. Баумана, 2004. 616 с.

7. Ang A.H., Chong G., Li Y.PID control system analysis, desing and technology / IEEE Trans. on Control Syst. Tech., 2005. Vol. 13. № 4. P. 559-576.

8. Astom K.J., Hagglunk T. Advanced PID control // Instrumentation, Systems and Automation Society, 2006. 406 p.

ИРКУТСКИЙ ГОСУДАРСТВЕННЫЙ УНИВЕРСИТЕТ ПУТЕЙ СООБЩЕНИЯ

Современные технологии. Системный анализ. Моделирование № 2 (62) 2019

9. Quevedo J., Escobet T. Digital control: past, present and future of PID control // Proc. IFACWorkshop. Terassa, Spain, Apr. 5-7, 2000.

10. Булгаков В.В., В.С. Кулабухов Сравнительный анализ формализованных методов синтеза регулятора следящей системы // Приборы. 2013. № 1 (151). С. 39-44.

11. Ким Д.П. Алгебраический метод синтеза линейных непрерывных систем управления // Мехатроника, автоматизация, управление. 2011. № 1. С. 9-15.

12. Ziegler J.G., Nichols N.B. Optimum setting for automatic controllers. // Trans. ASME. 1942. Vol. 64. Р. 759-768.

13. Farhan A.S. New efficient model-based PID design method // European Scientific Journal Edition. 2013. Vol. 9, № 15. P. 181-190.

14. Сизых В.Н., Мухопад А.Ю. Ассоциативный автомат адаптивного управления технологическими процессами на основе нейронных сетей // Науч. вестн. Новосиб. гос. техн. ун-та. 2014. № 1 (54). С. 34-45.

15. Агеев А.М. Сизых В.Н. Синтез оптимальных регуляторов системы управления самолетом через решение обратной задачи АКОР // Науч. вестн. Новосиб. гос. техн. ун-та. 2014. № 3 (56). С. 7-22.

16. Leva A., Cox C., Ruano A. Hands-on PID autotuning: a guide to better utilization - IFAC Professional Brief // International Federation of Automatic Control. URL: http://www.ifac-control.org.

17. Изерман Р. Цифровые системы управления. М. Мир, 1984. 541 с.

18. Методы робастного, нейро-нечеткого и адаптивного управления / под ред. Н.Д. Егупова М. : Изд-во МГТУ им. Баумана, 2002. 744 с.

19. Ротач В.Я. Теория автоматического управления // М. : МЭИ, 2004. 400 с.

20. Сизых В.Н., Баканов М.В. Алгоритмическое обеспечение адаптивной системы управления автономным мобильным роботом // Информационные системы контроля и управления в промышленности и на транспорте : сб. науч. тр. Вып. 27. Иркутск : Изд-во ИрГУПС, 2017. С. 33-47.

REFERENCES

1. Poduraev Yu.V. Osnovy mekhatroniki: Uchebnoe posobie [Fundamentals of Mechatronics: a study guide]. Moscow: Stankin Punl., 2000. 80 p.

2. Vorotnikov S.A. Informatsionnye ustroistva robototekhnicheskikh system [Information devices of robotic systems]. Moscow: Bauman MGTU Publ., 2005. 384 p.

3. Ageev M.D., Kiselev L.V., Matvienko Yu.V. et al.; Avtonomnye podvodnye roboty: sistemy i tekhnologii [Autonomous underwater robots: systems and technologies]. In-t problem morskikh tekhnologii [Institute of problems of marine technologies]. Moscow: Nauka Publ., 2005. 398 p.

4. Grishin Yu.P., Ipatov V.P., Yu.M. Kazarinov et al. Radiotekhnicheskie sistemy [Radio engineering systems]. Moscow: Vyssh. shk. Publ., 1990. 496 p.

5. Sizykh V.N., M.V. Bakanov Matematicheskaya model' dlya adaptivnogo upravleniya trekhkolesnym mobil'nym robotom [A mathematical model for adaptive control of a three-wheeled mobile robot]. Transportnoe, gornoe i stroitel'noe mashinostroenie: nauka i proizvodstvo : materialy mezhdunar. nauch.-prakt. konf [Transport, mining and construction engineering: science and production: materials ofthe Intern. scientific and practical conf.]. St.Petersburg : SPbF NITs MS Publ., 2018. No. 1. Pp. 9-18.

6. Pupkov K.A., Egupov N.D. (ed.). Metody klassicheskoi i sovremennoi teorii avtomaticheskogo upravleniya. T.3: Sintez regulyatorov sistem avtomaticheskogo upravleniya [Methods of classical and modern theory of automatic control. Vol.3: Synthesis of regulators of automatic control systems]. Moscow: Bauman MGTU Publ., 2004. 616 p.

7. Ang A.H., Chong G., Li Y.PID control system analysis, design and technology. IEEE Trans. on Control Syst. Tech., 2005. Vol. 13. No. 4. Pp. 559-576.

8. Astom K.J., Hagglunk T. Advanced PID control. Instrumentation, Systems and Automation Society, 2006. 406 p.

9. Quevedo J., Escobet T. Digital control: past, present and future of PID control. Proc. IFACWorkshop. Terassa, Spain, Apr. 5-7, 2000.

10. Bulgakov V.V., V.S. Kulabukhov Sravnitel'nyi analiz formalizovannykh metodov sinteza regulyatora sledyashchei sistemy [The comparative analysis of formalized methods of the synthesis of the tracking system regulator]. Pribory [Instrumentation], 2013. No. 1 (151). Pp. 39-44.

11. Kim D.P. Algebraicheskii metod sinteza lineinykh nepreryvnykh sistem upravleniya [Algebraic method of synthesis of linear continuous control systems]. Mekhatronika, avtomatizatsiya, upravlenie [Mechatronic, automation, control], 2011. No. 1. Pp. 9-15.

12. Ziegler J.G., Nichols N.B. Optimum setting for automatic controllers. Trans. ASME. 1942. Vol. 64. R. 759-768.

13. Farhan A.S. New efficient model-based PID design method. European Scientific Journal Edition. 2013. Vol. 9, No. 15. Pp. 181-190.

14. Sizykh V.N., Mukhopad A.Yu. Assotsiativnyi avtomat adaptivnogo upravleniya tekhnologicheskimi protsessami na osnove neironnykh setei [Associative automatic of adaptive control of technological processes based on neural networks.] Nauch. vestn. Novosib. gos. tekhn. un-ta [ScientificBulletin of NSTU], 2014. No. 1 (54). Pp. 34-45.

15. Ageev A.M. Sizykh V.N. Sintez optimal'nykh regulyatorov sistemy upravleniya samoletom cherez reshenie obratnoi zadachi AKOR [Optimal regulators' synthesis for the flight automatic control based on analytic construction problem in the singular formulation]. Nauch. vestn. Novosib. gos. tekhn. un-ta [ScientificBulletin of NSTU], 2014. No. 3 (56). Pp. 7-22.

16. Leva A., Cox C., Ruano A. Hands-on PID autotuning: a guide to better utilization - IFAC Professional Brief. International Federation of Automatic Control. URL: http://www.ifac-control.org.

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

17. Izerman R. Tsifrovye sistemy upravleniya [Digital control systems]. Moscow: Mir Publ., 1984. 541 p.

18. Egupov N.D. (ed.). Metody robastnogo, neiro-nechetkogo i adaptivnogo upravleniya [Methods of robust, neuro-fuzzy and adaptive control]. Moscow: Bauman MGTU Publ., 2002. 744 p.

19. Rotach V.Ya. Teoriya avtomaticheskogo upravleniya [The theory of automatic control]. Moscow: MEI Publ., 2004. 400 p.

20. Sizykh V.N., Bakanov M.V. Algoritmicheskoe obespechenie adaptivnoi sistemy upravleniya avtonomnym mobil'nym robotom [Algorithmic support of an adaptive control system for an autonomous mobile robot]. Informatsionnye sistemy kontrolya i upravleniya v promyshlennosti i na transporte : sb. nauch. tr [Information systems for monitoring and control in industry and transport: coll. of research papers]. Issue 27. Irkutsk: IrGUPS Publ., 2017. Pp. 33-47.

оо оо I

Modern technologies. System analysis. Modeling, 2019, Vol. 62, No. 2

Информация об авторах

Authors

Антошкин Станислав Борисович - к. т. н., доцент кафедры автоматизации производственных процессов, Иркутский государственный университет путей сообщения, г. Иркутск, e-mail: antoshkinsb@gmail.com

Баканов Максим Витальевич - магистрант, Иркутский государственный университет путей сообщения, г. Иркутск, e-mail: maximbakanov@mail.ru

Сизых Виктор Николаевич - д. т. н., доцент, профессор кафедры автоматизации производственных процессов, Иркутский государственный университет путей сообщения, г. Иркутск, e-mail: sizykh_vn@mail.ru

Для цитирования

Stanislav Borisovich Antoshkin - Ph.D. in Engineering Science, Associate Professor at the Subdepartment of Automation of Production Processes, Irkutsk State Transport University, Irkutsk e-mail: antoshkinsb@gmail.com

Maksim Vital'evich Bakanov - Master's student, Irkutsk State Transport University Irkutsk, e-mail: maximbakanov@mail.ru

Viktor Nikolaevich Sizykh - Doctor of Engineering Science, Associate Professor, Professor at the Subdepartment of Automation of Production Processes, Irkutsk State Transport University, Irkutsk, e-mail: sizykh_vn@mail.ru

For citation

Антошкин С. Б. Система управления автономного робота на основе метода обратных задач динамики / С. Б. Антошкин, М. В. Баканов, В. Н. Сизыгх // Современные технологии. Системный анализ. Моделирование. - 2019. - Т. 62, № 2. -С. 15-23. - БО!: 10.26731/1813-9108.2019.2(62).15-23

Antoshkin S. B., Bakanov M. V., Sizykh V. N. Sistema upravleni-ya avtonomnogo robota na osnove metoda obratnykh zadach dinamiki [An autonomous robot control system based on an inverse problems method in dynamics]. Sovremennye tekhnologii. Sistemnyi analiz. Modelirovanie [Modern Technologies. System Analysis. Modeling], 2019. Vol. 62, No. 2, pp. 15-23. DOI: 10.26731/1813-9108.2019.2(62). 15-23

УДК 62.752, 621.534.833; 888.6 DOI: 10.26731/1813-9108.2019.2(62).23-33

А. В. Елисеев, С. В. Елисеев

Иркутский государственный университет путей сообщения, г. Иркутск, Российская Федерация Дата поступления: 22 марта 2019 г.

ОСОБЕННОСТИ ДИНАМИЧЕСКИХ СВОЙСТВ ДИАДЫ В ПОДХОДАХ С ПОЗИЦИЙ МЕЗОМЕХАНИКИ

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

Ключевые слова: диада, структурные образования, характерные точки, преобразование движения, приведенные массы, центр масс.

A. V. Eliseev, S. V. Eliseev

Irkutsk State Transport University, Irkutsk, the Russian Federation Received: March 22, 2019

PECULIARITIES OF DYNAMIC PROPERTIES OF A DYAD IN APPROACHES FROM THE PERSPECTIVES OF MEZOMECHANICS

© А. В. Елисеев, С. В. Елисеев, 2019

23

i Надоели баннеры? Вы всегда можете отключить рекламу.