NONLINEAR ADAPTIVE HEADING CONTROL FOR AN UNDERACTUATED SURFACE VESSEL WITH CONSTRAINED INPUT AND SIDESLIP ANGLE COMPENSATION

In this paper, a nonlinear adaptive heading controller is developed for an underactuated surface vessel with constrained input and sideslip angle compensation. The controller design is accomplished in a framework of backstepping technique. First, to amend the irrationality of the traditional definition of the desired heading, the desired heading is compensated by the sideslip angle. Considering the actuator physical constrain, a hyperbolic tangent function and a Nussbaum function are introduced to handle the nonlinear part of control input. The error and the disturbance are estimated and compensated by an adaptive control law. In addition, to avoid the complicated calculation of time derivatives of the virtual control, the command filter is introduced to integrate with the control law. It is analysed by the Lyapunov theory that the closed loop system is guaranteed to be uniformly ultimately bounded stability. Finally, the simulation studies illustrate the effectiveness of the proposed control method

Finite-Time Tracking Control for a Class of MIMO Nonlinear Systems with Unknown Asymmetric Saturations

This paper addresses the problem of finite-time tracking control for multiple-input and multiple-output (MIMO) nonlinear systems with asymmetric saturations. A systematic approach is proposed to eliminate the effects of unmeasured external disturbances and unknown asymmetric saturations. In the proposed control strategy, a terminal sliding mode disturbance observer is provided to estimate the augmented disturbance (which contains the unknown asymmetric input saturation and external disturbance). The approximation error of the augmented disturbance can converge to zero in a fixed finite-time interval. Furthermore, a novel finite-time tracking control algorithm is developed to guarantee fast convergence of the tracking error. Compared with the existing results on finite-time tracking control, the chattering problem and the input saturation problem can be solved in a unified framework. Several simulations are given to demonstrate the effectiveness of the proposed approach

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

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

Adaptive neural network control of underactuated surface vessels with guaranteed transient performance: Theory and experimental results

In this paper, an adaptive trajectory trackingcontrol algorithm for underactuated unmanned surfacevessels (USVs) with guaranteed transient performance isproposed. To meet the realistic dynamical model of USVs,we consider that the mass and damping matrices are notdiagonal and the input saturation problem. Neural Networks(NNs) are employed to approximate the unknown externaldisturbances and uncertain hydrodynamics of USVs. Moreover,both full state feedback control and output feedbackcontrol are presented, and the unmeasurable velocities ofthe output feedback controller are estimated via a highgainobserver. Unlike the conventional control methods,we employ the error transformation function to guaranteethe transient tracking performance. Both simulation andexperimental results are carried out to validate the superiorperformance via comparing with traditional potential integral(PI) control approaches

Biomimetic oscillating foil propulsion to enhance underwater vehicle agility and maneuverability

Submitted in partial fulfillment of the requirements for the degree of Doctor of Philosophy at the Massachusetts Institute of Technology and the Woods Hole Oceanographic Institution June 2008Inspired by the swimming abilities of marine animals, this thesis presents "Finnegan the RoboTurtle", an autonomous underwater vehicle (AUV) powered entirely by four flapping foils. Biomimetic actuation is shown to produce dramatic improvements in AUV maneuvering at cruising speeds, while simultaneously allowing for agility at low speeds. Using control algorithms linear in the modified Rodrigues parameters to support large angle maneuvers, the vehicle is successfully controlled in banked and twisting turns, exceeding the best reported AUV turning performance by more than a factor of two; a minimum turning radius of 0.7BL, and the ability to avoid walls detected> 1.8BL ahead, are found for cruising speeds of 0.75BL/S, with a maximum heading rate of 400 / S recorded. Observations of "Myrtle", a 250kg Green sea turtle (Chelonia mydas) at the New England Aquarium, are detailed; along with steady swimming, Myrtle is observed performing 1800 level turns and rapidly actuating pitch to control depth and speed. Limb kinematics for the level turning maneuver are replicated by Finnegan, and turning rates comparable to those of the turtle are achieved. Foil kinematics which produce approximately sinusoidal nominal angle of attack trace are shown to improve turning performance by as much as 25%; the effect is achieved despite limited knowledge of the flow field. Finally, tests with a single foil are used to demonstrate that biomimetically inspired inline motion can allow oscillating foils utilizing a power/recovery style stroke to generate as much as 90% of the thrust from a power/power stroke style motion

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

Aquatic escape for micro-aerial vehicles

As our world is experiencing climate changes, we are in need of better monitoring technologies. Most of our planet is covered with water and robots will need to move in aquatic environments. A mobile robotic platform that possesses efficient locomotion and is capable of operating in diverse scenarios would give us an advantage in data collection that can validate climate models, emergency relief and experimental biological research. This field of application is the driving vector of this robotics research which aims to understand, produce and demonstrate solutions of aerial-aquatic autonomous vehicles. However, small robots face major challenges in operating both in water and in air, as well as transition between those fluids, mainly due to the difference of density of the media. This thesis presents the developments of new aquatic locomotion strategies at small scales that further enlarge the operational domain of conventional platforms. This comprises flight, shallow water locomotion and the transition in-between. Their operating principles, manufacturing methods and control methods are discussed and evaluated in detail. I present multiple unique aerial-aquatic robots with various water escape mechanisms, spanning over different scales. The five robotic platforms showcased share similarities that are compared. The take-off methods are analysed carefully and the underlying physics principles put into light. While all presented research fulfils a similar locomotion objective - i.e aerial and aquatic motion - their relevance depends on the environmental conditions and supposed mission. As such, the performance of each vehicle is discussed and characterised in real, relevant conditions. A novel water-reactive fuel thruster is developed for impulsive take-off, allowing consecutive and multiple jump-gliding from the water surface in rough conditions. At a smaller scale, the escape of a milligram robotic bee is achieved. In addition, a new robot class is demonstrated, that employs the same wings for flying as for passive surface sailing. This unique capability allows the flexibility of flight to be combined with long-duration surface missions, enabling autonomous prolonged aquatic monitoring.Open Acces

Composite adaptive locally weighted learning control for multi-constraint nonlinear systems

A composite adaptive locally weighted learning (LWL) control approach is proposed for a class of uncertain nonlinear systems with system constraints, including state constraints and asymmetric control saturation in this paper. The system constraints are tackled by considering the control input as an extended state variable and introducing barrier Lyapunov functions (BLFs) into the backstepping procedure. The system uncertainty is approximated by a composite adaptive LWL neural networks (NNs), where a prediction error is constructed via a series-parallel identification model, and NN weights are updated by both the tracking error and the prediction error. The update law with composite error feedback improves uncertainty approximation accuracy and trajectory tracking accuracy. The feasibility and effectiveness of the proposed approach have been demonstrated by formal proof and simulation results

Autonomous Marine Vehicles: Control-Oriented Modeling and Applications

This thesis will presents the state of the art and the personal contribution to the control-oriented modeling and control of marine vehicles. It is divided in two parts, the first one describes the scientific results related to the modeling and control aspects, while the second part describes an application related to the UAN project and a real-time distributed supervision system. The first result, described in chapter n.1, was motivated by the existence of a new class of hybrid underwater vehicles equipped with classic AUV and glider actuators. In particular, a dynamic model was derived for the general class of hybrid-propulsion vehicles, to which the case study eFolaga belongs. This development was made possible by considering a kinematic relaxation: the effects of the Centre of Gravity (COG) variations on the linear speed of the vehicle were neglected. The resulting simplified kinetic model, including the COG motion variation effects, takes a standard control-oriented form and consequently it can be easily used with all the available literature results regarding control and related aspects. This simplification works out if the COG speed is very small as compared to the vehicle speed, as it is the case of the eFolaga and of most vehicles with internal mass displacement systems. The second result, described in chapter n.2, was motivated by the need of a underwater vehicle capable to achieve high-energy efficiency by extracting propulsion directly from the sea-waves. The novel vehicle was designed to combine typical underwater capabilities such as underwater navigation and low-consumption gliding, with the clean-energy oriented feature of sea-wave energy extraction and propulsion conversion. The resulting vehicle, named Underwater Wave Glider (UWG) exploits the sea wave potential and the surface fluid profile with hydrodynamic wings to achieve a clean-energy passive propulsion. Currently the UWG is object of a combined study between ISME1 and CSSN2 . The importance of analyzing systems under constant sea-wave excitation motivated the study described in chapter n.3. In particular a method to combine surface models, described for instance with Motion Response Amplitude Operation (RAO), with classic underwater model was developed to evaluate system performances during floating motion. The resulting hybrid model, while capturing frequency domain specification of surface motion model, is able to provide time-varying access to the sea-wave induced effects acting on submerged vehicle parts. The chapter n.4, concluding the first part of the thesis, is dedicated to the control-allocation problem. In fact, the capability to reproduce coherently forces and moments through an intelligent use of actuators is a common requirement for marine vehicles control systems. The results presented, applied to a quite diffused class of marine vessels, can also be extended to other underwater or surface vehicle classes, by including the proper actuator spatial distribution and limitations. In particular, a parametric sequential quadratic programming method is proposed to solve the problem of control allocation with unconstrained forces/moments references. The new formulation, as shown in detail in the chapter, improves performances, with respect to the state-of-the-art, in case of not-feasibility or actuator saturation conditions. The second method, is used to properly distribute actuators configurations by exploiting a norm-infinity bounded reference set. This particular case has a direct impact on all vehicles of the considered class, equipped with human-interface-device (HID) systems. The implication of these new methods, together with the new drive-by-wire methodology, could affect considerably the nowadays vehicles maneuvering capabilities. The second part of the thesis is dedicated to the applications. In particular chapter n.5 will discuss experimental results of the UAN project final experiment in Throndheim, Norway (2011). Finally, chapter n.6 will present a cross-platform distributed system, named DCL, used to implement Hardware-In-the-Loop (HIL) and Software-In-the-Loop methodologies and to supervise real-time RTAI processes