CC BY
25
УДК 621.864.8 DOI: 10.21122/2309-4923-2023-3-33-38
ПАВЛЮКОВЕЦ С.А., ВЕЛЬЧЕНКО А.А., РАДКЕВИЧ АА.
МАТЕМАТИЧЕСКАЯ МОДЕЛЬ СИСТЕМЫ УПРАВЛЕНИЯ МОБИЛЬНЫМ ГУСЕНИЧНЫМ РОБОТОМ С УЧЕТОМ КИНЕМАТИЧЕСКИХ И ДИНАМИЧЕСКИХ ПАРАМЕТРОВ
Белорусский национальный технический университет г. Минск, Республика Беларусь
В работе разработана математическая модель системы управления мобильным гусеничным роботом, которая учитывает кинематические параметры (угловые скорости вращения катков и центра масс робота, линейную скорость передвижения робота и угол его поворота относительно нормали к оси) и динамические параметры (моменты инерции, усилия сопротивления и электромеханические параметры применяемых электродвигателей), что позволило дать наиболее полное математическое представление описания движения гусеничного мобильного робота. Получена система управления мобильными роботами по заранее заданной траектории с учетом обратных связей по положению.
Ключевые слова: мобильный гусеничный робот, математическая модель, кинематические и динамические параметры
Введение
Из числа всех видов мобильных роботов, разработанных за последние десятилетия, наиболее многофункциональными представляются мобильные роботы, использующие в качестве движителя гусеничные ленты. Применение современных систем управления, основанных, в том числе на методах искусственного интеллекта, в сочетании с преимуществами гусеничных шасси, таких как увеличенная площадь сцепления с поверхностью, образовываемая растягиваемой между опорными и приводными элементами гусеницей, обеспечивающая наилучшую проходимость по сравнению с колесными роботами, возможность движения мобильного робота по пересеченной местности с большими уклонами и ступеням, обеспечение высокой грузоподъемности и другие возможности предопределили широкое распространение гусеничных мобильных роботов, в первую очередь, в военной технике и сельском хозяйстве.
Формализация условий поведения гусеничного мобильного робота в пространстве описывается его математической моделью, которая характеризует статические и динамические характеристики робота, позволяя исследовать и анализировать его работу без использования аппаратных средств [1].
В настоящее время имеется ряд научных источников, в которых рассматривается вопрос математического моделирования гусеничных мобильных роботов. В частности, в статье [2] анализируется задача управления движением мобильного робота в неопределённых средах с обходом препятствий с использованием лазерных систем для управления. В источнике [3] предложена комплексная методика процесса построения численной модели
гусеничной машины для анализа ее движения, однако без учета ее кинематических и динамических параметров. В статьях [1, 4, 5] проанализировано применение методов искусственного интеллекта для управления мобильными роботами. Данные источники рассматривают математические модели гусеничных мобильных роботов либо без учета их кинематических и динамических параметров, либо анализируют системы управления мобильными роботами в общем случае, без учета специфики гусеничных движителей.
В данной статье авторами предлагается разработка математической модели системы управления мобильным гусеничным роботом, которая учитывает кинематические параметры (угловые скорости вращения катков и центра масс робота, линейную скорость передвижения робота и угол его поворота относительно нормали к оси) и динамические параметры (моменты инерции, усилия сопротивления и электромеханические параметры применяемых электродвигателей), что позволяет составить наиболее полное математическое описание движения гусеничного мобильного робота.
Исходя из выше сказанного, целью данной статьи является разработка математической модели системы траекторного управления гусеничным мобильным автономным роботом с учетом его кинематических и динамических параметров.
Назначение моделируемого гусеничного мобильного робота предполагает его применение в точном земледелии. В данной статье рассматривается разработка математической модели и анализ системы траекторного управления ходовой части робота, обеспечивающей его перемещение по заранее заданной траектории, определяемой требуемой последовательностью выполнения операций.
Построение математической модели гусеничного мобильного робота
Для математического описания гусеничного мобильного робота рассмотрим кинематические и динамические модели и исследуем управляемость ходовой части объекта.
Прямая кинематическая модель
гусеничного движителя описывается кинематикой
дифференциального матрицей состояний:
" ¿(0' cos (ф(0) 0
Я') = sin (ф(0) 0
_ф (') _ 0 1
привода,
Ж')
ю(0
определяемого
(1)
где х, у - координаты центра масс робота; ф - угол между вектором линейной скорости и нормалью к оси; $ - линейная скорость перемещения робота; ю - угловая скорость вращения центра масс робота.
Однако, дифференциальный привод предполагает идеальный контакт трения качения между колесом и поверхностью, в то время как гусеничный привод имеет большую площадь соприкосновения и требует проскальзывания для поворота гусениц. Поэтому, прямая кинематическая модель не столь надежна для оценки положения гусеничного движителя, чем для дифференциального колесного привода.
Визуализация кинематической модели гусеничного движителя в пространстве изображена на рис. 1. Как видно из рисунка, положение робота определяется координатой точки центра масс гусеницы О1 в подвижной системе координат (X,УиХ) и углом поворота гусеницы ф относительно неподвижного базиса (X, У, 2). При кинематическом анализе движения решается задача определения положения, скорости центра масс гусеницы и скорости точек центра катков и их соприкосновения с лентой [6].
Рисунок 1. Визуализация кинематической модели гусеничного движителя в пространстве
На данной модели (рис. 1) обозначены:
О, (X, У, 2). - неподвижная система координат;
Ор(х, , Х) - подвижная система координат; С^ С2 -точки крепления центров опорных катков; Кх,К -точки контакта гусеничных лент с поверхностью;
§ § - скорости точек крепления центров опорных катков; § х 1 § х2 - проекции скоростей точек крепления опорных катков на ось ОХ^ 71, §72 - проекции скоростей точек крепления опорных катков на ось О¥г - скорости
точек контакта опорных катков с поверхностью; § XI § х2 - проекции скоростей точек контакта опорных катков с поверхностью на ось ОХ^ 71, 72 - проекции скоростей точек контакта опорных катков с поверхностью на ось ОУ^ ©1, ©2 - угловые скорости вращения опорных катков; ф - угол поворота гусеницы вокруг оси 02х относительно 07; ¥ - угол поворота гусеницы вокруг оси 02х относительно ОХ.
Радиус-вектор, описывающий движение гусеницы в неподвижной системе координат, описывается матричным уравнением:
У01 0
(2)
где х У01 - проекции радиус-вектора в относительной системе координат.
Скорость центра масс гусеничного робота рассчитывается исходя из выражения:
оох
cos (?) V 1"
^п(?) = V1
0 0
(3)
^ (т)" V1"
а а) - а01 - ас sin (т) - V1
0 0
Скорость центра масс в подвижном базисе (Хх, Ух, 2Х) описывается в матричном виде:
(4)
а скорость центра масс в неподвижной системе координат (X ,7, 2) имеет вид:
(5)
Радиус-вектор закрепления катков гусеничного робота определяется как:
Г ^ Гос + ?сс,, 1 = {1...4}. (6)
Линейные скорости этих точек задаются дифференциальными уравнениями:
X ^ (¥- Ьф) V"
п(0) _ Э01 _ ^ sin (Чн -ф) _ V
0 0
& &
= ос
ос + Ш ■ Гсс = §с + Ш ■ ?сс. ■ (7)
Радиус-вектор точек контакта катков с поверхностью выражается уравнением:
(8)
Ъ™ = Г + , * = {1...4}
Продифференцируем выражение (8):
&Ъ<0) = + ^ол
(9)
X
Линейные скорости точек контакта катков с поверхностью К. в абсолютной системе координат (X, У, 2) определяются уравнениями:
(10)
XKi XC i j k
§ K= к = Ус, + ®1X ®ir 0 . (11)
0 0 0 0 TcA
Линейные скорости точек контакта катков с поверхностью К. в относительной системе координат (Х1,У1,¿1) определяются уравнениями:
5(1) = 5(0). T-1
™Ki Ki -40 ,
где
cos ф sin ф 0
- sin ф cos ф 0
0 0 1
cos ф - sin ф 0
sin ф cos ф 0 .
0 0 1
1/q = Ус + ll • sin(<P + «1 ).' {*c2 = *c + li ■cos (ф_а1 );
= ^c + li ■sin (ф-«1 ).'
\XC, = XC - l2 ■ C0S (ф + а2 );
{Ус, = Ус - l2 ■ sin (ф + а2 ).'
\xc4 = xc - li ■cos (ф"а 2 ); {-VC, = Ус - l2 ■ Sin (ф-«2 ).'
= r-(1 - il ); &2 = r -ю2 -(l - i2 );
& = (-(1 - ii )+®2-(1 - i2 ))-) ; arctg (01 -02 )
(19)
ю
= (-(1 - i2 )-ю1 -(1 - i1 ))-) ;
R =
( -(1 - i1 )+Ю2 -(1 - i2 )) Й (Ю2 -(1 - i2 )-Ю1 -(1 - i1 )) 2'
(12)
(13)
(14)
Положения точек центров катков гусениц задаются системами уравнений:
I Хс = xC + ll ■ cos (ф + at);
(15)
(16)
(17)
(18)
где - линейная скорость движения левой гусеницы; 92 - линейная скорость движения правой гусеницы; 9 - поступательная скорость движения гусеничного робота; г - радиус ведущего гусеничного катка; ®1,®2 - угловые скорости ведущих гусеничных катков; ю - угловая скорость поворота робота относительно центра масс; ф - угол поворота робота относительно неподвижной системы координат (X, У, 2); I - длина гусеничной ленты; Ь - ширина мобильного гусеничного робота; Я - радиус поворота гусеничного робота; ¡1, ¡2 - коэффициенты скольжения левой и правой гусениц соответственно.
Угловая скорость корпуса робота представляется матричным уравнением:
(20)
Визуализированная математическая модель гусеничного мобильного робота показана на рисунке 2.
где ха, ус. - координаты центра .-го катка, . = {1...4}; хс,ус - координаты центра масс корпуса робота; /1,/2 - расстояния от центра масс робота до 1 и 4, 2 и 3 катков соответственно; ф - угол поворота робота вокруг оси OZ1; а1, а2 - углы между диагоналями 11, /2 и осями подвижной системы координат Х1,У1.
Построение системы управления гусеничного мобильного робота с учетом кинематической и динамической моделей
С целью исследования управляемости ходовой части гусеничного робота как многомерного объекта рассмотрим его кинематическую и динамическую модели.
Движение гусеничного мобильного робота в подвижной системе координат (Х1, У1, 21) определяется уравнениями, описывающими его кинематическую модель [2]:
Рисунок 2. Визуализация математической модели гусеничного мобильного робота
С учетом принятых допущений, нелинейная динамическая модель гусеничного мобильного робота описывается системой дифференциальных уравнений [3].
b
T-1 = 1W
Tic =
dx
— = У ■ cos ф; dt
dy n ■
— = 9 ■ sm ф; dt
d 9 1 , ч
~Г =--(i +^2); ,
dt r ■ m
d ш 1 / ч
последовательного возбуждения, математическая модель которых имеет следующий вид:
(21)
FC = m ■ ф2 ■ R.
Сила инерции вычисляется как:
F = Fc . 21
<Яя _ U-c-e^-Ijj'Rz d L
dod _ с-1д-Мс
(25)
dt
J.
jb
dt 2r ■ JC d ф
— = ш. dt
где т - масса гусеничного робота; тр т2 - электромагнитные моменты, развиваемые электроприводами ведущих катков; JC - момент инерции робота относительно центра масс.
На робот при повороте на месте или на малых скоростях центробежная сила не оказывает существенного влияния, однако на высоких скоростях она представляется значительной и распределяется равномерно в поперечном направлении к вектору направления движения. В этой ситуации центробежная сила рассчитывается как:
(22)
(23)
где 1Я - ток якоря двигателя, А; и - напряжение двигателя, В; С - конструктивная постоянная двигателя, В-с/рад; - угловая скорость приводной оси, рад/с; Яъ - суммарное сопротивление двигателя, Ом; МС - статический момент на валу двигателя, Н-м; JДВ - момент инерции двигателя, кг-м2.
Тогда математическая модель левого дифференциального привода записывается согласно выражению:
(26)
Математическая модель правого дифференциального привода рассчитывается исходя из системы уравнений:
Центробежная сила создает момент сопротивления М, направленный встречно поворотному движению гусеничного робота.
Динамическая модель робота при повороте описывается уравнениями движения:
m ■ У1 = F1 + F2 - FC ■ Sin a" FR2 - FRl';
m ■ x1 = FC ■ cos a — g ■ ц1;
a2 4 r d a
a = arctg--ц1; JZ — = MC — MR;
4 ■ g dt
Mc =[(F — FRi )—(F1 — Fr1 )]■ b; , (24)
„ ( m H ■ m ■0-2 ■ x 1
FRi =[ ~2 J^R;
| m H ■ m ■ -&2 ■ x I
Fr2 2 bR ;
где H - высота центра тяжести над гусеницей; JZ - момент инерции относительно вертикальной оси Z; MC - момент относительно центра масс робота; FR1, FR2 - продольные силы сопротивления;
- коэффициент продольного сопротивления;
- коэффициент бокового сопротивления; g - ускорение силы тяжести; a - угол скольжения.
Управление роботом осуществляется с помощью контроля скорости катков, приводимых в движение двигателями постоянного тока
(27)
где ю1, ю2 - угловая скорость левого и переднего правого катков соответственно; I , I - ток якоря левого и правого двигателей соответственно; и1, и2 -напряжение питания левого и правого двигателей соответственно.
Таким образом, полученные выражения (26, 27) для левого и правого дифференциального привода, позволяют описать прямую кинематическую модель гусеничного движителя.
Заключение
В ходе математического исследования системы траекторного управления мобильным гусеничным роботом с учетом его кинематических и динамических параметров, было получено:
1. Математическая модель мобильного робота на основе его параметрических кинематических и динамических уравнений, которая позволит проводить структурно-параметрический синтез системы траек-торного управления гусеничным роботом, что ведет к повышению качества его управляемости;
2. Планирование траектории перемещения мобильного гусеничного робота по двум видам тракторного управления на основании его математической модели.
ЛИТЕРАТУРА
1. Романов, П.С. Подходы к созданию интеллектуальной системы управления мобильным роботом / П.С. Романов, И.П. Романова // Электронный научный журнал «Инженерный вестник Дона». - 2018. - № 1. - С. 1-13.
2. Salem, F.A. Dynamic and kinematic models and control for differential drive mobile robots / F.A. Salem // International Journal of Current Engineering and Technology. - 2013. - Vol. 3, № 2. - P. 253-263.
3. К вопросу управления мобильным роботом с колесами всенаправленного типа / С.А. Павлюковец [и др.] // BIG DATA и анализ высокого уровня = BIG DATA and Advanced Analytics : сборник научных статей IX Международной научно-практической конференции, Минск, 17-18 мая 2023 г. : в 2 ч. Ч. 2 / Белорусский государственный университет информатики и радиоэлектроники ; редкол.: В. А. Богуш [и др.]. - Минск, 2023. - С. 94-102.
4. Mahfouz, A.A. Modeling, simulation and dynamics analysis issues of electric motor for mechatronics applications using different approaches and verification by MATLAB/Simulink / A.A. Mahfouz, M.K. Mohammed, F.A. Salem // International Journal of Intelligent Systems and Applications. - 2013. - Vol. 5, № 5. - P. 39-57.
5. Юдинцев, Д.В. Методика построения математической модели гусеничной машины для анализа движения / Д.В. Юдинцев, М.С. Рублев. - Текст: электронный // Проектирование систем вооружения боеприпасов и измерительных комплексов : Труды 17-й Всероссийской научно-технической конференции (01-02 октября 2020 г., г. Нижний Тагил). - Нижний Тагил: НТИ (филиал) УрФУ, 2021. - C. 456-461.
6. Яцун, С.Ф. Математическое моделирование мобильного гусеничного робота / С.Ф. Яцун, Чжо Пьо Вей, А.В. Мальчиков, Е.С. Тарасова // Научное обозрение. Технические науки. - 2014. - № 2. - С. 236-237
REFERENCES
1. Romanov P. S., Romanova LP. Approaches to the creation of an intelligent control system for a mobile robot. Electronic scientific journal "Engineering Bulletin of the Don", 2018, № 1, рр. 1-13.
2. Salem, F.A. Dynamic and kinematic models and control for differential drive mobile robots. International Journal of Current Engineering and Technology, 2013, vol. 3, № 2, pp. 253-263.
3. On the issue of controlling a mobile robot with omnidirectional wheels / S.A. Pauliukavets [et al.] // BIG DATA and high-level analysis = BIG DATA and Advanced Analytics : collection of scientific articles of the IX International Scientific and Practical Conference, Minsk, May 17-18, 2023 : at 2 h. Part 2 / Belarusian State University of Informatics and Radioelectronics; editorial board: V.A. Bogush [and others]. Minsk, 2023, pp. 94-102.
4. Mahfouz A.A., Mohammed M.K., Salem F.A. Modeling, simulation and dynamics analysis issues of electric motor for mechatronics applications using different approaches and verification by MATLAB/Simulink. International Journal of Intelligent Systems and Applications, 2013, vol. 5, № 5, pp. 39-57.
5. Yudintsev D.V., Rublev MS. Methodology for constructing a mathematical model of a tracked vehicle for motion analysis. Design of weapon systems of ammunition and measuring complexes: Proceedings of the 17th All-Russian Scientific and Technical Conference (October 01-02, 2020, Nizhny Tagil).Nizhny Tagil: NTI (branch) UrFU, 2021, pp. 456-461.
6. Yatsun S.F., Zhuo Pyo Wei, Boys A.V., Tarasova E.S. Mathematical modeling of a mobile caterpillar robot. Scientific Review. Technical science, 2014, no. 2, pp. 236-237.
PAULIUKAVETSS.A., VELCHENKOА.А., RADKEVICHА.А.
MATHEMATICAL MODEL OF THE CONTROL SYSTEM OF MOBILE CATERPILLAR ROBOT TAKING INTO ACCOUNT KINEMATIC AND DYNAMIC
PARAMETERS
Belarusian National Technical University Minsk, Republic of Belarus
The paper developed a mathematical model of the control system for a mobile tracked robot, which takes into account the kinematic parameters (angular speeds of rotation of the rollers and the center of mass of the robot, the linear speed of the robot and its angle of rotation relative to the normal to the axis) and dynamic parameters (moments of inertia, resistance forces and electromechanical parameters used electric motors), which made it possible to give the most complete mathematical representation of the description of the movement of a caterpillar mobile robot. A control system for mobile robots along a predetermined trajectory is obtained, taking into account position feedback.
Keywords: mobile caterpillar robot, mathematical model, kinematic and dynamic parameters
Павлюковец Сергей Анатольевич, кандидат технических наук, доцент, заведующий кафедрой «Электропривод и автоматизация промышленных установок и технологических комплексов» Белорусского национального технического университета. Область научных интересов связана с разработкой методов и алгоритмов управления мобильными роботами.
Siarhei Pauliukavets, PhD, associate professor, head of the department «Electric drive and automation of industrial installations and technological complexes» of the Belarusian National Technical University. The area of scientific interests is related to the development of methods and algorithms for controlling mobile robots.
Е-mail: [email protected]
Вельченко Анна Александровна, кандидат технических наук, доцент, доцент кафедры «Электропривод и автоматизация промышленных установок и технологических комплексов» Белорусского национального технического университета. Область научных интересов связана с разработкой и исследованием нейросетевых регуляторов для электропривода в мобильной робототехнике и солнечной энергетике.
Anna Velchenko, PhD, associate professor, associate professor of the department «Electric drive and automation of industrial installations and technological complexes» of the Belarusian National Technical University. The area of scientific interests is related to the development and research of neural network controllers for electric drives in mobile robotics and solar energy.
Е-mail: [email protected]
Радкевич Артем Андреевич, магистрант кафедры «Электропривод и автоматизация промышленных установок и технологических комплексов» Белорусского национального технического университета. Область научных интересов связана с разработкой систем управления электроприводами.
Artsiom Radkevich, master's student of the department «Electric drive and automation of industrial installations and technological complexes» of the Belarusian National Technical University. The area of scientific interests is related to the development of control systems for electric drives.
Е-mail: [email protected]
