Аннотация 3
Введение 4
1 Обзор существующих подходов к решению задачи 7
1.1 Алгоритмы глобального планирования 10
1.1.1 Алгоритмы планирования пути по карте 10
1.1.2 Алгоритмы на основе пространственной декомпозиции 13
1.1.3 Методы с использованием потенциальных полей 15
1.2 Алгоритмы локального планирования 17
1.2.1 Семейство Bug - алгоритмов 18
1.2.2 Метод нахождения промежутков 20
1.3 Нечеткая логика 21
1.4 Выводы 22
2 Описание алгоритма 24
2.1 Постановка задачи 24
2.2 Алгоритм формирования пространственных траекторий 28
3 Результаты моделирования 40
Заключение 49
Список использованных источников 50
Приложение А. Программная реализация системы планирования траекторий 58
В настоящее время наблюдается активное развитие сферы применения мобильных роботов. Для широкого применения мобильных роботов в повседневной жизни необходима разработка алгоритмов планирования траекторий движения, которые обеспечили бы безопасное взаимодействие роботов с людьми, а также методов, позволяющих взаимодействовать роботам в составе мультиагентных систем. В таких случаях достаточно значимыми и обособленными являются задачи, которые роботы способны выполнять в автономном режиме без контроля оператора в окружении, априорной информации о котором недостаточно: транспортировка грузов различного назначения, осмотр зданий, поисковые операции и многие другие задачи. В процессе выполнения этих задач от системы управления роботом требуется формирование траекторий на основе данных, получаемых непрерывно в процессе движения от датчиков, интегрированных в робота. Такие траектории позволяют роботу двигаться быстро и безопасно в неизвестном окружении, содержащем препятствия.
Задача формирования траекторий движения мобильных роботов в среде, содержащей препятствия - это одна из главных проблем в разработке СУ. На данный момент предложено и модифицировано множество методов, которые можно классифицировать по различным критериям, но, в общем случае, говорят о методах, требующих полной или частичной априорной информации об окружении и о тех, что не требуют информации о местоположении препятствий. Первая группа методов преимущественно представляет собой алгоритмы поиска оптимального пути на графе [1, 2], также существуют генетические алгоритмы [3-5] и некоторые другие методы [6-8]. Часто методы первой группы так или иначе могут быть сведены к теории графов. В случае, когда мобильный робот передвигается в частично известном окружении или среде, где находятся динамические препятствия, маршрут также необходимо
планировать динамически, основываясь на показаниях бортовых датчиков и виде предварительно спланированного пути [9, 10]. Недостаток таких
подходов состоит в высокой вычислительной сложности и необходимости разработки эвристик формирования траекторий. В дополнение к вышесказанному траектории, формируемые таким образом, представляют собой набор базовых точек, через которые необходимо пройти роботу. Отсюда, возникает необходимость дополнительного использования интерполяционных алгоритмов, способных обеспечить гладкость траекторий.
Одними из представителей второй группы являются методы на принципе потенциальных полей [11, 12], которые позволяют мобильному роботу двигаться в сложном неизвестном окружении. Однако, подходы такого рода не позволяют управлять траекторией робота в процессе его движения. Также, они могут привести к резкому изменению направления движения, которое не может быть точно отработано СУ робота.
Несмотря на существование большого числа методов формирования траекторий, каждый из них подразумевает решение проблемы в плоскости. Это значительно уменьшает функциональные способности мобильных роботов, передвигающихся в пространстве (подводные, летательные аппараты). Возможность пространственного движения позволяет роботам в некоторых случаях обойти препятствия сверху, без изменения направления движения в горизонтальной плоскости. Однако, при движении в вертикальной плоскости, направление лучей зоны чувствительности бортовых датчиков робота непрерывно изменяется, что может исказить представление о расположении препятствий и привести к генерации неверных траекторий, когда используются традиционные методы.
В некоторых работах рассмотрены методы формирования траекторий в пространстве. В [13] описан гибридный метод для формирования траектории летательного аппарата в гористых местностях. В этом методе сначала формируется оптимальная траектория движения в плоскости на основе сеточного представления окружения робота. Результирующая дискретная траектория сглаживается с помощью метода потенциальных полей. Главный недостаток описанного метода - это необходимость знать карту расположения препятствий в пространстве и неспособность обходить встречающиеся препятствия сверху.
В [14] описан метод преодоления препятствий в вертикальной плоскости на основе информации от бортовых датчиков. Однако, в данной работе угол тангажа робота предполагается неограниченным, то есть всегда можно обойти препятствие сверху. Предположение применимо только к некоторым летательным аппаратам: тем, у которых есть вертикальные подруливающие устройства.
Таким образом, существует задача планирования пространственного маршрута движения мобильного робота в неизвестном окружении, включающем в себя препятствия, на основе показаний датчиков. Этот метод позволит использовать все преимущества пространственного движения.
В настоящей работе данная задача решена на основе метода формирования гладких траекторий в неизвестном окружении, предложенного в [15], с элементами нечеткой логики.
В процессе выполнения данной работы был реализован и дополнен элементами нечеткой логики метод формирования пространственных траекторий движения мобильного робота в неизвестном окружении на основе данных, поступающих с бортовых датчиков приближения, предложенный в работе [15]. Данный алгоритм основан на методе формирования гладких траекторий, описанном в работе [52]. Нечеткая логика применяется в том случае, когда это необходимо для достижения целевой точки, при этом осуществляется некоторый промежуточный режим движения.
Разработанный алгоритм характеризуется механизмом выбора стратегии обхода препятствия: в вертикальной плоскости без коррекции заранее спланированного пути, сбоку с его коррекцией или, если целевая точка находится на вершине возвышенности с резким уклоном и не может быть достигнута путем обхода препятствия сверху, в вертикальной плоскости с одновременной коррекцией исходной траектории - и принципом формирования гладких траекторий, который заключается в использовании сплайнов Безье третьего порядка.
Данный метод отличается малой вычислительной стоимостью и за счет своих особенностей позволяет увеличить скорость движения мобильного робота, что является его преимуществом.
В дальнейшем метод может быть модифицирован путем применения сплайнов Безье к траектории движения робота в пространственных координатах. Работа может вестись в направлении создания режимов, позволяющих роботу обходить препятствие снизу или заезжать в туннели, а также выбирать направление обхода препятствия на основе уже пройденного пути.
1. Lim Chee Wang. Hybrid of global path planning and local navigation implemented on a mobile robot in indoor environment / Lim Chee Wang, Lim Ser Yong, M.H. Ang. // Proceedings of the IEEE International Symposium on Intelligent Control (ISIC). - Vancouver, Canada: - 2002. - С. 821-826.
2. Wu, Zh. Obstacle prediction-based dynamic path planning for a mobile robot / Zh. Wu, L. Feng. // International Journal of Advancements in Computing Technology, 2012. - Vol. 4. - № 3. - C. 118-124.
3. Jianping, T. Genetic algorithm based path planning for a mobile robot / T. Jianping, S. Yang. // Proceedings of the IEEE International Conference on Robotics and Automation. - Taipei, Taiwan: - 2003. - Vol. 1. - С. 1221-1226.
4. Shiltagh, N. Path Planning of Intelligent Mobile Robot Using Modified Genetic Algorithm / N. Shiltagh, L. Jalal. // International Journal of Soft Computing and Engineering (IJSCE), 2013. - Vol. 3. - № 2. - С. 31-36.
5. Sedighi, K.H. Autonomous Local Path-Planning for a Mobile Robot Using a Genetic Algorithm / K.H. Sedighi, K. Ashenayi, T.W. Manikas, R.L. Wainwright and other. // Proceedings of the Congress on Evolutionary Computation. - Portland, USA: - 2004. - Vol. 2. - С. 1338-1345.
6. Shiltagh, N. Optimal path planning for intelligent mobile robot navigation using modified particle swarm optimization / N. Shiltagh, L. Jalal. // International Journal of Engineering and Advanced Technology, 2013. - Vol. 2. - № 4. - С. 260-267.
7. Garrido, S. Path planning for mobile robot navigation using Voronoi diagram and fast marching / S. Garrido, L. Moreno, D. Blanco, P. Jurewicz. // International Journal of Robotics and Automation, 2011. - Vol. 2. - № 1. - С. 42¬64.
8. Mohanraj, T. Mobile robot path planning using ant colony optimization / T. Mohanraj, S. Arunkumar, M. Raghunath, M. Anand. // International Journal of Research in Engineering and Technology (IJRET), 2013. - Vol. 213. - № 11. - С. 1-6.
9. Saha, O. Real-time robot path planning around complex obstacle patterns through learning and transferring options / O. Saha, P. Dasgupta. // Proceedings of the IEEE International Conference on Autonomous Robot Systems and Competitions (ICARSC). - Coimbra, Portugal: - 2017. - С. 278-283.
10. Jiang, M. Mobile robot path planning based on dynamic movement primitives / M. Jiang, Y. Chen, W. Zheng, H. Wu and other. // Proceedings of the IEEE International Conference on Information and Automation. - Ningbo, China: - 2017. - С. 980-985.
11. Ge, S. S. Dynamic motion planning for mobile robots using potential field method / S. S. Ge, Y.J. Cui. // Autonomous Robots, 2002. - Vol. 13. - С. 207-222.
12. Zhou, J.-H. A self-localization and path planning technique for mobile robot navigation / J.-H. Zhou, H.-Y. Lin. // Proceedings of the 8th World Congress on Intelligent Control and Automation (WCICA). - Taipei, Taiwan: - 2013. - С. 694-699.
13. Tan, J. The 3D Path Planning Based on A* Algorithm and Artificial Potential Field for the Rotary-Wing Flying Robot / J. Tan, L. Zhao, Y. Wang, Y. Zhang and other. // Proceedings of the 8th International Conference on Intelligent Human-Machine Systems and Cybernetics (IHMSC). - Hangzhou, China: - 2016. - Vol. 2. - С. 551-556.
14. Агеев, М.Д. Автономные подводные роботы: системы и технологии: учебник / М.Д. Агеев. - М.: Наука, 2005 - 398 с.
15. Yukhimets, D.A. Method of spatial path planning for mobile robot in unknown environment / D.A. Yukhimets, A.V. Zuev, A.S. Gubankov. // Proceedings of the 28th DAAAM International Symposium. - Vienna, Austria: - 2017. - С. 258¬267.
16. Leena, N. A Survey on Path Planning Techniques for Autonomous Mobile robots / N. Leena, K. K. Saju. // . IOSR Journal of Mechanical and Civil Engineering (IOSR-JMCE), 2014. - С. 76-79.
17. Zeyad, A. A. A Comprehensive Study on Pathfinding Techniques for Robotics and Video Games / A. A. Zeyad, S. Shahrizal, K. Hoshang. // International Journal of Computer Games Technology, 2015. - Article ID 736138. - 11 с.
18. Huang, H.-P. Dynamic visibility graph for path planning / H.-P. Huang, S.-Y. Chung. // Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). - Sendai, Japan: - 2004. - Vol. 3. - С. 2813-2818.
19. Janet, J.A. The essential visibility graph: An approach to global motion planning for autonomous mobile robots / J.A. Janet, R.C. Luo, M.G. Kay // Proceedings of the IEEE International Conference on Robotics and Automation. - Nagoya, Japan: - 1995. - Vol. 2. - С. 1958-1963.
20. Habib, M.K. Efficient method to generate collision free paths for an autonomous mobile robot based on new free space structuring approach / M.K. Habib, H. Asama // Proceedings of the IEEE/RSJ International Workshop on intelligent robots and systems. - Osaka, Japan: - 1991. - Vol. 2. - С. 563-567.
21. Peter, E. Hart. A formal basis for the heuristic determination of minimum cost paths / Peter E. Hart, Nils J. Nilsson, Bertram Raphael. // IEEE Transactions on Systems Science and Cybernetics, 1968. - Vol. 4. - С. 100-107.
22. Lingelbach, F. Path planning using probabilistic cell decomposition / F. Lingelbach. // Proceedings of the IEEE International Conference on Robotics and Automation. - New Orleans, LA, USA: - 2004. - Vol. 1. - С. 467-472.
23. Sleumer, N.H. Exact cell decomposition of arrangements used for path planning in robotics / N.H. Sleumer, N. Tschichold-Gurman. // Technical Report, 1999.
24. Elfes, A. Using occupancy grids for mobile robot perception and navigation / A. Elfes. // Computer, 1989. - Vol. 22. - № 6. - C. 46-57.
25. Yahja, A. Framed-quadtree path planning for mobile robots operating in sparse environments / A. Yahja, A. Stentz, S. Singh, B.L. Brumitt. // Proceedings of the IEEE International Conference on Robotics and Automation. - Leuven, Belgium: - 1998. - Vol. 1. - С. 650-655.
26. Kitamura, Y. 3-D path planning in a dynamic environment using an octree and an artificial potential field / Y. Kitamura, T. Tanaka, F. Kishino, M. Yachida. // Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems. - Pittsburgh, PA, USA: - 1995. - Vol. 2. - С. 474-481.
27. Kazakov, K.A. Topological Mapping Complex 3D Environments Using Occupancy Octrees / K.A. Kazakov, V.A. Semenov, V.A. Zolotov. // Proceedings of the 21st International Conference on Computer Graphics and Vision. - Moscow, Russia: - 2011. - С. 111-114.
28. Chazelle, B. Approximation and Decomposition of Shapes / B. Chazelle. // Advances in Robotics: Algorithmic and Geometric Aspects of Robotics, 1987. - Vol. 1. - С. 145-185.
29. De Berg, M. Computational Geometry: Algorithms and Applications: textbook / De Berg M., Cheong O., Van Kreveld M., Overmars M. - 3rd edition. - S.: Springer-Verlag Telos, 2008. - 386 с.
30. Canny, J.F. An opportunistic global path planner / J.F. Canny, M.C. Lin. // Algorithmica, 1993. - Vol. 10. - № 2-4. - С. 102-120.
31. Stuart, J. R. Artificial Intelligence: A Modern Approach: textbook / Stuart
J. Russell, Peter Norvig - 1st edition - Englewood Cliffs, NJ: Prentice-Hall Inc. A Simon and Schuster Company, 1995. - 75 с.
32. Stentz, A. Optimal and Efficient Path Planning for Partially-Known Environments / A. Stentz. // Proceedings of the IEEE International Conference on Robotics and Automation. - San Diego, California: - 1994. - Vol. 4. - С. 3310¬3317.
33. Nash, A. Theta*: Any-Angle Path Planning on Grids / A. Nash, K. Daniel, S. Koenig. // Journal of Artificial Intelligence Research, 2010. - Vol. 39. - С. 533-579.
34. Koenig, S. Lifelong planning A* / S. Koenig, M. Likhachev, D. Furcy. // Artificial Intelligence, 2004. - Vol. 155. - № 1-2. - С. 93-146.
35. Koenig, S. D* lite / S. Koenig, M. Likhachev. // Proceedings of the 18th National Conference on Artificial Intelligence. - Edmonton, Alberta, Canada: - 2002. - С. 476-483.
36. Ge, S.S. New potential functions for mobile robot path planning / S.S. Ge, Y.J. Cui. // IEEE Transactions on Robotics and Automation, 2000. - Vol. 16. - № 5. - С. 615-620.
37. Jing, R. Modified Newton's method applied to potential fieldbased navigation for mobile robots / R. Jing, K.A. McIsaac, R.V. Patel. // IEEE Transactions on Robotics, 2006. - Vol. 22. - № 2. - С. 384-391.
38. Ferrara, A. Second-order sliding-mode control of a mobile robot based on a harmonic potential field / A. Ferrara, M. Rubagotti. // IET Control Theory and Applications, 2008. - Vol. 2. - № 9. - С. 807-818.
39. Khatib, O. Real-time obstacle avoidance for manipulators and mobile robots / O. Khatib. // International Journal of Robotics Research, 1986. - Vol. 5. - № 1. - С. 90-98.
40. Wallgrun, J. O. Voronoi graph matching for robot localization and mapping / J. O. Wallgrun. // Transactions on computational science IX. - B.: Springer, 2010 - С. 76-108.
41. Fan, X.-P. Dynamic obstacle-avoiding path plan for robots based on a new artificial potential field function / X.-p. Fan, S.-y. Li, T.-f Chen. // Control Theory and Applications, 2005. - Vol. 22. - № 5. - С. 703-707.
42. Borenstein, J. The vector field histogram-fast obstacle avoidance for mobile robots / J. Borenstein, Y. Koren. // IEEE Transactions on Robotics and Automation, 1991. - Vol. 7. - № 3. - С. 278-288.
43. Ulrich, I. VFH+: Reliable obstacle avoidance for fast mobile robots / I. Ulrich, J. Borenstein. // Proceedings of the IEEE International Conference on Robotics and Automation. - Leuven, Belgium: - 1998. - Vol. 2. - С. 1572-1577.
44. Ulrich, I. VFH*: Local obstacle avoidance with look-ahead verification / I. Ulrich, J. Borenstein. // Proceedings of the IEEE International Conference on Robotics and Automation. - San Francisco, CA, USA: - 2000. - Vol. 3. - С. 2505-2511.
45. Zhu, Y. A New Bug-type Navigation Algorithm Considering Practical Implementation Issues for Mobile Robots / Yi Zhu, Tao Zhang, Jingyan Song, Xiaqin Li. // Proceedings of the IEEE International Conference on Robotics and Biomimetics. - Tianjin, China: - 2010. - С. 531-536.
46. Emam Fathy Mohamed. An improved Tangent Bug method integrated with artificial potential field for multi-robot path planning / Emam Fathy Mohamed, Khaled El-Metwally, A. R. Hanafy. // Proceedings of the International Symposium on Innovations in Intelligent Systems and Applications. - Istanbul, Turkey: - 2011.
- С. 555-559.
47. Sezer, V. A Novel Obstacle Avoidance Algorithm: Follow the Gap Method / V. Sezer, M. Gokasan. // Robotics and Autonomous Systems, 2012. -Vol. 60. - № 9. - С. 1123-1134.
48. Zohaib, M. An Improved Algorithm for Collision Avoidance in Environments Having U and H Shaped Obstacles / M. Zohaib, M. Pasha, N. Javaid, A. Salaam and other. // Studies in Informatics and Control Journal, 2014. -Vol. 23.
- № 1. - С. 97-106.
49. Zohaib, M. Intelligent Bug Algorithm (IBA): A Novel Strategy to Navigate Mobile Robots Autonomously / M. Zohaib, M. Pasha, J. Nadeem, I. Jamshed. // Proceedings of the Third International Multi-topic Conference. - Jamshoro, Pakistan: - 2012. - С. 291-299.
50. Motlagh, R. E. Development of a new minimum avoidance system for a behavior-based mobile robot / R. E. Motlagh, T. S. Hong, N. Ismail. // Fuzzy Sets and Systems, 2009. -Vol. 160. - № 13. - С. 1929-1946.
51. Бекасов, Д. E. Применение аппарата нечеткой логики при решении задачи поиска пути в неизвестном окружении / Д.Б. Бекасов. // Молодежный научно-технический вестник МГТУ им. Н.Э. Баумана, 2012. - № 5. - С. 40.
52. Filaretov, V.F. Planning smooth paths for mobile robots in an unknown environment / V.F. Filaretov, D.A. Yukhimets. // International Journal of Computer and Systems Sciences, 2017. -Vol. 56. - № 4. - С. 738-748.
53. Filaretov, V.F. The formation of motion laws for mechatronics objects along the paths with the desired speed / V.F. Filaretov, A.S. Gubankov, I.V. Gornostaev. // Proceedings of the International Conference on Computer, Control, Informatics and Its Applications. - Jakarta, Indonesia: - 2016. - С. 93-96.
54. Filaretov, V. F. Adaptive system forming extremely high speed of multilink manipulator gripper / V. F. Filaretov, A. S. Gubankov. // Proceedings of the 23rd International DAAAM Symposium. - Vienna, Austria: - 2016. - С. 473¬476.