ВЕСТНИК«
ГОСУДАРСТВЕННОГО УНИВЕРСИТЕТА ......^
МОРСКОГО И РЕЧНОГО ФЛОТА ИМЕНИ АДМИРАЛА С. О. МАКАРОВА,
ЭКСПЛУАТАЦИЯ ВОДНОГО ТРАНСПОРТА,
СУДОВОЖДЕНИЕ
DOI: 10.21821/2309-5180-2021-13-3-307-315
STATIC OBSTACLES AVOIDANCE ALGORITHM FOR UNMANNED SHIP
A. A. Dyda, I. I. Pushkarev, K. N. Chumakova
Maritime State University named after admiral G. I. Nevelskoy,
Vladivostok, Russian Federation
An algorithm for the formation of a route for unmanned ship along a given trajectory and avoiding static obstacles is proposed in the paper. The algorithm is implemented by combining the trajectory motion function and the function that generates circulation around a given point (obstacle). The route of movement is defined by a set of waypoints with coordinates connected by straight line segments. The obstacle is specified in the form of the center coordinate and the radius of the obstacle. To move along the trajectory, an algorithm based on the use of the sum of the gradient vector of the auxiliary function and the vector that specifies the direction on a given route section is used. This allows the vessel to move along a given route. Circulations around the obstacle are formed on the basis of a special class of vector fields proposed in the works of D. Panagou, H. G. Tanner, K. J. Kyriakopoulos. By orienting the circulation in the direction of movement along the trajectory at the point of the obstacle and limiting it to a given maneuvering zone, a navigation vector field, which is a set of vectors showing the required direction of movement at a specific point, is formed. To reduce the probability of an unmanned ship piling up on an obstacle and to ensure safe maneuvering, an additional "repulsive" vector field, which forms a "forbidden" zone in the navigation vector field, is introduced. The algorithms under study are implemented in the Matlab / Simulink modeling environment. The results of numerical experiments are presentedfor various combinations of algorithm parameters. The results are presented graphically in the form of displaying navigation vector fields showing the movement direction of the unmanned ship, and displaying obstacles, prohibited zones and maneuvering zones. Further improvement of the algorithm for solving problems of avoiding dynamic and group obstacles is planned.
Keywords: unmanned ship, waypoint, algorithm, vector field, navigation vector field, circulation, trajectory, route, static obstacle, maneuvering zone.
For citation:
Dyda, Aleksandr A., Igor I. Pushkarev, and Ksenya N. Chumakova. "Static obstacles avoidance algorithm
for unmanned ship." Vestnik Gosudarstvennogo universiteta morskogo i rechnogo flota imeni admirala
S. O. Makarova 13.3 (2021): 307-315. DOI: 10.21821/2309-5180-2021-13-3-307-315.
УДК 681.5
АЛГОРИТМ ОБХОДА СТАТИЧЕСКИХ ПРЕПЯТСТВИЙ ДЛЯ БЕЗЭКИПАЖНОГО СУДНА
А. А. Дыда, И. И. Пушкарев, К. Н. Чумакова
Морской Государственный университет имени адмирала Г. И. Невельского,
Владивосток, Российская Федерация
В работе предложен алгоритм формирования маршрута движения безэкипажного судна по заданной траектории и обходу статических препятствий. Алгоритм реализован путем комбинирования функции движения по траектории и функции, формирующей циркуляцию вокруг заданной точки (препятствия). Маршрут движения задается набором путевых точек с координатами соединенных отрезками прямых, препятствие — в виде координаты центра и радиуса препятствия. Для движения по траектории используется алгоритм, основанный на использовании суммы вектора градиента вспомогательной функции и вектора, задающего направление на заданном участке маршрута, что позволяет обеспечить движение судна вдоль заданного маршрута. Циркуляции вокруг препятствия формируются на основе специального класса
2 О 2
ЛВЕСТНИК
............ГОСУДАРСТВЕННОГО УНИВЕРСИТЕТА
Х^ОРСКОГО И РЕЧНОГО ФЛОТА ИМЕНИ АДМИРАЛА С. О. МАКАРОВА
векторных полей, предложенных в работах D. Panagou, H. G. Tanner, K. J. Kyriakopoulos. При ориентировании циркуляции в направлении движения по траектории в точке препятствия и ограничении ее заданной зоной маневрирования формируется навигационное векторное поле — набор векторов, показывающих требуемое направление движения в конкретной точке. Для уменьшения вероятности навала безэкипажного судна на препятствие и обеспечения безопасного маневрирования введено дополнительное «отталкивающее» векторное поле, формирующее «запрещенную» зону в навигационном векторном поле. Исследуемые алгоритмы реализованы в среде моделирования Matlab/Simulink. Приведены результаты численных экспериментов для различных сочетаний параметров алгоритма. Результаты представлены графически в виде отображения навигационных векторных полей, показывающих направление движения безэкипажного судна и отображения препятствий, запрещенных зон и зон маневрирования. Планируется дальнейшее совершенствование алгоритма для решения задач обхода динамических и групповых препятствий.
Ключевые слова: безэкипажное судно, путевая точка, алгоритм, векторное поле, навигационное векторное поле, циркуляция, траектория, маршрут, статическое препятствие, зона маневрирования.
Для цитирования:
Дыда А. А. Алгоритм обхода статических препятствий для безэкипажного судна / А. А. Дыда, И. И. Пушкарев, К. Н. Чумакова // Вестник Государственного университета морского и речного флота имени адмирала С. О. Макарова. — 2021. — Т. 13. — № 3. — С. 307-315. DOI: 10.21821/2309-51802021-13-3-307-315.
со
г
со
см о
Введение (Introduction)
В современном мире наблюдается повышенный интерес к новому виду морского транспорта — безэкипажным судам (БЭС) [1], [2] как обширной области, имеющей большой потенциал развития и разнообразные сферы применения — от дистанционно управляемых судов с берегового поста управления до полностью автоматических судов, работающих без вмешательства человека.
Безэкипажные суда имеют множество преимуществ по сравнению с традиционными, и в первую очередь их применение позволяет исключить пребывание людей в опасных морских условиях, а также снизить стоимость эксплуатации и повысить безопасность судоходства [3], [4]. Все это заставляет многие страны и компании проводить научные исследования и опытно-конструкторские работы, направленные на развитие технологий безэкипажного судовождения.
Следует отметить, что в настоящее время существует ряд серьезных проблем и ограничений в области безэкипажных судов — это и устаревшее морское законодательство, в котором не учтены современные достижения науки и техники в безэкипажных технологиях [5], и организационные трудности, связанные с использованием и эксплуатацией БЭС, и ряд серьезных технических проблем, требующих качественного решения. К последним относятся вопросы, связанные с разработкой системы управления движением БЭС, которым посвящено большое количество работ. В частности, в работе [6] решается задача синтеза траектории движения судна, принципы построения алгоритмов управления БЭС в акватории порта рассмотрены в статье [7], в работе [8] исследована гибридная система управления движением БЭС в заданную точу.
Целью настоящей работы является решение частной задачи по созданию алгоритма обхода статических препятствий, встречающихся при движении БЭС по заданной траектории.
Методы и материалы (Methods and Materials)
Для движения БЭС по заданной траектории, представленной набором путевых точек с координатами (xi,yi), i = 0,1,..., n, используем алгоритм [9] на основе градиента вспомогательной функции, обеспечивающий движение судна вдоль заданного маршрута, описанный далее.
Уравнение i-го фрагмента планируемой траектории движения, соединяющей путевые точки
(x,у) с (xi+i>y+i) имеет вид:
k = ; bi = y -kxx; (1)
xi+i xi
У = kix + b, (2)
где k, b — соответствующие константы, определяемые через координаты путевых точек.
ВЕСТНИК,
ГОСУДАРСТВЕННОГО УНИВЕРСИТЕТА
МОРСКОГО И РЕЧНОГО ФЛОТА ИМЕНИ АДМИРАЛА С. О. МАКАРОВА^
Введем функцию двух переменных Fi (х, у) так, чтобы она достигала экстремума (максимума) на .-м участке маршрута судна:
^ (х у ) = --2 (у - к1х - ь )2.
(3)
Компоненты вектора-градиента функции Fi (х, у) вычисляются по формуле
grad^ = (к (у - к1х - Ь), - у + к1х + Ь). (4)
Введем вспомогательный вектор = (м?^,единичной длины, направленный вдоль го участка траектории движения судна. Его компоненты вычисляются через координаты путевых точек (хг, уг) и (хг+1, уг+1), определяющих й участок запланированной траектории движения судна:
Ж =
(5)
_ Уi+1 - Уi
* л/сх+1- х )2 +(у+1- Уi )2
^ _
Определим вектор :
= gradF; (х у)+щ =
\
— + ам?х1,—^ + ащ. dyi
(6)
где а — весовой коэффициент, а > 0.
На рис. 1 показан пример поля векторов градиента для функции Fw, которое является навигационным векторным полем — набором векторов, показывающих требуемое направление движение БЭС в конкретной точке.
Рис. 1. Пример поля векторов F . (вектора нормированы)
2 О 2
Существует ряд публикаций, в которых предлагаются различные подходы для построения алгоритма обхода статических препятствий. Для формирования траектории обхода препятствия
ЛВЕСТНИК
............ГОСУДАРСТВЕННОГО УНИВЕРСИТЕТА
Х^ОРСКОГО И РЕЧНОГО ФЛОТА ИМЕНИ АДМИРАЛА С. О. МАКАРОВА
используем следующий класс векторных полей, предложенный в работах D. Panagou, H. G. Tanner, K. J. Kyriakopoulos [10], [11]:
F'(r) = Х(рт r)r -p(rT r), (7)
где r = [x y]т , p = [px py ] — параметры ориентации поля; X — специальный параметр.
При определенных значениях X приведенная формула позволяет создавать векторные поля с различными свойствами, в том числе формирующие циркуляцию вокруг заданной точки. Для X = 1 векторное поле имеет вид:
К = Pyxy -р хУ2; Fy= PxXy -р yx 2;
(8)
px =cos (ф);
Py =sin (ф),
где ф — угол ориентации векторного поля.
Визуальное представление [12] данного векторного поля приведено на рис. 2. Очевидно, что векторное поле (8), позволяющее обходить препятствие по окружности, требует модификации для продолжения движения по заданному маршруту без избыточного маневрирования.
со г
Рис. 2. Векторное поле F' (X = 1, p = 1, p = 0, вектора нормированы)
см о
Разделим векторное поле Г' на две полуплоскости А+ и А прямой, проходящей через центр препятствия и перпендикулярной вектору направления движения ^ в данной точке. Для положительной полуплоскости А+ векторное поле Г' формируется при Х = 0. Тогда итоговое векторное поле обхода препятствия Г' имеет вид (рис. 3):
F ' = <
(Py*y ~РХУ2, РхХУ "Py*2) —дляточек (x, y)e A~; (-p ^^2 -p *x2, -p yy2 -p y* 2) —дляточек (x, y )e A+.
(9)
ВЕСТНИК«)
ГОСУДАРСТВЕННОГО УНИВЕРСИТЕТА ^^
МОРСКОГО И РЕЧНОГО ФЛОТА ИМЕНИ АДМИРАЛА С. О. МАКАРОВА
А1
. —^v44\\\\\\\\\U \ ^
\N \ П \ U
^тш т!
НШШШ 1 1
i: ; /////////// 7\
vv// A J
.101-'-'-•-'--,
-10 -в -в -4 н2 О 2 4 в 8 10
Рис. 3. Итоговое векторное поле F' (px = 1, p = 0, вектора нормированы)
Результаты (Results)
Построим навигационное векторное поле F (рис. 4) для движения БЭС с учетом векторного поля обхода статического препятствия F' и векторного поля заданной траектории движения Fw:
F =
¡dfw +(1 -5, )F' для Ц < R2;
[ Fwi для Ц > R2-
(10)
я2 - л1
где 5,. — коэффициент влияния; Я1 — радиус препятствия; R2 — радиус зоны маневрирования; Di — расстояние от центра препятствия до текущего положения безэкипажного судна.
а)
б)
Рис. 4. Примеры навигационного координаты препятствия (0,0); б — R, :
векторного поля F: а — R = 1, R2 = 3, = 2, R2 = 5 , координаты препятствия (1, -1)
2 О 2
Навигационное векторное поле F позволяет двигаться по заданной траектории, обходя имеющиеся на пути статические препятствия, с учетом размера препятствия и заданной зоны маневрирования. Однако в связи с особенностями безэкипажного судна (Underactuated Vehicle) [13], на которое оказывает значительное воздействие внешняя среда (ветер, течения), возможен навал БЭС на препятствие. Для уменьшения вероятности подобного последствия навигационное векторное поле F может быть дополнено введением «отталкивающих» векторов в ближней области препятствия.
Выберем «отталкивающее» векторное поле F" для препятствия с координатами (xobst, yobst) в виде:
F"= 2 (x - xob5t); F" = 2(y - yobt).
(11)
Введем параметр радиус запрещенной зоны Я/ , которым будут ограничены влияние векторного поля Г" и коэффициент ц.. Тогда навигационное векторное поле Г примет вид:
F =
F" для Д < R,;
Vf' + (1 -ц ,) F" для R > Di < R; SF + (1 -Si) для я;> Dl < R2; Fwi для Dl > R2
5..=
- R'.
(12)
R2 - R1
CO
г
со
^ =
A - R r,- r,
Графическое представление примеров полученных навигационных полей при различных параметрах приведено на рис. 5.
а)
б)
e>j
Рис. 5. Примеры навигационного векторного поля Г: а — Я1 = 1, Я[ = 3, Я2 = 6, координаты препятствия (-2, 3); б — Я. = 2, Я1 = 4, Я. = 7, координаты препятствия (0,0)
Заключение (Conclusion)
Предложен алгоритм (12), использующий специальные функции для генерации навигационного векторного поля, которое формирует требуемое направление движения БЭС с учетом обхода статических препятствий. Алгоритм обеспечивает безопасный обход препятствий путем введения дополнительного «отталкивающего» векторного поля, принуждающее судно к маневрированию в разрешенной зоне. Приведенные результаты моделирования подтвердили работоспособность алгоритма при различных параметрах. Планируется его дальнейшее развитие для решения задач обхода динамических и групповых препятствий.
СПИСОК ЛИТЕРАТУРЫ
1. Koikas G. New Technology trends in the design of Autonomous Ships / G. Koikas, M. Papoutsidakis, N. Niki-takos // International Journal of Computer Application. — 2019. — Vol. 178. — No. 25. — Pp. 4-7. DOI: 10.5120/ ijca2019919043.
2. Komianos A. The autonomous shipping era. operational, regulatory, and quality challenges / A. Komianos // TransNav: International Journal on Marine Navigation and Safety of Sea Transportation. — 2018. — Vol. 12. — No. 2. — Pp. 335-348. DOI: 10.12716/1001.12.02.15.
3. Kretschmann L. Analyzing the economic benefit of unmanned autonomous ships: An exploratory cost-comparison between an autonomous and a conventional bulk carrier / L. Kretschmann, H. C. Burmeister, C. Jahn // Research in transportation business & management.—2017.—Vol. 25.—Pp. 76-86. DOI: 10.1016/ j.rtbm.2017.06.002.
4. Wróbel K. Towards the assessment of potential impact of unmanned vessels on maritime transportation safety / K. Wróbel, J. Montewka, P. Kujala // Reliability Engineering & System Safety. — 2017. — Vol. 165. — Pp. 155-169. DOI: 10.1016/j.ress.2017.03.029.
5. Дмитриев В. И. Методы обеспечения безопасности мореплавания при внедрении беспилотных технологий / В. И. Дмитриев, В. В. Каретников // Вестник Государственного университета морского и речного флота имени адмирала С. О. Макарова. — 2017. — Т. 9. — № 6. — С. 1149-1158. DOI: 10.21821/2309-51802017-9-6-1149-1158.
6. Смоленцев С. В. Простая аналитическая модель движения судна / С. В. Смоленцев, Д. В. Исаков // Вестник Государственного университета морского и речного флота имени адмирала С. О. Макарова. — 2019. — Т. 11. — № 1. — С. 7-21. DOI: 10.21821/2309-5180-2019-11-1-7-21.
7. Каретников В. В. Основные принципы построения алгоритмов управления беспилотным судном в акватории порта / В. В. Каретников, С. В. Рудых, А. А. Буцанец // Речной транспорт (XXI век). — 2019. — № 2 (90). — С. 55-57.
8. Пшихопов В. Х. Гибридная система управления движением безэкипажного судна в заданную точку / В. Х. Пшихопов, М. Ю. Медведев, В. В. Соловьев // Известия ЮФУ. Технические науки. — 2019. — № 1 (203). — С. 163-176. DOI: 10.23683/2311-3103-2019-1-163-176.
9. Дыда А. А. Подход к управлению судном по траектории на основе градиента вспомогательной функции / А. А. Дыда, К. Н. Чумакова, И. И. Пушкарев // Научные проблемы водного транспорта. — 2020. — № 65. — С. 27-36. DOI: 10.37890/jwt.vi65.125.
10. Panagou D. Control of nonholonomic systems using reference vector fields / D. Panagou, H. G. Tanner, K. J. Kyriakopoulos // 2011 50th IEEE Conference on Decision and Control and European Control Conference. — IEEE, 2011. — Pp. 2831-2836. DOI: 10.1109/CDC.2011.6160922.
11. Panagou D. Motion planning and collision avoidance using navigation vector fields / D. Panagou // 2014 IEEE International Conference on Robotics and Automation (ICRA). — IEEE, 2014. — Pp. 2513-2518. DOI: 10.1109/ICRA.2014.6907210.
12. Сирота А. А. Методы и алгоритмы анализа данных и их моделирование в Matlab: учеб. пособие / А. А. Сирота. — СПб.: БХВ — Петербург, 2016. — 384 с.
13. Yi G. Research on Underactuated USV Path Following Algorithm / G. Yi, Z. Liu, J. Q. Zhang, J. Dong // 2020 IEEE 4th Information Technology, Networking, Electronic and Automation Control Conference (ITNEC). — IEEE, 2020. — Vol. 1. — Pp. 2141-2145. DOI: 10.1109/ITNEC48623.2020.9085222.
2 О 2
TJ »ВЕСТНИК
............ГОСУДАРСТВЕННОГО УНИВЕРСИТЕТА
VjyiOPCKOrO И РЕЧНОГО ФЛОТА ИМЕНИ АДМИРАЛА С. О.
МАКАРОВА
REFERENCES
1. Koikas, G., M. Papoutsidakis, and N. Nikitakos. "New Technology trends in the design of Autonomous Ships." International Journal of Computer Application 178.25 (2019): 4-7. DOI: 10.5120/ijca2019919043.
2. Komianos, Aristotelis. "The autonomous shipping era. Operational, regulatory, and quality challenges." TransNav: International Journal on Marine Navigation and Safety of Sea Transportation 12.2 (2018): 335-348. DOI: 10.12716/1001.12.02.15.
3. Kretschmann, Lutz, Hans-Christoph Burmeister, and Carlos Jahn. "Analyzing the economic benefit of unmanned autonomous ships: An exploratory cost-comparison between an autonomous and a conventional bulk carrier." Research in transportation business & management 25 (2017): 76-86. DOI: 10.1016/j.rtbm.2017.06.002.
4. Wrobel, Krzysztof, Jakub Montewka, and Pentti Kujala. "Towards the assessment of potential impact of unmanned vessels on maritime transportation safety." Reliability Engineering & System Safety 165 (2017): 155-169. DOI: 10.1016/j.ress.2017.03.029.
5. Dmitriev, Vladimir I., and Vladimir V. Karetnikov. "Methods of ensuring the safety of navigation when implement unmanned technology." Vestnik Gosudarstvennogo universiteta morskogo i rechnogo flota imeni admirala S. O. Makarova 9.6 (2017): 1149-1158. DOI: 10.21821/2309-5180-2017-9-6-1149-1158.
6. Smolentsev, Sergey V., and Dmitry V. Isakov. "A simple analytical model of ship movement." Vestnik Gosudarstvennogo universiteta morskogo i rechnogo flota imeni admirala S. O. Makarova 11.1 (2019): 7-21. DOI: 10.21821/2309-5180-2019-11-1-7-21.
7. Karetnikov, V., S. Rudykh, and A. Butsanets. "Basic principles for creating algorithms of control unmanned ship in port's water area." River transport (21st century) 2(90) (2019): 55-57.
8. Pshikhopov, Viacheslav Khasanovich, Mikhail Yur'evich Medvedev, and Viktor Vladimirovich Solovjev. "A hybrid control system of movement of unmanned vessel to a given point." Izvestiya SFedU. Engineering sciences 1(203) (2019): 163-176.
9. Dyda, Alexander A., Ksenya N. Chumakova, and Igor I. Pushkarev. "Auxiliary function gradient approach to marine vehicle path-following control." Russian Journal of Water Transport 65 (2020): 27-36. DOI: 10.37890/ jwt.vi65.125.
10. Panagou, Dimitra, Herbert G. Tanner, and Kostas J. Kyriakopoulos. "Control of nonholonomic systems using reference vector fields." 2011 50th IEEE Conference on Decision and Control and European Control Conference. IEEE, 2011. 2831-2836. DOI: 10.1109/CDC.2011.6160922.
11. Panagou, Dimitra. "Motion planning and collision avoidance using navigation vector fields." 2014 IEEE International Conference on Robotics and Automation (ICRA). IEEE, 2014. 2513-2518. DOI: 10.1109/ ICRA.2014.6907210.
12. Sirota, A. A. Metody i algoritmy analiza dannykh i ikh modelirovanie v Matlab: ucheb. posobie. SPb.: BKhV — Peterburg, 2016.
13. Yi, Ge, Zhong Liu, Jian-Qiang Zhang, and Jiao Dong. "Research on Underactuated USV Path Following Algorithm." 2020 IEEE 4th Information Technology, Networking, Electronic and Automation Control Conference (ITNEC). Vol. 1. IEEE, 2020. 2141-2145. DOI: 10.1109/ITNEC48623.2020.9085222.
ИНФОРМАЦИЯ ОБ АВТОРАХ
INFORMATION ABOUT THE AUTHORS
CO
314J
Дыда Александр Александрович —
доктор технических наук, профессор
Морской государственный университет имени
адмирала Г. И. Невельского
690003, Российская Федерация, г. Владивосток,
ул. Верхнепортовая, д. 50а
e-mail: adyda@mail.ru
Пушкарев Игорь Игоревич — аспирант
Научный руководитель:
Дыда Александр Александрович
Морской государственный университет
имени адмирала Г. И. Невельского
690003, Российская Федерация, г. Владивосток,
ул. Верхнепортовая, д. 50а
e-mail: B_r_i_g88@mail.ru
Dyda, Aleksandr A. —
Dr. of Technical Sciences, professor Maritime State University named after admiral G. I. Nevelskoy
50a, Verhneportovaya Str., Vladivostok, 690003,
Russian Federation
e-mail: adyda@mail.ru
Pushkarev, Igor I. — Postgraduate
Supervisor:
Dyda, Aleksandr A.
Maritime State University named
after admiral G. I. Nevelskoy
50a, Verhneportovaya Str., Vladivostok, 690003,
Russian Federation
e-mail: B_rig88@mail.ru
ВЕСТНИК«)
ГОСУДАРСТВЕННОГО УНИВЕРСИТЕТА ^^
МОРСКОГО И РЕЧНОГО ФЛОТА ИМЕНИ АДМИРАЛА С. О. МАКАРОВА
Чумакова Ксения Николаевна — аспирант
Научный руководитель:
Дыда Александр Александрович
Морской государственный университет имени
адмирала Г. И. Невельского
690003, Российская Федерация, г. Владивосток,
ул. Верхнепортовая, д. 50а
e-mail: ksushechka_1991@mail.ru
Chumakova, Ksenya N. — Postgraduate
Supervisor:
Dyda, Aleksandr A.
Maritime State University named
after admiral G. I. Nevelskoy
50a, Verhneportovaya Str., Vladivostok, 690003,
Russian Federation
e-mail: ksushechka_1991@mail.ru
Статья поступила в редакцию 19 марта 2021 г.
Received: March 19, 2021.
2 О 2