Анализ вращения поворотных колёс мобильного робота с дифференциальным приводом Текст научной статьи по специальности «Механика и машиностроение»

УДК 621.865.8 DOI: 10.21122/2309-4923-2023-4-30-36

РАДКЕВИЧА.А., ШИСИНЬ ЯН, ЗАРЕЦКИЙВ.А., ВЕЛЬЧЕНКО А.А, ПАВЛЮКОВЕЦ С.А.

АНАЛИЗ ВРАЩЕНИЯ ПОВОРОТНЫХ КОЛЁС МОБИЛЬНОГО РОБОТА С ДИФФЕРЕНЦИАЛЬНЫМ ПРИВОДОМ

Белорусский национальный технический университет г. Минск, Республика Беларусь

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

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

Введение

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

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

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

а служат лишь для силовой поддержки корпуса робота и изменяют своё положение в результате воздействия приводных колёс. В зависимости от конструктивного исполнения поворотные колёса подразделяются на центрально ориентируемые и нецентрально ориентируемые.

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

Свободно вращающиеся неприводные поворотные колеса очевидно влияют на управляемость мобильного робота при движении. Математическое описание их поведения при вращении является важной задачей для повышения управления ходовой части робота. Общие уравнения, характеризующие статическое положение поворотных колёс в пространстве, были представлены в статье [2]. Более развёрнутое математическое описание и экспериментальное исследование нелинейной динамики при колебаниях кастор колеса содержится в исследовании [3], а также в работе [4], где описан общий подход к анализу динамики гибких неголономных систем на примере свободно вращающегося колеса.

Вопросу анализа и оптимизации механической конструкции крепления кастор колеса в ручной тележке посвящена статья [5]. Применительно к мобильным роботам, проблема управления по траектории роботизированной трёхколёсной платформы с учётом возмущающего воздействия, создаваемым отклонением угла поворота свободно вращающегося колеса, подробно рассмотрена в работах [6, 7]. Однако, для исследования планирования движения робота по траектории значимым этапом является анализ взаимного влияния дифференциально приводимых колёс традиционного типа на поворотные колёса и, соответственно, на управляемость мобильным роботом, которые не рассматриваются в данных работах.

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

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

Исследование кинематики мобильного

робота с двумя поворотными колёсами

Четырёхколёсный мобильный робот, изображённый на рисунке 1, имеет два поворотных центрально ориентируемых и два приводных традиционных колеса [6]. Стандартные колёса являются ведущими, которые дифференциально приводятся в движение двигателями, а поворотные колёса выполняют только опорную и направляющую функцию.

Положение в пространстве центрально ориентированного поворотного колеса в таком роботе определяется тремя константами: радиус-вектором I, радиусом колеса г, углом поворота робота 9 и одной переменной - углом поворота колеса ф в функции времени: ф = ф(0, а его вращение характеризуется двумя переменными: углом ф = ф(/) и угловой скоростью вращения ролика ю = ДО [2].

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

движением колёсного мобильного робота [7]. Одним из параметров, количественно определяющим поведение поворотного колеса, является угол поворота ф, который может быть использован в качестве управляемой величины для повышения точности отслеживания траектории движения мобильного робота [8].

Рисунок 1. Мобильный робот с двумя центрально ориентированными поворотными колёсами

Рисунок 2. Мобильный робот с двумя нецентрально ориентированными поворотными колесами

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

R =

l1(«R +«L )

2(®r -®L У

(1)

где Я - радиус поворота, м; 11 - расстояние между ведущими колёсами робота, м; ю1 - угловая скорость левого ведущего колеса робота, рад/с; юЯ - угловая скорость правого ведущего колеса робота, рад/с.

Мобильный робот с двумя традиционными приводными и двумя поворотными нецентрально ориентируемыми колёсами показан на рисунке 2.

Для описания кинематики нецентрально ориентируемого (кастор) колеса используются те же параметры, что и в предыдущем случае, но добавляется расстояние I - плечо между плоскостями поворота и центра колеса. Движение кастор колеса также определяется зависимостями ф = ф(/) и ю = /(/).

Радиус поворота Я мобильного робота с кастор колесами можно выразить как:

R =

I - (12 / cos ф^

tan ф1

R =-

I

I

tan ф2 sin ф2

Ф; = arccos

I ■ 12 +у1 R4 +12R2 - R2í

RT7F

2;2

2

Решив уравнение (3), получаем выражение угла поворота ф2 [9]:

-I • 12 R4 +12R2 - R2122

Ф2 = arccos-

R2 +12

Если длина плеча поворотного колеса 12 = 0, получаем выражение:

0 <

-I ■ 12 4 +12R2 - R2l22 WR2 +12

R2 +12

R2 +12

<1.

Когда длина плеча I. свободного колеса схо-

дится к 1, получается уравнение:

-I ■ 12 + -I2 + R2

lim

12 —1

R2 +12

R2 +12

Из уравнения (1) видно, что радиус поворота Я связан с угловой скоростью ведущих колёс мобильного робота, поэтому для уравнения (7) необходимо проанализировать случаи Я > 1 и Я < 1. Радиус поворота Я совпадает с угловой скоростью ведущих колёс мобильного робота. Следовательно, получаем выражения:

0 < Нт

12 —1

-I • 12

-12R2 - R2Í2,

(2)

(3)

-1<lim

1, —I

R2 +12

-1 • 12

<1, R > 1;

12 R2 -

(8)

R2 +12

-<0, R< 1.

В итоге диапазон значений ф2 можно определить как ф2 е (0, п).

Если принять cosф2 = а и cosф1 = Ь, то разность углов поворота свободных колёс можно выразить как:

где I - расстояние от точки крепления свободного колеса до геометрического центра робота, м; 12 - длина плеча свободного колеса, м; ф1 - угол поворота переднего кастор колеса относительно оси хт; ф2 - угол поворота заднего кастор колеса относительно оси х.

Далее рассмотрим диапазон значений ф1 и ф2. Очевидно, что при движении мобильного робота по прямой линии кривизна траектории равна 0, поэтому значения ф1 и ф2 равны 0. На практике, чтобы избежать искажений траектории при движении, длина плеча поворотного колеса должна удовлетворять условию 0 < 12 < 1. Как показано на рисунке 1, длина плеча свободного колеса мобильного робота равна 0.

Если учесть, что кривизна траектории движения мобильного робота не равна 0, то радиус поворота Я > 0 в соответствии с состоянием движения мобильного робота на рисунке 2. Согласно уравнению (2), диапазон значений ф1 составляет ф1 е (0,п/2). Поэтому зависимость между углом поворота кастор колеса ф1 и радиусом поворота Я выражается как:

Дф = ф2 - = arccos(ab + ^(1 - а2)(1 - Ь2)).

(9)

Построение зависимостей кинематических параметров поворотных колёс

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

(4)

6

Я 5 а;

Я 4 £ 3 £ 2 ^ ! 0

-

<¡>1 А</1

у\

0

20

100

120

(5)

40 60 КО Угол поворота </>!

Рисунок 3. Зависимость между углами поворота кастор колёс и радиуса поворота робота

Таблица 1

Параметры четырёхколёсного мобильного робота

(6)

(7)

Параметры Значение

Радиус поворота Я (0, 6]

Скорость правого колеса юЯ (0, 20]

Скорость левого колеса ю1 (0, 20]

Радиус-вектор 1 0,5

Расстояние между ведущими колёсами 11 0,5

Длина плеча кастор колеса 12 0,1

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

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

скорость ведущего колеса может быть измерена датчиком угловой скорости, поэтому зависимость между угловыми скоростями ведущих колёс мобильного робота и углом поворота свободного колеса можно получить с помощью уравнений (1), (4) и (5): [10].

^ = arccos

= arccos

4l ■ l2 (®R -<L )2 + ll (<R + <L l2 (o)R + <aL )2 + 4(®R - <L )2 (l2 -l22 ) ¡2(®r +<l )2 + 4l2(<R -<L )2 '

-4l • l2 (®R ~®L )2 + l1 (®R + ®L Wl12(®R +®L )2 + 4(®R -®L (l' - l2 )

¡12(®r +®l )2 + 4l2(®r -®l )2

(10)

(11)

Из уравнений (10) и (11) можно получить угол поворота свободного колеса при вращении ведущего колеса мобильного робота с различными угловыми скоростями.

На основании предыдущих уравнений и данных из таблицы 1, построенная зависимость между угловой скоростью ведущего колеса и углом поворота свободного колеса мобильного робота представлена на рисунке 4.

Рисунок 4. Зависимость между угловыми скоростями ведущих колёс и углом поворота свободного колеса мобильного робота

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

Заключение

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

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

Если поворотные колёса мобильного робота имеют определенную длину плеча 12 (являются нецентрально ориентируемыми), то при совершении вращательного движения зависимости углов вращения от радиуса поворота ф = _ДЯ) выражаются разными характеристиками и существует разность углов поворота свободных колёс Дф. Зависимость угла поворота свободных колёс в функции угловой скорости приводного колеса ф = _Дю) позволяет в реальном времени получить информацию о текущей угловой скорости ведущего колеса в зависимости от угла поворота кастор колёс. Одновременно можно получить диапазон угловых скоростей ведущих колёс мобильного робота в соответствии с предельным изменением угла вращения свободных колёс. Анализ графиков свидетельствует о том, что с возрастанием угловой скорости приводных колёс увеличивается угол отклонения поворотных колёс относительно осей подвижной системы координат (От , Хт , Ут ). Полученную зависимость необходимо учитывать при разработке системы управления роботом по траектории и выборе оптимальной скорости маневрирования при сохранении устойчивости конструкции.

При использовании центрально ориентируемых поворотных колёс зависимости углов вращения роликов от радиуса поворота ф = _ДЯ) описываются одной и той же характеристикой, а функции угла поворота свободных колёс от угловой скорости ведущих колёс ф = У(ю) определяются одной кривой.

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

ЛИТЕРАТУРА

1. Павлюковец С.А К вопросу управления мобильным роботом с колесами всенаправленного типа / С.А. Павлюковец [и др.] // BIG DATA и анализ высокого уровня = BIG DATA and Advanced Analytics : сборник научных статей IX Международной научно-практической конференции, Минск, 17-18 мая 2023 г. : в 2 ч. Ч. 2 / Белорусский государственный университет информатики и радиоэлектроники; редкол.: В. А. Богуш [и др.]. - Минск, 2023. - С. 94-102.

2. Кампион, Г. Структурные свойства и классификация кинематических и динамических моделей колесных мобильных роботов / Г. Кампион, Ж. Бастен, Б. д'Андреа-Новель // Нелинейная динамика. - 2011. - Т. 7, № 4. - С. 733-769.

3. Beregi, S., Takacs, D., Gyebroszki, G. [et al.] Theoretical and experimental study on the nonlinear dynamics of wheel-shimmy / Sandor Beregi, Denes Takacs, Gergely Gyebroszki, Gabor Stepan // Nonlinear Dynamics 98. - December, 2019. - Рр. 25812593.

4. Schwab AL., Meijaard J.P. Dynamics of Flexible Multibody Systems with Non-Holonomic Constraints: A Finite Element Approach / Schwab, Arend L., Jacob P. Meijaard // Multibody System Dynamics 10. - August 2003. - P. 107-123.

5. Nemade A. Optimization and Analysis of a Caster Bracket / Amit Nemade // International Journal of Science and Research (IJSR). Vol. 9, Issue 3 (2020). - March 2020. - Рр. 1180-1185.

6. Shabalina K Comparative analysis of mobile robot wheels design / K. Shabalina, A. Sagitov, E. Magid // 2018 11th International Conference on Developments in eSystems Engineering (DeSE), Cambridge, 02-05 September / IEEE. - Cambridge, 2018. - Рр. 175-179.

7. Tian Zhiyu. Trajectory Tracking for Wheeled Mobile Robots Considering the Castor Wheel's Torsion Angle Disturbance / Tian Zhiyu, Liu Xiaoping, Wang Gang, Zhao Yunlong, Li Xinghua // Journal of Beijing University of Posts and Telecommunications. -2022. - Vol. 45, No. 1. - Рр. 94-101. (in Chinese)

8. Beniak, R. Trajectory tracking of a tri-wheel mobile robot using the castor wheel's twist angle / R. Beniak, T. Pyka // 2019 24th International Conference on Methods and Models in Automation and Robotics (MMAR), Miedzyzdroje, 26-29 August / IEEE. -Miedzyzdroje, 2019. - Рр. 281-285.

9. Beniak, R. Influence of Р^^ to trajectory accuracy in mobile robot motion / R. Beniak, T. Pyka // Journal of Automation, Mobile Robotics and Intelligent Systems. - 2012. - Vol. 6, No. 4. - Рр. 50-56.

10. Капитанюк, Ю.А Разработка системы траекторного управления мобильным роботом с роликонесущими колесами / Ю.А. Капитанюк, А.А. Капитонов, С.А. Чепинский // Научно-технический вестник информационных технологий, механики и оптики. - №2 (90). - 2014. - 2014. - С. 65-71.

REFERENCES

1. Pauliukavets S.A. [et al.] On the issue of controlling a mobile robot with omnidirectional wheels. BIG DATA and highlevel analysis = BIG DATA and Advanced Analytics: collection of scientific articles of the IX International Scientific and Рт^^! Conference, Minsk, May 17-18, 2023: at 2 p. Part 2. Belarusian State University of Informatics and Radioelectronics; editorial board: V.A. Bogush [and others]. Minsk, 2023. Рр. 94-102.

2. Campion G., Bastin G., D'Andrea-Novel B. Structural properties and classification of kinematic and dynamic models of wheeled mobile robots. IEEE Transactions on robotics and automation, 1996, vol. 12, no. 1. Рр. 47-62.

3. Beregi S., Takacs D., Gyebroszki G. [et al.] Theoretical and experimental study on the nonlinear dynamics of wheel-shimmy. Nonlinear Dynamics 98. 2019. Рр. 2581-2593.

4. Schwab A.L., Meijaard J.P. Dynamics of Flexible Multibody Systems with Non-Holonomic Constraints: A Finite Element Approach. Multibody System Dynamics 10. 2003. Рр. 107-123.

5. Nemade A., Sagitov A., Magid E. Optimization and Analysis of a Caster Bracket. International Journal of Science and Research (IJSR). Vol. 9. Issue 3. 2020. Рр. 1180-1185.

6. Shabalina K. Comparative analysis of mobile robot wheels design. 2018 11th International Conference on Developments in eSystems Engineering (DeSE), Cambridge, 02-05 September 2018. IEEE. Cambridge, 2018. Рр. 175-179.

7. Tian Zhiyu [et al.] Trajectory Tracking for Wheeled Mobile Robots Considering the Castor Wheel's Torsion Angle Disturbance. Journal of Beijing University of Posts and Telecommunications. 2022. Vol. 45. No. 1. Рр. 94-101. (in Chinese)

8. Beniak R., Pyka T. Trajectory tracking of a tri-wheel mobile robot using the castor wheel's twist angle. 2019 24th International Conference on Methods and Models in Automation and Robotics (MMAR), Miedzyzdroje, 26-29 August 2019. IEEE. Miedzyzdroje, 2019. Рр. 281-285.

9. Beniak R., Pyka T. Influence of PWM to trajectory accuracy in mobile robot motion. Journal of Automation, Mobile Robotics and Intelligent Systems. 2012. Vol. 6. No. 4. Рр. 50-56.

10. Kapitanyuk, Yu.A. [et al.] Development of a trajectory control system for a mobile robot with roller-carrying wheels. Scientific and Technical Bulletin of Information Technologies, Mechanics and Optics. Vol. 2 (90). 2014. Рр. 65-71. (in Russian)

RADKEVICHА.А., SHIXIN YANG, ZARETSKI U.A., VELCHENKO А.А., PAULIUKAVETSБ.А.

ANALYSIS OF CASTOR WHEELS ROTATION OF MOBILE DIFFERENTIAL

DRIVE ROBOT

Belarusian National Technical University Minsk, Republic of Belarus

Mathematical models for controlling centrally oriented and non-centrally oriented rotary wheels of a mobile robot are considered. Based on the analysis of the kinematics of the mobile robot, the dependences of the rotation angle of the rear and front free wheel on the angular velocities of the right and left differentially driven drive wheel were obtained. For a specific mobile robot with certain kinematic parameters, graphs of the dependences of the angle of rotation of the free wheels on the radius of rotation of each wheel and graphs of the dependences of the angle of rotation of the free wheels on the angular velocities of the driving wheels were constructed. The results obtained made it possible to establish a pattern between the angle of rotation of the castor wheels and the design characteristics of the robot. A certain range of angular velocities of the driving wheels in accordance with the limiting values of the caster wheel rotation angles makes it possible to take into account the obtained mathematical models to increase the stability of the movement of the mobile robot.

Keywords: rotary wheel, mobile robot, differential drive, castor wheel, kinematic model, turning angle, turning radius

Радкевич Артём Андреевич, магистрант кафедры «Электропривод и автоматизация промышленных установок и технологических комплексов» Белорусского национального технического университета. Область научных интересов связана с применением нейросетевых технологий управления электроприводами в мобильной робототехнике.

Artsiom A. Radkevich is a master student of the Electric drive and automation of industrial installations and technological complexes department of the Belarusian National Technical University. The area of scientific interests is related to neural network control of electric drives in wheeled mobile robotics.

E-mail: [email protected], [email protected]

Ян Шисинь, аспирант кафедры «Электропривод и автоматизация промышленных установок и технологических комплексов» Белорусского национального технического университета. Область научных интересов связана с исследованием алгоритмов управления колесными мобильными роботами.

Yang Shixin is a PhD student of the Electric drive and automation of industrial installations and technological complexes department of the Belarusian National Technical University. The area of scientific interests is related to developing of control algorithms for wheeled mobile robots.

E-mail: [email protected], [email protected]

Зарецкий Владимир Александрович, аспирант кафедры «Электропривод и автоматизация промышленных установок и технологических комплексов» Белорусского национального технического университета. Область научных интересов - системы управления движением колесных роботов, безопасность движения роботов, нейросетевая навигация мобильных роботов.

Uladzimir A. Zaretski is a PhD student of the Electric drive and automation of industrial installations and technological complexes department of the Belarusian National Technical University. The area of scientific interest includes control systems for wheeled robot motion, safety of robot movement and neural network navigation of mobile robots.

E-mail: [email protected], [email protected]

Вельченко Анна Александровна, кандидат технических наук, доцент, доцент кафедры «Электропривод и автоматизация промышленных установок и технологических комплексов» Белорусского национального технического университета. Область научных интересов связана с разработкой и исследованием нейросетевых регуляторов для электропривода в мобильной робототехнике и солнечной энергетике.

Anna A. Velchenko is a PhD, associate professor, associate professor the Electric drive and automation of industrial installations and technological complexes department. 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.

E-mail: [email protected], [email protected]

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

Siarhei A. Pauliukavets is a PhD, associate professor, head of the Electric drive and automation of industrial installations and technological complexes department of the Belarusian National Technical University. The area of scientific interests is related to the development of methods and algorithms for controlling mobile robots.

E-mail: [email protected], [email protected]