blaich et al. - 2012 - extended grid based collision avoidance considering colregs for vessels

6
Extended Grid Based Collision Avoidance Considering COLREGs for Vessels Michael Blaich * Michael Rosenfelder * Michael Schuster * Oliver Bittel * Johannes Reuter * * University of Applied Sciences Konstanz, Konstanz, 78462 Germany (e-mail: [email protected]). Abstract: In this work a grid based collision avoidance algorithm which considers the physical constrains of a vessel is presented. For this purpose a new geometry neighbourhood is introduced and explained in detail. The collision avoidance algorithm pays attention to the COLREGs and provides a collision-free path. To find this path, Lee’s algorithm is used. Keywords: Collision avoidance, Ship navigation, Path planning, Lee’s algorithm, COLREGs, Optimal route, Raster grid 1. INTRODUCTION In the last decades, vessel traffic and average cursing speed have increased, thus the collision risk for vessels is rising. Many Collision Avoidance (CA) algorithms are carried out in maritime navigation research to decrease this collision risk. Most research is carried out to develop supporting systems for vessel navigators. However, most of these algo- rithms consider only other vessels but not the environment e.g., the shore line or other static obstacles. Another way to prevent collisions is to develop systems which can au- tonomously generate manoeuvres to avoid collisions. These systems have to consider both, other vessels and static obstacles. Nowadays, collision avoidance manoeuvres con- sidering the local traffic and other obstacles are usually subject to the navigator’s own reaction and judgement. To adjust several avoidance manoeuvres, traffic rules are required. Therefore, the only specific rules for maritime navigation are the collision regulations (COLREGs 1 ). As reported in Perrow (1984), 56% of the maritime collisions are caused by the violation of the COLREGs. Thus, a CA system which considers the COLREGs could be benefiting for the vessel navigator. There are several navigational advising systems to simplify the decision finding process for the navigator, but they do not autonomously avoid collisions. For example, the Vessel Traffic Service (VTS), is a marine traffic monitoring system established by harbour authorities to observe the marine traffic. The idea of the system is a central unit, receiving navigation information of all vessels and sending the traffic situation to every connected vessel. Another system is the Automatic Identification System (AIS). AIS is an automated tracking system used on vessels and is included into VTS for identifying and locating vessels by electronically exchanging data with other nearby vessels and VTS stations. The Automatic Radar Plotting Aid (ARPA) is also used for tracking other objects. A radar with ARPA capability can create tracks using radar con- tacts. The system calculates the tracked objects course, 1 The International Regulations for Preventing Collisions at Sea speed and Closest Point of Approach (CPA). A possi- ble collision with other vessels or shore lines can so be recognised. One major drawback is, that these systems are expensive and not suitable for small vessels like they are used on the Lake Constance. This work focuses on a CA for small vessels in inland waters or ports where high traffic density and narrow envi- ronment leads to high collision risks. Thus, the close range collision avoidance methods have become an important subject. The developed algorithm can be used for a fully autonomous collision avoidance, since it considers other vessels, static obstacles like a jetty, a bridge or the shore lines, and the COLREGs. It provides a collision free path regarding the physical constrains of a vessel. This ensures that the vessel can follow the provided path. The algorithm calculates the CPA with other vessels or static obstacles in a local area of up to 800 m. This range corresponds to the radar sensor range used to detect other vessels. In general, there are two possibilities to avoid collisions. First, is to adjust the vessel’s velocity according to avoid collisions with other vessels. The second is to dismiss the current path and continue on an alternative course. The presented Extended Grid Based Collision Avoidance (EGBCA) approach focuses on planning an alternative collision free path. But the speed altering for collision avoidance could also be used by calculating different tra- jectories depending on different speed. The algorithm for the alternative path calculation is based on the approach of Szlapczynski (2005) and uses a raster grid. For the raster grid, a variation of the maze-routing algorithm presented by Lee (1961) is implemented to find a collision-free path from the current position to a given goal. The maze- routing algorithm always finds the shortest path. The drawback of this path is that it could include many turns which lead to an unqualified vessel course. Szlapczynski (2005) extended the maze-algorithm by introducing turn penalties to achieve more suitable path with less turns for vessel manoeuvres. Physical constrains like the turning rate are not considered in Szlapczynski (2005), which lim- its the algorithm. In his approach, the vessel can reach all

Upload: mohamed-elsayed-hasan

Post on 17-Jan-2016

13 views

Category:

Documents


1 download

DESCRIPTION

Blaich et al. - 2012 - Extended Grid Based Collision Avoidance Considering COLREGs for Vessels

TRANSCRIPT

Page 1: Blaich Et Al. - 2012 - Extended Grid Based Collision Avoidance Considering COLREGs for Vessels

Extended Grid Based Collision AvoidanceConsidering COLREGs for Vessels

Michael Blaich ∗ Michael Rosenfelder ∗ Michael Schuster ∗

Oliver Bittel ∗ Johannes Reuter ∗

∗ University of Applied Sciences Konstanz, Konstanz, 78462 Germany(e-mail: [email protected]).

Abstract: In this work a grid based collision avoidance algorithm which considers the physicalconstrains of a vessel is presented. For this purpose a new geometry neighbourhood is introducedand explained in detail. The collision avoidance algorithm pays attention to the COLREGs andprovides a collision-free path. To find this path, Lee’s algorithm is used.

Keywords: Collision avoidance, Ship navigation, Path planning, Lee’s algorithm, COLREGs,Optimal route, Raster grid

1. INTRODUCTION

In the last decades, vessel traffic and average cursing speedhave increased, thus the collision risk for vessels is rising.Many Collision Avoidance (CA) algorithms are carried outin maritime navigation research to decrease this collisionrisk. Most research is carried out to develop supportingsystems for vessel navigators. However, most of these algo-rithms consider only other vessels but not the environmente.g., the shore line or other static obstacles. Another wayto prevent collisions is to develop systems which can au-tonomously generate manoeuvres to avoid collisions. Thesesystems have to consider both, other vessels and staticobstacles. Nowadays, collision avoidance manoeuvres con-sidering the local traffic and other obstacles are usuallysubject to the navigator’s own reaction and judgement.To adjust several avoidance manoeuvres, traffic rules arerequired. Therefore, the only specific rules for maritimenavigation are the collision regulations (COLREGs 1 ). Asreported in Perrow (1984), 56% of the maritime collisionsare caused by the violation of the COLREGs. Thus, a CAsystem which considers the COLREGs could be benefitingfor the vessel navigator.

There are several navigational advising systems to simplifythe decision finding process for the navigator, but theydo not autonomously avoid collisions. For example, theVessel Traffic Service (VTS), is a marine traffic monitoringsystem established by harbour authorities to observe themarine traffic. The idea of the system is a central unit,receiving navigation information of all vessels and sendingthe traffic situation to every connected vessel. Anothersystem is the Automatic Identification System (AIS). AISis an automated tracking system used on vessels and isincluded into VTS for identifying and locating vessels byelectronically exchanging data with other nearby vesselsand VTS stations. The Automatic Radar Plotting Aid(ARPA) is also used for tracking other objects. A radarwith ARPA capability can create tracks using radar con-tacts. The system calculates the tracked objects course,

1 The International Regulations for Preventing Collisions at Sea

speed and Closest Point of Approach (CPA). A possi-ble collision with other vessels or shore lines can so berecognised. One major drawback is, that these systems areexpensive and not suitable for small vessels like they areused on the Lake Constance.

This work focuses on a CA for small vessels in inlandwaters or ports where high traffic density and narrow envi-ronment leads to high collision risks. Thus, the close rangecollision avoidance methods have become an importantsubject. The developed algorithm can be used for a fullyautonomous collision avoidance, since it considers othervessels, static obstacles like a jetty, a bridge or the shorelines, and the COLREGs. It provides a collision free pathregarding the physical constrains of a vessel. This ensuresthat the vessel can follow the provided path. The algorithmcalculates the CPA with other vessels or static obstaclesin a local area of up to 800 m. This range corresponds tothe radar sensor range used to detect other vessels.

In general, there are two possibilities to avoid collisions.First, is to adjust the vessel’s velocity according to avoidcollisions with other vessels. The second is to dismissthe current path and continue on an alternative course.The presented Extended Grid Based Collision Avoidance(EGBCA) approach focuses on planning an alternativecollision free path. But the speed altering for collisionavoidance could also be used by calculating different tra-jectories depending on different speed. The algorithm forthe alternative path calculation is based on the approachof Szlapczynski (2005) and uses a raster grid. For the rastergrid, a variation of the maze-routing algorithm presentedby Lee (1961) is implemented to find a collision-free pathfrom the current position to a given goal. The maze-routing algorithm always finds the shortest path. Thedrawback of this path is that it could include many turnswhich lead to an unqualified vessel course. Szlapczynski(2005) extended the maze-algorithm by introducing turnpenalties to achieve more suitable path with less turnsfor vessel manoeuvres. Physical constrains like the turningrate are not considered in Szlapczynski (2005), which lim-its the algorithm. In his approach, the vessel can reach all

Page 2: Blaich Et Al. - 2012 - Extended Grid Based Collision Avoidance Considering COLREGs for Vessels

Fig. 1. The vessel Korona from the HTWG Konstanz usedfor dimensioning and testing the CA algorithm on theLake Constance.

neighbour cells in the grid apart from the previously usedcell. To be able to turn a real vessel about 135 degree inone cell, a large cell size is required. For our vessel Koronashown in Figure 1, the cell size would be about 40 m. Innarrow environment like ports or channels, this cell size isnot suitable for CA. Therefore, the EGBCA extends thegrid by a cell size independent model of the vessel dynamicwhich regards the physical constrains of the vessel.

To use the CA algorithm on real vessels, some furtherextensions are required. First, the algorithm has to keepthe conditions of the COLREGs. This is realized byadopting the ship domain of Goodwin et al. (1975) for theother vessels. Further, the collision-free path should havea tangential connection to the original path, in this workcalled global path. This is necessary because the CA onlyworks in a local domain of 800 m but the global path canbe much longer. Therefore, the collision-free path requiresa tangential connection to the global path to get a smoothchangeover from the local collision-free path to the globalpath.

This work is structerd in 5 sections. In section 2, simi-lar approaches for maritime collision avoidance are intro-duced. Section 3 presents a new grid based approach toovercome the limitations of the previous ones. The exper-imental results are shown in section 4. Finally, section 5concludes this work with some future prospects.

2. RELATED WORK

Collision avoidance of vessels has been first discussed bySharpey-Schafer (1955). The discussion focused on the be-haviour of marine traffic in general and optimal strategiesfor evasive manoeuvres in close range encounters. Thiswork concentrates on general issues and provides somesuggestions how to act in a possible collision situation.Collision avoidance research for vessels, nearly stoppedfor the next decades after this discussion. Because of,increasing traffic and collisions on sea in the last twodecades, research focused on theoretical and practical de-velopments of collision avoidance systems. The intensive

research started with a fuzzy set approach published byJames (1986).

Nowadays, many different approaches are carried out formaritime collision avoidance. An overview of the algo-rithms developed in the last decades is given in Statheroset al. (2007) and Tam et al. (2009). Referring to thesepublications, the CA algorithms can by divided into twogroups, the deterministic and the heuristic approaches.Deterministic approaches use mathematical models andalgorithms to find an optimal solution. Depending onthe problem complexity and the large search space, thecomputing time of these algorithms is high. Thus, most ofthese approaches are not suitable for a real CA system. Toreduce this computing time, heuristic approaches searchfor an acceptable solution in a subspace. Therefore, oftensoft-computing techniques based on Artificial Intelligence(AI) are adopted. Some typical soft-computing methodsused for CA algorithms are evolutionary algorithms, fuzzylogic, neural networks, expert systems and combinations ofthese as hybrid systems. Referring to Tam et al. (2009), themost promising algorithm is the evolutionary algorithmpublished by Smierzchalski (1999). But for this work thefocus is on a deterministic approach. Tam et al. (2009)claim that the approach of Szlapczynski (2005) is the mostpractical and the most efficient one. The approach is basedon Chang et al. (2003) which uses a raster grid and themaze-routing algorithm.

Approaches with raster grid realize the search by iteratingover predefined steps and guarantee a solution if there isone. A raster grid is an extension of an occupancy gridbut stores more then one value per cell. The grids areused to discretise the search space for a faster processing.These approaches have become more popular in the lastdecade. The reason is the increasing storage space andcomputer performance. Search algorithms like the maze-routing algorithm used in Chang et al. (2003) find anoptimal path in these grids. The grid raster of Changet al. (2003) stores in each cell if it is sea or land, if thecell is occupied by an other vessel and the arrival time ofthe own vessel. The maze-routing algorithm always findsthe shortest path. This does not have to be the optimalpath for vessel navigation if it consist of many turns.For vessel navigation, a straight path with a minimumof turns is mostly preferred by navigators. To solve thisproblem, Szlapczynski (2005) presented a modified versionof this approach and added turn penalties to each cell.This results in a path with a minimum of turns which ismore suitable for vessel navigation. Additionally, he addedthe possibility to reduce the own vessel’s speed to avoid acollision. This speed altering is only used if no collision-freepath exists for the current speed.

3. EXTENDED GRID BASED COLLISIONAVOIDANCE

The EGBCA is based on the approach of Szlapczynski(2005) who extended the approach of Chang et al. (2003)by turn-penalties. Both approaches will not be further ex-plained, it is assumed that the reader is familiar with these.The main improvements of the EGBCA regarding to theprevious approaches are a new neighbourhood geometrycalled T-neighbourhood and the tangential connection to

Page 3: Blaich Et Al. - 2012 - Extended Grid Based Collision Avoidance Considering COLREGs for Vessels

the global path. The T-neighbourhood is used to considerthe vessel’s physical constraints. For this purpose, a newstoring method for the orientation of the vessel in thegrid is required which leads to a new calculation of theturn penalties. This extension provides the possibility touse a smaller cell size which improves the accuracy andthe consideration of the COLREGs because of a betterapproximation of the ship domain.

Normally the vessel follows a predefined global path. Thispath is given be an autopilot system or by the vessel’snavigator and is not checked for collisions. The EGBCAchecks if collisions occur in a subsection of the path. Thissubsection is also called local area. The size of the localarea is adopted to the sensor’s range for detecting othervessels. For this work a grid size of 400 cells with a cellsize of 2 m is used. Only considering a subsection of theglobal path leads to the problem that the vessel has toreturn to the global path after a collision is avoided.To get a drivable path, the reconnection to the globalpath should be smooth. Therefore, the EGBCA uses atangential connection between the local collision-free andthe global path.

A further extension for the collision avoidance process isthe providing of supporting points of a trajectory insteadof list of visited cells as done in the previous approaches. Tofind the supporting points of the visited cells, the Douglasand Peucker (1973) algorithm is used. As presented inSchuster et al. (2012), supporting points can be directlyused for navigation systems to control the vessel.

3.1 Considering Vessel’s physical constraints

Each vessel has its own dynamic characteristics. For CA,the most important characteristic is the maximal turningrate which defines the turning circle. This turning rate isgiven in degrees per travelled meter. If the CA does notconsider this turning rate, the vessel may not be able tonavigate on the planed path. For this work the physicalconstrains of the Korona are used, with a turning rateof 0.66667◦/m. This means for a track length of 10 m ,theKorona can change the orientation of about 6.6667◦. To re-gard this performance, the T-neighbourhood is introduced.An overview of the traditional geometry neighbourhood isgiven in Chang et al. (2003). Contrary to the traditionalgeometry neighbourhoods the T-neighbourhood only con-siders the cells reachable by the vessel even for a smallcell size. This leads to a neighbourhood’s geometry whichlooks like the character T. For this work, the vertical lineis called body and the horizontal line is called head. Inthis work, the T-neighbourhood is normalized to a headof three cells. The physical constrains can be applied bymodify the length of the body. Using the Korona and a cellsize of 2 m e.g., leads to a T-neighbourhood with a headof three cells and a body of four cells which is shown inFigure 2.

Using the T-neighbourhood requires a precise orientationwhich is not reachable with the discretised orientationsused by traditional geometry neighbourhoods. They reacha maximum step size for the orientation of 11.25◦ for a16-geometry neighbourhood. This is not suitable for theT-neighbourhood. To solve this problem, the orientationof the vessel is stored in an undiscretised form in each

Fig. 2. Example of the T-neighbourhood for the boatKorona and a cell size of 2 m.

Fig. 3. The domain presented by Goodwin et al. (1975)and its basic representation (if a ship is considered asone cell) in the grid raster

cell. Therefore, the EGBCA only discretise the position ofthe vessel including the latitude and longitude coordinates.But the incoming orientation for each cell is stored as anundiscretised value. Using these undiscretised orientationvalues the turn penalties have to be calculated betweenthe incoming and outgoing orientation. This leads to newturn penalties. To adopt this turn penalties to the cell sizeof the grid, a scaling factor is added.

3.2 Considering the COLREGs

As a benefit of the T-neighbourhood a raster grid witha small cell size can be used. This provides a preciserealisation of the ship domain presented by Goodwin et al.(1975). This approach obtaines a non-symmetric ship do-main which is divided into three sectors as shown in Figure3. For each sector a different dimension is used to modelthe collision risk for the direction of this sector. Using thisship domain for other vessels and Lee’s algorithm to findthe collision-free path enabled the consideration of theCOLREGs since Lee’s algorithm finds the shortest pathto pass this domain. Therefore, the path on the stern sideis shorter than on the bow side and on the port side it isshorter then on the starboard side. In a heading situatione.g. , this leads to avoidance manoeuvre for the own vesselto the starboard side to pass the other vessel on the portside. This is conform to the COLREGs. Detailed tests withconsidering the COLREGs by the EGBCA are presentedin section 4.

3.3 Tangential Connection to the Global Path

In vessel navigation, typically a global path is planned anda CA algorithm checks in a local area if the subsection ofthe path is collision-free. A scenario with a global path

Page 4: Blaich Et Al. - 2012 - Extended Grid Based Collision Avoidance Considering COLREGs for Vessels

Fig. 4. Consideration of tangential connection to the globalpath.

and a local area for the CA is shown in Figure 4. Theblue line is the global path and the vessel is shown in themiddle of the red marked window which defines the localarea. The shore line and the pier are marked orange andthe vessel is highlighted in red. If the CA generates a newcollision-free path, it has to be connected tangential tothe global path. To consider this tangential connection,two new virtual circular obstacles are added to the grid.This can be seen at the right part of Figure 4. Theseobstacles are called funnel, based on their functionality.The diameter of these obstacles corresponds to the turncircle of the vessel to consider this physical constraint.These obstacles are created by a wave-front propagationalgorithm.

4. EXPERIMENTAL RESULTS

To analyse the performance of the EGBCA and theconsideration of the COLREGs, several test scenarios arecarried out. These scenarios have been verified by Perera(2010) with his fuzzy logic approach. For all tests, twovessels with different course conditions are used. The ownvessel has a speed of 1m/s and the other vessel 2m/s. Inall the scenarios, collisions have been avoided confirm toguidelines of the COLREGs.

4.1 Heading

In the heading scenario the other vessel drives straighttowards the own vessel. The result of the EGBCA is a pathpassing the other vessel parallel on port side as shown inFigure 5.

0 10 20 30 40 50 60−5

0

5

Fig. 5. Heading scenario.

4.2 Overtaking

If the own vessel is overtaken by another vessel, normallythe own vessel stays on the course. But if the other vesselhas a higher priority as the own vessel, the own vesselhas to dismiss his path. The overtaking scenario simulatesan overtaking by a vessel with higher priority. For thisscenario the EGBCA dismisses its path and successfullyavoids a collision as shown in Figure 6.

−20 −10 0 10 20 30 40−5

0

5

Fig. 6. Overtaking scenario.

4.3 Crossing Port Side

The crossing port side scenario shows the crossing byanother vessel from port side. The EGBCA plans a pathto pass the other vessel on stern side as shown in Figure 7.

0 10 20 30 40−10

−5

0

5

10

15

20

25

30

35

40

45

Fig. 7. Crossing port side scenario.

4.4 Crossing Port Bow Side

In this scenario, the other vessel drives towards the ownvessel from port bow side. The EGBCA plans a pathto pass the other vessel on stern side. This is shown inFigure 8.

0 10 20 30 40−5

0

5

10

15

20

25

30

35

Fig. 8. Crossing port bow side scenario.

Page 5: Blaich Et Al. - 2012 - Extended Grid Based Collision Avoidance Considering COLREGs for Vessels

4.5 Crossing Port Stern Side

In this scenario, the other vessel drives towards the ownvessel from port stern side. The EGBCA plans a pathwhich first goes parallel to the other vessel and then passeson stern side. This is shown in Figure 9.

0 10 20 30 40−10

−5

0

5

10

15

20

25

30

35

Fig. 9. Crossing port stern side scenario.

4.6 Crossing Starboard Side

In the crossing starboard side scenario, the other vesseldrives towards the own vessel from starboard side. TheEGBCA plans a path to pass the other vessel on sternside as shown in Figure 10.

0 10 20 30 40−45

−40

−35

−30

−25

−20

−15

−10

−5

0

5

Fig. 10. Crossing starboard side scenario.

4.7 Crossing Starboard Bow Side

In this scenario, the other vessel drives towards the ownvessel from starboard bow side. The EGBCA plans a pathto pass the other vessel on stern side. This is shown inFigure 11.

0 10 20 30 40 50−35

−30

−25

−20

−15

−10

−5

0

5

Fig. 11. Crossing starboard bow side scenario.

4.8 Crossing Starboard Stern Side

In this scenario, the other vessel drives towards the ownvessel from starboard stern side. The EGBCA plans a pathwhich first goes parallel to the other vessel and then passeson stern side. This is shown in Figure 12.

0 10 20 30 40−30

−25

−20

−15

−10

−5

0

5

10

Fig. 12. Crossing starboard stern side scenario.

5. CONCLUSION

This work presented a grid based collision avoidance al-gorithm. The algorithm uses a special T-neighbourhoodfor the grid search algorithm to consider the physicalconstraints of the vessel. This new T-neighbourhood offersthe possibility to use a smaller cell size. Some of thedeficiencies reported by Tam et al. (2009) for the approachof Szlapczynski (2005) are eliminated by this work. Theextendability to other objectives is guaranteed by thevariability of the cell size. Smaller cell sizes also lead to animproved consideration of the COLREGs. The confirma-tion of the produced collision avoidance manoeuvres withthe COLREGs is proved in several tests.

For future work the T-neighbourhood could be modeleddynamically and asymmetric to regard external influencee.g., wind and river current.

Page 6: Blaich Et Al. - 2012 - Extended Grid Based Collision Avoidance Considering COLREGs for Vessels

REFERENCES

Chang, K.Y., Jan, G.E., and Parberry, I. (2003). A Methodfor Searching Optimal Routes with Collision Avoidanceon Raster Charts.

Douglas, D. and Peucker, T. (1973). Algorithms for thereduction of the number of points required to representa digitized line or its caricature. Cartographica: TheInternational Journal for Geographic Information andGeovisualization, 10(2), 112–122.

Goodwin, E., Polytechnic, L., and for National Aca-demic Awards, C. (1975). A statistical study of shipdomains. Cambridge Univ Press.

James, M. (1986). Modelling the decision process incomputer simulation of ship navigation. Journal ofNavigation, 39(01), 32–48.

Lee, C. (1961). An algorithm for path connections and itsapplications. Electronic Computers, IRE Transactionson, 30, 1389–1401.

Perera, L.P. (2010). Autonomous guidance and navigationbased on the COLREGs rules and regulations of collisionavoidance . Design, (1999), 205–216.

Perrow, C. (1984). Normal Accidents: Living With High-Risk Technologies. Basic Books, Inc., New York, USA.

Schuster, M., Reuter, J., and Blaich, M. (2012). Inte-gration von Navigationsalgorithmen in Regelkreise amBeispiel autonomer Systeme auf dem Wasser. Karl-sruher Geowissenschaftliche Schriften, Rehie B - Ver-messung und Photogrammetrie.

Sharpey-Schafer, J.M. (1955). Collision at Sea. Journal ofNavigation, 8(03), 261–280.

Smierzchalski, R. (1999). Evolutionary trajectory planningof ships in navigation traffic areas. Journal of marinescience and technology, 4(1), 1–6.

Statheros, T., Howells, G., and Maier, K.M. (2007). Au-tonomous Ship Collision Avoidance Navigation Con-cepts, Technologies and Techniques.

Szlapczynski, R. (2005). A New Method of Ship Routingon Raster Grids, with Turn Penalties and CollisionAvoidance.

Tam, C., Bucknall, R., and Greig, A. (2009). Reviewof Collision Avoidance and Path Planning Methods forShips in Close Range Encounters.