Collision avoidance for unmanned surface vehicles based on COLREGS

Unmanned surface vehicles (USVs) are becoming increasingly vital in a variety of maritime applications. The development of a real-time autonomous collision avoidance system is the pivotal issue in the study on USVs, in which the reliable collision risk detection and the adoption of a plausible collision avoidance maneuver play a key role. Existing studies on this subject seldom integrate the International Regulations for Preventing Collisions at Sea 1972 (COLREGS) guidelines. However, in order to ensure maritime safety, it is of fundamental importance that such a regulation should be obeyed at all times. In this paper, an approach of real-time collision avoidance has been presented with the compliance with the COLREGS rules been successfully integrated for USV. The approach has been designed in a way that through the judgment of the collision situation, the velocity and heading angle of the USV are changed to complete the collision avoidance of the obstacle. A strategy with reference obstacle is proposed to deal with the multiple moving obstacles situation. A number of simulations have been conducted in order to confirm the validity of the theoretic results obtained. The results show that the algorithms can sufficiently deal with complex traffic environments and that the generated practical path is suitable for USVs

Autonomous docking using direct optimal control

We propose a method for performing autonomous docking of marine vessels using numerical optimal control. The task is framed as a dynamic positioning problem, with the addition of spatial constraints that ensure collision avoidance. The proposed method is an all-encompassing procedure for performing both docking, maneuvering, dynamic positioning and control allocation. In addition, we show that the method can be implemented as a real-time MPC-based algorithm on simulation results of a supply vessel.Comment: 12th IFAC Conference on Control Applications in Marine Systems, Robotics, and Vehicles (CAMS 2019). IFAC; Daejeon. 2019-09-18 - 2019-09-2

통합형 무인 수상선-케이블-수중선 시스템의 다물체동역학 거동 및 제어

Underwater exploration is becoming more and more important, since a vast range of unknown resources in the deep ocean remain undeveloped. This dissertation thus presents a modeling of the coupled dynamics of an Unmanned Surface Vehicle (USV) system with an Underwater Vehicles (UV) connected by an underwater cable (UC). The complexity of this multi-body dynamics system and ocean environments is very difficult to model. First, for modeling this, dynamics analysis was performed on each subsystem and further total coupled system dynamics were studied. The UV which is towed by a UC is modeled with 6-DOF equations of motion that reflects its hydrodynamic characteristic was studied. The 4th-order Runge–Kutta numerical method was used to analyze the motion of the USV with its hydrodynamic coefficients which were obtained through experiments and from the literature. To analyze the effect of the UC, the complicated nonlinear and coupled UC dynamics under currents forces, the governing equations of the UC dynamics are established based on the catenary equation method, then it is solved by applying the shooting method. The new formulation and solution of the UC dynamics yields the three dimensional position and forces of the UC end point under the current forces. Also, the advantage of the proposed method is that the catenary equations using shooting method can be solved in real time such that the calculated position and forces of UC according to time can be directly utilized to calculate the UV motion. The proposed method offers advantages of simple formulation, convenient use, and fast calculation time with exact result. Some simple numerical simulations were conducted to observe the dynamic behaviors of AUV with cable effects. The simulations results clearly reveal that the UC can greatly influence the motions of the vehicles, especially on the UV motions. Based on both the numerical model and simulation results developed in the dissertation, we may offer some valuable information for the operation of the UV and USV. Secondly, for the design controller, a PD controller and its application to automatic berthing control of USV are also studied. For this, a nonlinear mathematical model for the maneuvering of USV in the presence of environmental forces was firstly established. Then, in order to control rudder and propeller during automatic berthing process, a PD control algorithm is applied. The algorithm consists of two parts, the forward velocity control and heading angle control. The control algorithm was designed based on the longitudinal and yaw dynamic models of USV. The desired heading angle was obtained by the so-called “Line of Sight” method. To support the validity of the proposed method, the computer simulations of automatic USV berthing are carried out. The results of simulation showed good performance of the developed berthing control system. Also, a hovering-type AUV equipped with multiple thrusters should maintain the specified position and orientation in order to perform given tasks by applying a dynamic positioning (DP) system. Besides, the control allocation algorithm based on a scaling factor is presented for distributing the forces required by the control law onto the available set of actuators in the most effective and energy efficient way. Thus, it is necessary for the robust control algorithm to conduct successfully given missions in spite of a model uncertainty and a disturbance. In this dissertation, the robust DP control algorithm based on a sliding mode theory is also addressed to guarantee the stability and better performance despite the model uncertainty and disturbance of current and cable effects. Finally, a series of simulations are conducted to verify the availability of the generated trajectories and performance of the designed robust controller. Thirdly, for the navigation of UV, a method for designing the path tracking controller using a Rapidly-exploring Random Trees (RRT) algorithm is proposed. The RRT algorithm is firstly used for the generation of collision free waypoints. Next, the unnecessary waypoints are removed by a simple path pruning algorithm generating a piecewise linear path. After that, a path smoothing algorithm utilizing cubic Bezier spiral curves to generate a continuous curvature path that satisfies the minimum radius of curvature constraint of underwater is implemented. The angle between two waypoints is the only information required for the generation of the continuous curvature path. In order to underwater vehicle follow the reference path, the path tracking controller using the global Sliding Mode Control (SMC) approach is designed. To verify the performance of the proposed algorithm, some simulation results are performed. Simulation results showed that the RRT algorithm could be applied to generate an optimal path in a complex ocean environment with multiple obstacles.Acknowledgement .................................................................................................. vi Abstract……. ....................................................................................... ………….viii Nomenclature ....................................................................................................... xvi List of Abbreviations ........................................................................................... xxi List of Tables ...................................................................................................... xxiii List of Figures ..................................................................................................... xxiv Chapter 1: Introduction ......................................................................................... 1 1.1 Background .................................................................................................. 1 1.1.1 Unmanned Surface Vehicles (USVs) ...................................................... 1 1.1.2 Umbilical Cable ....................................................................................... 4 1.1.3 Unmanned Underwater Vehicles (UUVs) ............................................... 5 1.1.4 Literature on Modeling of Marine Vehicles ............................................ 9 1.1.5 Literature on Control and Guidance of Marine Vehicles ...................... 11 1.2 Our System Architecture ........................................................................... 12 1.3 Motivation ................................................................................................. 13 1.4 Contribution ............................................................................................... 16 1.5 Publications Associated to the Dissertation .............................................. 17 1.6 Structure of the Dissertation ...................................................................... 18 Chapter 2: Mathematical Model of Unmanned Surface Vehicle (USV) ......... 20 2.1 Basic Assumptions .................................................................................... 20 2.2 Three Coordinate Systems ......................................................................... 20 2.3 Variable Notation ...................................................................................... 22 2.4 Kinematics ................................................................................................. 23 2.5 Kinetics ...................................................................................................... 26 2.5.1 Rigid Body Equations of Motion ........................................................... 26 2.5.2 Hydrodynamic Forces and Moments ..................................................... 28 2.5.3 Restoring Forces and Moments ............................................................. 31 2.5.4 Environmental Disturbances .................................................................. 32 2.5.5 Propulsion Forces and Moments ........................................................... 35 2.6 Nonlinear 6DOF Dynamics ....................................................................... 35 2.7 Mathematical Model of USV in 3 DOF .................................................... 36 2.7.1 Planar Kinematics .................................................................................. 36 2.7.2 Planar Nonlinear 3 DOF Dynamics ....................................................... 38 2.8 Configuration of Thrusters ........................................................................ 40 2.9 General Structure and Model Parameters .................................................. 41 2.9.1 Structure of USV ................................................................................... 41 2.9.2 Control System of USV ......................................................................... 42 2.9.3 Winch Control System ........................................................................... 43 Chapter 3: Mathematical Model of the Umbilical Cable (UC) ........................ 45 3.1 Basic Assumptions for UC ........................................................................ 45 3.2 Analysis on Forces of UV ......................................................................... 47 3.3 Relation for UC Equilibrium ..................................................................... 50 3.4 Catenary Equation in the Space Case ........................................................ 51 3.5 Shooting Method ....................................................................................... 55 3.6 Boundary Conditions ................................................................................. 57 3.7 Cable Effects ............................................................................................. 58 3.8 Model Parameters and Simulation ............................................................. 59 Chapter 4: Mathematical Model of Underwater Vehicle (UV) ........................ 63 4.1 Background ................................................................................................ 63 4.1.1 Basic Assumptions................................................................................. 63 4.1.2 Reference Frames .................................................................................. 64 4.1.3 Notations ................................................................................................ 65 4.2 Kinematics Equations ................................................................................ 66 4.3 Kinetic Equations ...................................................................................... 67 4.3.1 Rigid-Body Kinetics .............................................................................. 67 4.3.2 Hydrostatic Terms ................................................................................. 69 4.3.3 Hydrodynamic Terms ............................................................................ 70 4.3.4 Actuator Modeling ................................................................................. 75 4.3.5 Umbilical Cable Forces ......................................................................... 75 4.4 Nonlinear Equations of Motion (6DOF) ................................................... 76 4.5 Simplification of UV Dynamic Model ...................................................... 77 4.5.1 Simplifying the Mass and Inertia Matrix ............................................... 78 4.5.2 Simplifying the Hydrodynamic Damping Matrix.................................. 79 4.5.3 Simplifying the Gravitational and Buoyancy Vector ............................ 80 4.6 Thruster Modeling ..................................................................................... 80 4.7 Current Modeling ...................................................................................... 83 4.8 Dynamic Model Including Ocean Currents ............................................... 84 4.9 Complete Motion Equations of AUV (6DOF) .......................................... 89 4.10 Dynamics Model Parameter Identification ................................................ 91 4.11 Numerical Solution for Equations of Motion ............................................ 93 4.12 General Structure and Model Parameters .................................................. 94 4.12.1 Structure of AUV ............................................................................... 94 4.12.2 Control System of AUV ..................................................................... 96 Chapter 5: Guidance Theory ............................................................................... 97 5.1 Configuration of GNC System .................................................................. 97 5.1.1 Guidance ................................................................................................ 98 5.1.2 Navigation .............................................................................................. 98 5.1.3 Control ................................................................................................... 98 5.2 Maneuvering Problem Statement .............................................................. 99 5.3 Guidance Objectives ................................................................................ 100 5.3.1 Target Tracking ................................................................................... 100 5.3.2 Trajectory Tracking ............................................................................. 100 5.4 Waypoint Representation ........................................................................ 101 5.5 Path Following ......................................................................................... 102 5.6 Line of Sight (LOS) Waypoint Guidance ................................................ 102 5.6.1 Enclosure-Based Steering .................................................................... 104 5.6.2 Look-ahead Based Steering ................................................................. 105 5.6.3 LOS Control......................................................................................... 106 5.7 Cubic Polynomial for Path-Following ..................................................... 107 Chapter 6: Control Algorithm Design and Analysis ....................................... 110 6.1 Proportional Integral Differential (PID) Controller ................................ 110 6.1.1 General Theory .................................................................................... 110 6.1.2 Stability of General PID Controller ..................................................... 112 6.1.3 PID Tuning .......................................................................................... 114 6.1.4 Nonlinear PID for Marine Vehicles ..................................................... 116 6.1.5 Nonlinear PD for Marine Vehicles ...................................................... 117 6.1.6 Stability of Designed PD Controller .................................................... 117 6.2 Sliding Mode Controller .......................................................................... 118 6.2.1 Tracking Error and Sliding Surface ..................................................... 119 6.2.2 Chattering Situation ............................................................................. 120 6.2.3 Control Law and Stability .................................................................... 121 6.3 Allocation Control ................................................................................... 124 6.3.1 Linear Quadratic Unconstrained Control Allocation Using Lagrange Multipliers ................................................................................................ 125 6.3.2 Thruster Allocation with a Constrained Linear Model ........................ 127 6.4 Simulation Results and Discussion ......................................................... 131 6.4.1 Berthing (parking) Control of USV ..................................................... 133 6.4.2 Motion Control of UV ......................................................................... 136 Chapter 7: Obstacle Avoidance and Path Planning for Vehicle Using Rapidly-Exploring Random Trees Algorithm.................................................................. 168 7.1 Path Planning and Guidance: Two Interrelated Problems ....................... 168 7.2 RRT Algorithm for Exploration .............................................................. 171 7.2.1 Random Node Selection ...................................................................... 172 7.2.2 Nearest Neighbor Node Selection ....................................................... 173 7.2.3 RRT Exploration with Obstacles ......................................................... 174 7.3 RRT Algorithm for Navigation of AUV ................................................. 176 7.3.1 Basic RRT Algorithm .......................................................................... 176 7.3.2 Biased-Greedy RRT Algorithm ........................................................... 178 7.3.3 Synchronized Biased-Greedy RRT Algorithm .................................... 179 7.4 Path Pruning ............................................................................................ 182 7.4.1 Path Pruning Using LOS ..................................................................... 182 7.4.2 Global Path Pruning ............................................................................. 183 7.5 Summarize the Proposed RRT Algorithm ............................................... 185 7.6 Simulation for Path Following of AUV .................................................. 187 Chapter 8: Simulation of Complete USV-UC-UV Systems ............................ 196 8.1 Simulation Procedure .............................................................................. 196 8.2 Simulation Results and Discussion ......................................................... 201 8.2.1 Dynamic Behaviors of Complete USV (Stable)-Cable- AUV (Turning Motion) ..................................................................................................... 201 8.2.2 Dynamic Behaviors of Complete USV (Forward motion)-Cable- AUV (Turning Motion) ...................................................................................... 207 8.2.3 Applied Controller to Complete USV -Cable- AUV ........................... 215 Chapter 9: Conclusions and Future Works ..................................................... 238 9.1 Modeling of Complete USV-Cable-AUV System .................................. 238 9.2 Motion Control ........................................................................................ 239 9.3 Cable Force and Moment at the Tow Points ........................................... 239 9.4 Path Planning ........................................................................................... 239 9.5 Future Works ........................................................................................... 240Docto

A COLLISION AVOIDANCE SYSTEM FOR AUTONOMOUS UNDERWATER VEHICLES

The work in this thesis is concerned with the development of a novel and practical collision avoidance system for autonomous underwater vehicles (AUVs). Synergistically, advanced stochastic motion planning methods, dynamics quantisation approaches, multivariable tracking controller designs, sonar data processing and workspace representation, are combined to enhance significantly the survivability of modern AUVs. The recent proliferation of autonomous AUV deployments for various missions such as seafloor surveying, scientific data gathering and mine hunting has demanded a substantial increase in vehicle autonomy. One matching requirement of such missions is to allow all the AUV to navigate safely in a dynamic and unstructured environment. Therefore, it is vital that a robust and effective collision avoidance system should be forthcoming in order to preserve the structural integrity of the vehicle whilst simultaneously increasing its autonomy. This thesis not only provides a holistic framework but also an arsenal of computational techniques in the design of a collision avoidance system for AUVs. The design of an obstacle avoidance system is first addressed. The core paradigm is the application of the Rapidly-exploring Random Tree (RRT) algorithm and the newly developed version for use as a motion planning tool. Later, this technique is merged with the Manoeuvre Automaton (MA) representation to address the inherent disadvantages of the RRT. A novel multi-node version which can also address time varying final state is suggested. Clearly, the reference trajectory generated by the aforementioned embedded planner must be tracked. Hence, the feasibility of employing the linear quadratic regulator (LQG) and the nonlinear kinematic based state-dependent Ricatti equation (SDRE) controller as trajectory trackers are explored. The obstacle detection module, which comprises of sonar processing and workspace representation submodules, is developed and tested on actual sonar data acquired in a sea-trial via a prototype forward looking sonar (AT500). The sonar processing techniques applied are fundamentally derived from the image processing perspective. Likewise, a novel occupancy grid using nonlinear function is proposed for the workspace representation of the AUV. Results are presented that demonstrate the ability of an AUV to navigate a complex environment. To the author's knowledge, it is the first time the above newly developed methodologies have been applied to an A UV collision avoidance system, and, therefore, it is considered that the work constitutes a contribution of knowledge in this area of work.J&S MARINE LT

TASKS STATEMENT FOR MODERN AUTOMATIC CONTROL THEORY OF UNDERWATER COMPLEXES WITH FLEXIBLE TETHERS

The definition of a new class of control objects is proposed. It is an underwater complex with flexible tethers (UCFT) for which there is the need to automate motion control under uncertainty and nonstationarity of own parameters and external disturbances. Classification of marine mobile objects and characteristics of the flexible tethers as UCFT elements is given. The basic UCFTs configurations that are used in the implementation of advanced underwater technologies are revealed. They include single-, double- and three-linked structures with surface or underwater support vessels and self-propelled or towed underwater vehicles. The role of mathematical modeling in tasks of motion control automation is shown. The tasks of UCFT mathematical modeling are formulated for synthesis and study of its automatic control systems. Generalized structures of mathematical models of UCFT basic elements are proposed as the basis for the creation of simulating complex to study the dynamics of its motion. The tasks of UCFT identification as a control object are formulated. Their consistent solution will help to obtain a UCFT mathematical model. The basic requirements for UCFT automatic motion control systems are determined. Their satisfaction will ensure implementation of selected underwater technology. Areas of development of synthesis methods of UCFT automatic control systems are highlighted

Planning for Autonomous Operation of Unmanned Surface Vehicles

The growing variety and complexity of marine research and application oriented tasks requires unmanned surface vehicles (USVs) to operate fully autonomously over long time horizons even in environments with significant civilian traffic. The autonomous operations of the USV over long time horizons requires a path planner to compute paths over long distances in complex marine environments consisting of hundreds of islands of complex shapes. The available free space in marine environment changes over time as a result of tides, environmental restrictions, and weather. Secondly, the maximum velocity and energy consumption of the USV is significantly influenced by the fluid medium flows such as strong currents. Finally, the USV have to operate in an unfamiliar, unstructured marine environment with obstacles of variable dimensions, shapes, and motion dynamics such as other unmanned surface vehicles, civilian boats, shorelines, or docks poses numerous planning challenges. The proposed Ph.D. dissertation explores the above mentioned problems by developing computationally efficient path and trajectory planning algorithms that enables the long term autonomous operation of the USVs. We have developed a lattice-based 5D trajectory planner for the USVs operating in the environment with the congested civilian traffic. The planner estimates collision risk and reasons about the availability of contingency maneuvers to counteract unpredictable behaviors of civilian vessels. Secondly, we present a computationally efficient and optimal algorithm for long distance path planning in complex marine environments using A* search on visibility graphs defined over quad trees. Finally, we present an A* based path planning algorithm with newly developed admissible heuristics for computing energy efficient paths in environment with significant fluid flows. The effectiveness of the planning algorithms is demonstrated in the simulation environments by using systems identified dynamics model of the wave amplitude modular vessel (WAM-V) USV14

Control-law for Oil Spill Mitigation with a team of Heterogeneous Autonomous Vehicles

Oil spill incidents in the sea or harbours occur with some regularity during exploration, production, and transport of petroleum products. In order to mitigate the impact of the oil spill in the marine life, immediate, safety, effective and eco-friendly actions must be taken. Autonomous vehicles can assume an important contribution by establishing a cooperative and coordinated intervention. This dissertation presents the development of two path planning control-laws, the first one an autonomous surface vehicle (ASV) being able to contour the oil spill while s deploying microorganisms and nutrients (bioremediation) capable of mitigate and contain the oil spill spread, and the second one for a unmanned aerial vehicle (UAV) in order to perform the coverage of the entire spillage area with the same microorganisms and nutrients deployment capabilities. In order to validate both methods, a simulation environment was developed in Gazebo with a oil spill scenario, an ASV and an UAV. Field tests have been conducted in the Leixões Harbour in Porto, Portugal.Incidentes relacionados com derrames de petróleo no oceano ou em portos ocorrem com alguma regularidade, durante a exploração, produção e transporte de petróleo e seus derivados. Para mitigar o impacto desses derramamentos na fauna e flora marinha de uma forma imediata, segura, efectiva e amiga do ambiente novas ações são necessárias. Veículos autónomos podem providenciar uma importante contribuição estabelecendo uma intervenção cooperativa e coordenada. Esta dissertação apresenta o desenvolvimento de dois algoritmos de controlo para o planeamento de trajectórias, a primeira para um veículo de superfície autónomo (ASV) ser capaz de contornar o perímetro do derrame enquanto distribui microorganismos e nutrientes (bio-remediação), capazes de mitigar e conter a propagação do derramamento de petróleo e a segunda para um veículo aéreo não-tripulado (UAV) ser capaz de cobrir todo a área de derrame enquanto distribui os mesmos microorganismos e nutrientes. De forma a validar ambos os métodos, um ambiente de simulação foi desenvolvido em Gazebo com cenário do derrame de petróleo, um ASV e um UAV. Testes de campo foram realizados no porto de Leixões, no Porto, Portugal

Underwater Vehicles

For the latest twenty to thirty years, a significant number of AUVs has been created for the solving of wide spectrum of scientific and applied tasks of ocean development and research. For the short time period the AUVs have shown the efficiency at performance of complex search and inspection works and opened a number of new important applications. Initially the information about AUVs had mainly review-advertising character but now more attention is paid to practical achievements, problems and systems technologies. AUVs are losing their prototype status and have become a fully operational, reliable and effective tool and modern multi-purpose AUVs represent the new class of underwater robotic objects with inherent tasks and practical applications, particular features of technology, systems structure and functional properties

Розробка системи автоматичного керування ланкою підводного комплексу з гнучкими зв’язками

Блінцов, О. В. Розробка системи автоматичного керування ланкою підводного комплексу з гнучкими зв’язками = Development of automatic control system of underwater complex branch with flexible connections / О. В. Блінцов // Зб. наук. пр. НУК. – Миколаїв : НУК, 2016. – № 4 (466). – С. 75–83.Запропоновано спосіб формалізації структури підводного комплексу з гнучкими зв’язками (ПКГЗ), який дає змогу виділити керовані ланки в ньому. Синтезовано систему автоматичного керування (САК) ланкою ПКГЗ у складі розроблених інверсних регуляторів телекерованого підводного апарата та кабельної лебідки. Методом комп’ютерного моделювання досліджено розроблену САК. Отриманий результат утворює основу для синтезу САК багатоланковими ПКГЗ.Synthesis of automatic control systems (ACS) of spatial motion of underwater systems with flexible connections (USFC) forms the actual scientific problem. Own nonlinearity remotely operated underwater vehicle (ROV) enhanced nonlinearity flexible connections that make up USFC. Synthesis of ACS and USFC link forms the basis for automatic control of both onelink and multilink USFC. The method of the formalization of USFC structure is in the form of a graph model. It is represented on the basis of defined-controlled units of USFC. The method of inverse dynamics is synthesized from the regulators spatial movement of TPA and cable winches to control the length of the flexible part of the issued bonds. A BAC USFC link, which includes TPA, a cable winch and synthesized regulators, is the basis for the automation of spatial movement of onelink and multilink USFC. Computer simulation work of NAO investigates USFC link. The result is quite satisfactory for the automatic management of objects of such complexity.Предложен способ формализации структуры подводного комплекса с гибкими связями (ПКГС), который дает возможность выделить управляемые звенья в нём. Синтезирована система автоматического управления (САУ) звеном ПКГС в составе разработанных инверсных регуляторов телеуправляемого подводного аппарата и кабельной лебедки. Методом компьютерного моделирования исследована разработанная САУ. Полученный результат является основой для синтеза САУ многозвенными ПКГС