с 01.01.2019 по 01.01.2022
Ростов-на-Дону, Ростовская область, Россия
Ростовская область, Россия
УДК 007.52 не содержащие человека в качестве звена системы, роботы, автоматы
Мобильный робот — сложная система, способная получать информацию о внешнем мире и использовать ее для безопасного перемещения целенаправленным образом. С помощью датчиков информационная подсистема робота может определять его положение, а также расположение статических и динамических объектов в рабочей области. Движение робота к заданной (целевой) точке может осуществляться по различным алгоритмам. Эти алгоритмы реализуют те или иные методы планирования траектории движения к целевой точке, предотвращать столкновения робота с препятствиями, сокращать время перемещения и пройденное расстояние для экономии энергии аккумулятора и т.п. Мобильные роботы должны функционировать в изменяющейся среде со значительной степенью неопределенности. Одной из основных задач мобильного робота является задача планирования траекторий движения и управления движением робота к целевой точке. В статье предлагается метод планирования траектории движения мобильного робота и управления его движением. Метод основан на имитационном моделировании движения робота в среде с неподвижными и подвижными препятствиями. Предполагается, что направление движения препятствий может изменяться случайным образом.
мобильный робот, планирование траектории робота, управление движением робота
Введение. Роботы успешно применяются в машиностроении, при производстве автомобилей и в ряде других областей. В ближайшем будущем роботы будут широко использоваться в сельском хозяйстве, горнодобывающей индустрии и сфере услуг. Эти роботы будут обладать значительной мобильностью и способностью самостоятельно принимать решения по своему поведению. Следовательно, для обеспечения безопасности таких мобильных роботов и их успешного функционирования необходимы алгоритмы планирования действий и движений. Мобильный робот должен быть способен извлекать информацию из окружающей среды и использовать ее для безопасного перемещения целенаправленным образом. Для этого роботы могут использовать различные типы датчиков или получать необходимую информацию от внешних информационных систем. Задачи планирования безопасных траекторий движения робота рассматривались многими исследователями [1–7] и эти работы продолжаются, поскольку условия, в которых функционируют роботы очень разнообразны.
Чтобы избежать столкновений с препятствиями, необходимо знать положение препятствий и предсказывать траекторию их движения. В определенной мере методы, использующие локализацию и картографирование (SLAM) [8] для определения местоположения мобильного робота в режиме реального времени и нанесения на карту окружающей зоны обнаруженных препятствий, позволяют решить эту задачу. К недостаткам данной группы относится отсутствие механизмов прогнозирования и планирования движения к целевой точке.
Известные методы планирования траектории могут быть эффективны для определённых условий и неприменимы для других условий. Они могут иметь различную вычислительную сложность, что не позволит использовать их в системах, где планирование траектории должно осуществляться в реальном масштабе времени для быстро движущихся объектов.
В данной статье рассмотрены наиболее распространенные методы планирования траектории движения робота. Также в статье предлагается метод планирования движения мобильного робота и управления его перемещением в среде с подвижными и неподвижными препятствиями.
Анализ известных методов планирования траекторий мобильных роботов. Известно значительное количество методов планирования траекторий движения мобильных роботов на основе теории графов [1–3, 9]. Обычно узлы графа отражают состояния, в которых может находиться робот. Переходы между состояниями могут быть оценены некоторой функцией затрат. В этом случае возможно нахождение пути, который имеет минимальные суммарные затраты при перемещении робота в целевую точку. Эти методы в общем случае относятся к группе глобальных и позволяют определить наилучшую траекторию к целевой точке в детерминированных условиях движения робота. Методы на основе графов малоэффективны при планировании траекторий движения робота при наличии динамических препятствий.
Еще одной группой методов планирования являются методы на основе клеточной декомпозиции. В этих методах выполняется разбиение рабочего пространства на области («клетки»). Каждая клетка рабочего пространства может быть свободна для перемещения туда робота или занята. Планирование траектории предполагает нахождение последовательности перемещения робота через смежные свободные клетки в целевую точку. Метод имеет серьезный недостаток: увеличение трудоемкости при уменьшении шагов сетки. Также нет эффективных способов учитывать случайный характер движения препятствий. Методы на основе клеточной декомпозиции малоэффективны при планировании траекторий движения робота в условиях случайных процессов, при стохастичности вектора скорости препятствий.
Планирование траекторий робота на основе оптимизационных методов основаны на рассмотрении динамики движения, либо оптимизационном решении задач при групповом управлении. Поэтому подход, основанный на оптимальном управлении, эффективен для простых (линейных) детерминированных систем [10–12]. Методы не обеспечивают эффективности при планировании траекторий в условиях подвижных препятствий с неопределенным характером движения.
Для планирования траекторий движения в недетерминированных условиях ряд методов, использует элементы искусственного интеллекта [13–16]. Среди них можно выделить биоинспирированные алгоритмы: роевой интеллект, «муравьиный» алгоритм, метод роя частиц, а также генетические и эволюционные алгоритмы. Методы ориентированы на решение задач управления группой роботов неприменимы или неэффективны при планировании траекторий одиночного робота в условиях изменяющейся обстановки [17].
Еще одной большой группой методов, применяемых для управления роботом при наличии различных препятствий, являются методы на основе потенциальных полей. Методы используются достаточно широко как для двухмерных, так и для трехмерных случаев. Движение планируется вдоль линий векторного поля [1, 10], потенциальная функция которого определяется расположением препятствий и их формой. В качестве потенциальной функции наиболее часто методы используют:
• виртуальное силовое поле;
• Ньютоновское потенциальное поле;
• супербиквадратное потенциальное поле;
• гармоническое векторное поле;
Робот рассматривается как материальная точка, движущаяся под действием силы притяжения к целевой точке и сил отталкивания от препятствий. Потенциальная функция [1] может быть записана в виде следующего уравнения.
(1)
где 
– притягивающая потенциальная функция, заданная для точки 
; 
– слагаемые отталкивающей потенциальной функции, соответствующие отдельным препятствиям. Притягивающая потенциальная функция может быть задана как уравнение
(2)
где 
– коэффициент, определяющий силу притяжения к целевой точке 
, которое может быть описано следующим образом
(3)
Для каждого 
-го препятствия потенциальная функция может быть описана уравнениями 4 и 5
(4)
(5)
Суперпозиция векторной суммы, притягивающей и отталкивающих сил определяет направление движения робота. Под действием этих сил робот объезжает препятствия и движется к целевой точке. Известны различные модификации метода потенциальных функций в зависимости от особенностей применения и условий реализации.
К основным недостаткам методов на основе потенциальных полей относятся возможность попадания робота в локальные минимумы между препятствиями, а также возможность «осцилляций траектории». Известны модификации метода потенциальных полей для устранения таких недостатков в условиях динамической среды [9, 18, 19]. Методы на основе потенциальных полей малоэффективны при планировании траекторий движения робота в условиях подвижных препятствий с неопределенными параметрами.
Планирование и управление движением робота с учетом стохастичности параметров препятствий. На основе анализа известных методов планирования траекторий движения мобильных роботов были сделаны выводы о том, что для управления движением мобильного робота в среде с подвижными и неподвижными препятствиями необходимо разработать метод планирования, в основе которого должен лежать учет вероятности достижения роботом конкретных точек на местности с учетом вероятности возможных столкновений с препятствиями [20].
При разработке метода авторы исходили из того, что при наличии подвижных препятствий наилучшая траектория не может быть найдена до начала движения. Несмотря на наличие некоторой априорной информации о положении и параметрах движения подвижных препятствий их стохастичность обуславливает уменьшение надежности прогноза столкновений с увеличением интервала прогнозирования. В этом случае планироваться может перемещение робота на определенном временном интервале, при соответствующем уровне прогнозной оценки вероятности столкновения на данном интервале. Планирование и управление движением мобильного робота могут быть осуществлены при наличии: навигационной информации о собственном положении, текущем положении препятствий, движущихся «случайным» образом [4, 21, 22, 23]; определенных на планируемый интервал времени параметрах стохастических оценках направления движения подвижных препятствий.
Задачи исследования были сформулированы следующим образом:
- разработать метод планирования траекторий движения мобильного робота в среде со статическими и динамическими препятствиями в условиях неопределенности движения препятствий;
- разработать метод управления траекторным движением мобильного робота с учетом изменяющейся текущей обстановки;
- создать дискретно-непрерывную имитационную модель движения объектов в рабочей области с учетом стохастичности параметров движения препятствий;
- разработать метод динамического планирования траектории движения мобильного робота с изменяемым временем прогноза событий;
- провести вычислительный эксперимент (моделирование) по планированию траекторий и движению мобильного робота на основе предложенных решений при наличии динамических препятствий.
Метод. В данной статье предлагается метод планирования траектории движения мобильного робота на основе имитационного моделирования изменяющейся обстановки. Будем считать, что положение целевой точки, куда должен прибыть робот, известно и не изменяется. Также введем некоторые допущения:
- динамические препятствия могут изменять направление своего движения случайным образом;
- параметры законов распределения случайных величин (направления и движения) известны и определяются математическим ожиданием Μαo, среднеквадратическим отклонением ϭαo сигма, и дисперсией угла направления движения Dαo;
- скорость движения препятствий известна;
- координаты и вектор скорости каждого препятствия доступны для измерения через некоторый интервал времени tизм.
Авторами поставленные задачи были решены с учетом следующих допущений и
условий – координаты статических препятствий априорно известны; динамические препятствии имеют известную скорость движения; динамические препятствия могут изменять направление своего движения случайным образом; для динамических препятствий параметры законов распределения случайных величин известны; координаты и вектор скорости динамических препятствий «доступны для измерения» в дискретные моменты времени через некоторый интервал времени.
Указанные допущения справедливы в предположении, что системой управления робота (или внешней системой) осуществляется мониторинг области, где происходит движение робота. Практическая реализация такого мониторинга возможна на основе лазерных дальнометрических датчиков, системы технического зрения или лидаров. В ходе такого мониторинга выполняется оценка текущего положения каждого препятствия и параметров его движения, в предположении что вектор скорости может быть описан нормальным законом распределения случайной величины. Следует отметить, что для системы управления робота информация о препятствиях обновляется через интервал времени tизм, который превышает интервал времени принятия решений о параметрах движения робота. tр.
С точки зрения процесса имитационного моделирования рассмотрим движение робота к целевой точке с координатами Xg, Yg в условиях неподвижных и подвижных препятствий. Каждое препятствие определено своими координатами Xoi, Yoi и параметрами движения Voi, Μαoi, Dαoi, ϭαoi. Где Voi – текущая оценка скорости движения каждого препятствия, Μαoi, Dαoi, ϭαoi – математическое ожидание, дисперсия и среднеквадратическое отклонение направления движения каждого подвижного препятствия. Имитационная модель разработана и реализована в среде Matlab.
Введем понятие горизонта событий, под которым будем понимать интервал времени t0 для которого будет выполняться прогноз движения препятствий и оцениваться вероятность столкновения с ними мобильного робота. Выбор «наилучшего значения» t0 является нетривиальной задачей и в данной статье не рассматривается.
Поясним логику принятия решений и действий на уровне бортовой системы управления роботом соответствующую положению объектов в рабочей области, показанной на рисунке 1.
Рис. 1. Расположение мобильного робота и препятствий на планируемом интервале времени 
Светлыми окружностями обозначены начальные положения препятствий, темными – положения препятствий в конце интервала прогнозирования 
. Конечное положение препятствий определяется как результат его движения с вероятностными характеристиками, известными в момент времени 
. Чем больше будет величина горизонта прогноза , тем меньше надежность прогноза. Следовательно, возрастает вероятность не обнаружения возможного столкновения. Однако, уменьшение прогнозируемого интервала значительно меньше величины 
из-за возрастания вычислительных издержек системы управления без адекватного (соответствующего) роста качества планирования траектории движения робота. В общем случае выбор значения зависит от скоростных и динамических характеристик робота, имеющегося времени информационно-измерительной подсистемы.
Логика предлагаемого метода планирования траектории робота и его движения к целевой точке иллюстрируется алгоритмом, приведенном на рисунке 2.
В момент времени t, на основе текущих данных о расположении целевой точки, робота, препятствий и параметров их движения выполняется оценка положения препятствий к моменту времени t+t0. Для робота выбирается направление движения на целевую точку и прогнозируется его положение в момент времени t+t0. Движение робота на интервале времени t0 произойдет без столкновений с препятствиями, если при перемещениях робота и препятствий выполняются условия
(6)
где 
– радиус зоны безопасности вокруг робота, 
– радиус зоны безопасности вокруг соответствующего препятствия, 
, 
- текущие координаты робота, 
, 
– координаты препятствий.
Если существует вероятность столкновения робота, то возможны два решения. Если столкновение может произойти с неподвижным препятствием, то выполняется его обход, критерием выбора лучшего варианта при этом является минимальный путь (время) обхода. Если столкновение возможно с движущимся препятствием, то выполняется изменение планируемой скорости движения робота и еще раз выполняется прогноз возможности столкновения.
Рис. 2. Общий алгоритм достижения целевой точки
Результаты. Результаты планирования траектории движения мобильного робота на основе имитационного моделирования изменяющейся обстановки приведены ниже. На рисунке 3 показано построение траектории движения робота при наличии в рабочей зоне неподвижных препятствия. На каждом интервале планирования определялась промежуточная точка, в которую робот должен переместиться за время t0 (определяется горизонтом событий).
Результаты планирования траектории движения мобильного робота на основе имитационного моделирования изменяющейся обстановки приведены ниже. На рисунке 3 показано построение траектории движения робота при наличии в рабочей зоне неподвижных препятствия. На каждом интервале планирования определялась промежуточная точка, в которую робот должен переместиться за время t0 (определяется горизонтом событий).
Проверка работоспособности метода для случая статических и динамических препятствий иллюстрируется на рисунке 4. Кроме неподвижных препятствий в рабочей зоне имеются подвижные препятствия, направление движения которых изменяется случайным образом. Траектории движения препятствий показаны синими линиями.
Рис. 3. Планирование и движение по траектории при статических препятствиях
Рис. 4. Планирование и движение по траектории при статических и динамических препятствиях
На рисунке видно, что на втором интервале планирования движения, было обнаружена возможность столкновения робота с подвижным препятствием, движущимся из начальной точки х=650, у=560. Для предотвращения столкновения была уменьшена скорость робота. И еще раз выполнен прогноз возможности столкновения. Если столкновения не произойдет, робот перемещается в новую промежуточную точку. После этого осуществляется планирование траектории движения мобильного робота на новом интервале времени, определяющим горизонт событий.
Обсуждение результатов. В предложенном методе планирования и управления движением робота учитывается случайный характер движения динамических препятствий. Для ситуаций возможного столкновения реализовано несколько стратегий, обеспечивающих безопасное движение робота. В зависимости от сложившейся ситуации реализуются различные алгоритмы поведения робота. Стратегии поведения робота отличаются для ситуаций при его опасном сближении с неподвижными и подвижными препятствиями.
Предложенный метод обеспечивает безопасное перемещение робота в целевую точку.
Метод позволяет задавать величину зоны безопасности при планировании траектории движения робота и при необходимости изменять ее в зависимости от принятого времени прогнозирования – горизонта событий.
Объезд неподвижных препятствий осуществляется наилучшим образом для минимизации времени движения к целевой точке.
Дальнейшие улучшения предложенного метода будут включать следующие решения:
Определение наилучшей промежуточной точки для движения при объезде статических и динамических препятствий с учетом прогноза изменения их расположения на интервале, превышающем принятое время прогнозирования;
Реализация долгосрочного прогнозирования изменений обстановки в зоне движения мобильного робота для принятия стратегических и тактических решений. Это позволит избегать ситуаций, не имеющих решения и планировать близкие к оптимальной траектории безопасного движения мобильного робота.
Выводы. Выполненные эксперименты с математическим моделирование процессов планирования и управления движением мобильного робота позволяют сделать следующие выводы.
- Разработан метод планирования траектории движения мобильного робота в среде с неподвижными и подвижными препятствиями, в том числе имеющими случайный характер изменения векторов скорости подвижных препятствий; Метод учитывает возможные столкновения на заданном временном интервале горизонта прогноза;
- Разработанный метод реализует несколько стратегий предотвращения столкновений, в том числе для объезда неподвижных и подвижных препятствий с изменением собственной скорости и направления движения;
- Разработана имитационная модель, реализующая дискретно-непрерывный процесс движения объектов в некоторой области;
- Результаты моделирования показали эффективность планирования траекторий и управления движением робота в условиях неподвижных и подвижных препятствий.
1. Liu V. Methods of path planning in an environment with obstacles (review) // Mathematics and mathematical modeling: a network scientific publication. Moscow: MGTU. 2018. No. 01. Pp. 15-58. DOI: 10.24108 / mathm.0118.0000098.
2. Lim C. W., Yong L. S., Ang M.H. Hybrid of global path planning and local navigation implemented on a mobile robot in indoor environment // Proceedings of the IEEE International Symposium on Intelligent Control (ISIC). Vancouver, Canada. 2002. Pp. 821-826. DOI:https://doi.org/10.1109/ISIC.2002.1157868.
3. Zhenyu W., Lin F. Obstacle prediction-based dynamic path planning for a mobile robot // International Journal of Advancements in Computing Technology. 2012. Vol. 4. No. 3. Pp. 118-124.
4. Хоанг Д.Т., Пыркин А.А. Траекторное управление мобильным роботом в условиях неопределенности // Изв. вузов. Приборостроение. 2021. Т. 64. №8. С. 608-619.
5. Дас Н.Ч., Скакун А.Д., Зим З.Х., Уддин Р. Алгоритм планирования траектории мобильного робота // Международная конференция по мягким вычислениям и измерениям. 2021. Т. 1. С. 228-231.
6. Федоров В.М., Шарлай А.С. Обзор известных методов построения системы навигации для реализации возможности автономного перемещения мобильных роботов в среде с препятствиями // В сборнике: информационные технологии в современном инженерном образовании. материалы межвузовской научно-практической конференции. Санкт-Петербург, 2020. С. 241-245.
7. Страшнов Е.В., Торгашев М.А. Моделирование движения колесных роботов по ровной поверхности в системах виртуального окружения // В сборнике: Виртуальное моделирование, прототипирование и промышленный дизайн. Материалы VI Международной научно-практической конференции. 2020. С. 149-154.
8. Цинь Ч. Исследование алгоритма slam роботов на основе оптимизации графов // StudNet. 2021. Т. 4. №7. С. 63-76.
9. Карпасюк И.В. Модификация метода потенциалов для поиска путей на взвешенном графе // В сборнике: Технические средства систем управления и связи = International Scientific Forum on Control and Engineering. Международный научный форум. Материалы V Международной конференции «Информационные технологии и технические средства управления» (ICCT-2021), 14-й Международной конференции «Акустооптические и радиолокационные методы измерений и обработки информации» (ARMIMP-2021). Астрахань, 2021. С. 248-250.
10. Jing R., McIsaac K.A., Patel R.V. Modified Newton's method applied to potential field-based navigation for mobile robots // IEEE Transactions on Robotics. 2006. Vol. 22. No. 2. Pp. 384-391.
11. Shiltagh N., Jalal L. Optimal path planning for intelligent mobile robot navigation using modified particle swarm optimization // International Journal of Engineering and Advanced Technology. 2013. Vol. 2. No. 4. Pp. 260-267.
12. Yee Z.C., Ponnambalam S.G. Mobile robot path planning using ant colony optimization // IEEE/ASME International Conference on Advanced Intelligent Mechatronics. Singapore, 2009. Pp. 851-856. DOI:https://doi.org/10.1109/AIM.2009.5229903.
13. Moreno J.A., Castro M. Heuristic algorithm for robot path planning based on a growing elastic net // Progress in artificial intelligence: 12th Portuguese conf. on artificial intelligence: EPIA 2005 (Covilhã, Portugal, December 5-8, 2005): Proc. B.: Springer, 2005. Vol. 3808. Pp. 447-454. DOI:https://doi.org/10.1007/11595014_44.
14. Антонов В. О., Гурчинский М. М., Петренко В. И., Тебуева Ф. Б. Метод планирования траектории движения точки в пространстве с препятствием на основе итеративной кусочно-линейной аппроксимации // Системы управления, связи и безопасности. 2018. № 1. С. 168-182.
15. Medvedev M., Pshikhopov V. Path planning of mobile robot group based on neural networks // Lecture Notes in Computer Science 2020. Vol. 12144LNAI. Pp. 51-62. DOI:https://doi.org/10.1007/978-3-030-55789-8_5.
16. Pshikhopov V.Kh., Gurenko B.V., Medvedev M.Yu. Algorithms of adaptive position-trajectory control systems of moving objects // Control problems. 2015. No. 4. Pp. 66-75.
17. Скороспехов Ю.В., Куделин А.С., Григорьев Г.К. Проблемы автономного управления и ориентации в пространстве военных робототехнических комплексов // В сборнике: научная сессия гуап: гуманитарные науки. Сборник докладов традиционной Научной сессии, посвященной Всемирному дню авиации и космонавтики. Санкт-Петербург, 2020. С. 160-163.
18. Ge S.S., Cui Y.J. New potential functions for mobile robot path planning // IEEE Trans. on Robotics and Automation. 2000. Vol. 16. No. 5. Pp. 615-620. DOI:https://doi.org/10.1109/70.880813
19. Jing R., McIsaac K.A., Patel R.V. Modified Newton's method applied to potential fieldbased navigation for mobile robots // IEEE Trans. on Robotics. 2006. vol. 22. No. 2. Pp. 384-391. DOI:https://doi.org/10.1109/TRO.2006.870668
20. Яковлев Д.С., Тачков А.А. Вероятность столкновения автономного мобильного робота с препятствием // Мехатроника, автоматизация, управление. 2021. Т. 22. №3. С. 125-133.
21. Звонарев И.С., Караваев Ю.Л. Анализ систем управления мобильных роботов с элементами интеллектуальногоуправления // В сборнике: "Выставка инноваций - 2021" (осенняя сессия). Сборник материалов XXXII Республиканской выставки-сессии студенческих инновационных проектов. Ижевск, 2021. С. 62-67.
22. Лапшинов С.А., Шахнов В.А., Юдин А.В. Направления интеллектуализации управления движением мобильного робота // Нейрокомпьютеры: разработка, применение. 2021. Т. 23. №1. С. 50-62.
23. Баженов Е.И., Мокрушин С.А., Охапкин С.И. Анализ и выбор принципа построения системы ориентации мобильного робота // Системы управления и информационные технологии. 2021. №2 (84). С. 27-30.
