Switching control of an underwater glider with independently controllable wings Andrea Caiti ∗ , Vincenzo Calabrò ∗ , Stefano Geluardi, Sergio Grammatico ∗ , Andrea Munafò ∗∗ ∗ Department of Energy and Systems Engineering, University of Pisa, Largo Lucio Lazzarino 1, 56122 Pisa, Italy. ∗∗ Integrated Systems for Marine Environment (ISME), 16126 Genova, Italy. Abstract: This paper presents a control-oriented dynamic model of an underwater glider with independently controllable wings. We show that this particular feature is particularly useful to improve the vehicle’s maneuverability. The only actuators here used are a ballast tank and two hydrodynamic wings. A switching control strategy, together with a backstepping control scheme, is designed to limit the action of the ballast tank and hence to enforce energy-efficient maneuvers. We consider a case study in which the vehicle has the hydrodynamic wings behind its main hull. This structure is motivated by the recently-introduced concept of the underwater wave glider, that is a vehicle capable of both surface and underwater navigation. The control algorithm is validated via numerical simulations of the vehicle performing three-dimensional path-following maneuvers. 1. INTRODUCTION Underwater gliders are winged Autonomous Underwater Vehicles (AUVs) that, unlike thrusters’ propelled vehicles, can be employed for long-term and flexible missions, such as oceanographic sampling and underwater surveillance. The underwater glider concept (Stommel [1989]) motivated the development of several prototypes, for instance the “Slocum” (Webb et al. [2001]), the “Spray” (Sherman et al. [2001]) and the “Seaglider” (Eriksen et al. [2001]). These are all buoyancy-propelled, fixed-winged gliders which shift internal ballast to control the attitude, see (Leonard and Graver [2001]). As underwater glider can be operated in high-efficiency conditions of reliance on the battery power, an accurate control system is crucial for their performance and, especially, endurance. Most importantly, the use of feedback control can provide robustness to uncertainty and disturbances (Leonard and Graver [2001]). Among others, we refer the interested reader to (Bhatta and Leonard [2004]), (Mahmoudian and Woolsey [2008]), where some state-feedback control schemes are proposed for underwater gliders having fixed hydrodynamic wings. More recently, the need for higher maneuverability motivated the development of underwater gliders with movable rudder (Noh et al. [2011]) or even with independently controllable wings (Arima et al. [2008]). For instance, in (Arima et al. [2009]) many experimental tests are performed with the “Alex” glider to also characterize the so called “lateral response”. This latter characteristic is clearly not available if the glider is just equipped with fixed hydrodynamic wings. 1 Corresponding author Andrea Caiti, e-mail: a.caiti@dsea.unipi.it. In this paper, we consider the concept of the underwater wave glider (Caiti et al. [2012]), capable of both wavepropelled surface navigation and buoyancy-driven underwater motions, in its operation mode of underwater glider. As a consequence, the hydrodynamic wings of the vehicle are positioned in the back of the main hull. In particular, we propose a state-feedback switching control scheme for the three-dimensional path-following task (Encarnaçao and Pascoal [2000]), (Aguiar and Pascoal [2002]). The paper is organized as follows. Section 2 contains the modeling of the vehicle and the characterization of the actuators, namely the ballast and the independently controlled wings. Section 3 presents a switching control scheme for a path-following maneuver. Some simulations are commented in Section 4. In the last section we conclude the paper and outline some future lines of research. 2. UNDERWATER GLIDER MODEL In this section we present the modeling of the underwater glider, with particular attention to the functional characteristics of the control actuators. The vehicle has got a time-dependent mass m(t) and a Center of Gravity (CoG) with variable position rg (t) due to a ballast tank, positioned on top of the vehicle’s hull. For any generic vector v, let us adopt the notation with superscript b to indicate the components of v expressed in the body-fixed frame “attached” to the vehicle; while we use the superscript n to indicate the navigation reference frame. The equations governing the dynamics of the position and of the velocity of the CoG are Λ + Υ(t) Υ̇(t) ṁ(t) b rgb (t) = , ṙgb (t) = − r (t), (1) m(t) m(t) m(t) g m m kg m m m kg kg/s m m m m m m m m Table 1. Numerical parameters of the considered underwater glider where Λ and Υ(t) are, respectively, the static and the dynamic contributes of the CoG dynamics. Considering the mass of water ε(t) contained in the ballast tank, a standard six-dimensional model for the rigid body motion (plus the “ballast’s dynamics”) can be obtained as follows. η̇ = J (η) v (2a) M (ε) v̇ + C (v, ε) v + D (v) v + g (η, ε) + T (v, ε) ε̇ = τ (2b) ε̇ = uε (2c) where the mass matrix M (ε), the Coriolis matrix C (ε) already include the added mass effects (Fossen [2002]), D (v) v is the hydrodynamic drag force acting on vehicle, g (η, ε) indicates the forces of gravity and buoyancy, and the term T (v, ε) ε̇ represents the effects of the variable CoG (1). In (2c) we assume that we can control the velocity of the CoG ε̇ via the input uε . The generalized force τ consists on the (controlled) hydrodynamic effects of the wings, characterized later on. This modeling technique for vehicles having a variable position of the CoG has been also used in (Caiti and Calabrò [2010]) for a hybrid AUV, see (Caffaz et al. [2012]) for further details. In Table 2 the numerical parameters here used are shown. 2.1 Ballast tank characterization We assume that the position of the CoG can vary only by filling and emptying the ballast tank. Based on the numerical parameters of Table 2, we “characterize” the ballast actuator, positioned on top of the vehicle’s hull. Therefore, injecting water in the ballast tank will result in moving the CoG towards the top of the vehicle, and vice versa. This choice also allows to regulate the pitch angle of the vehicle by changing the water contained in the ballast tank. As a consequence, also the glide angle of the vehicle can be regulated. Buoyancy force of the vehicle depends linearly on the amount of water embarked in the ballast tank. The posi- Center of Gravity (CoG) variation [m] CoG along the Body xéAxis (solid) and zéAxis (dashed) 2 0.15 23.65 −0.02 0 0.1 1 0.1 0.9 0 0.1 0.25 0.10 −0.8 ±0.2 0 0.12 0.1 0.08 0.06 0.04 0.02 0 é0.02 0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 Water contained in the ballast tank [kg] 0.9 1 Fig. 1. Variation of the longitudinal position of the center of gravity of the vehicle as a function of the water contained in the ballast tank positionated on top of the vehicle’s hull. 20 Equilibrium Pitch Angle [deg] Characteristic Glider parameters Length Diameter Vehicle Static weight ms Static CoG position (Λ/ms )x Static CoG position (Λ/ms )y Static CoG position (Λ/ms )z Capacity max b Ballast Tank Maximum rate |˙b |max Position (rbb )x Position (rbb )y Position (rbb )z Width Hydrodynamic Wings Length b ) Position (rw x b ) Position (rw y b ) Position (rw z 15 10 5 0 é5 é10 é15 é20 0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 Water contained in the ballast tank [kg] 0.9 1 Fig. 2. Steady-state pitch angle reached by the vehicle as a function of the water contained in the ballast tank positionated on top of the vehicle’s hull. tion of the ballast tank has been tuned in such a way that some symmetry is obtained for the buoyancy: for values of water mass ε > 0.5 kg the vehicle becomes negative (the gravity force is greater than the buoyancy force), while for ε < 0.5 kg the vehicle is positive (the gravity force is less than the buoyancy force). By introducing a certain mass of water ε in the ballast tank at the position rb we obtain a shift of the CoG of the entire vehicle, as represented in Fig. 1. 2.2 Wings characterization The hydrodynamic wings play a fundamental role to guarantee the gliding motion of the vehicle. Their contribution affects the dynamics (2b) via the generalized force τ . For “numerical convenience”, we consider the NACA009 wing profile. The orientation of each wing is described by the angle of attack (α + β), see Figure 3, i.e. the angle between the longitudinal direction of the wing xω and the direction of the velocity vω . A hydrodynamic wing introduces the lift L (α + β) and drag D (α + β) forces, see Figure 3, due to its relative velocity with respect to the fluid velocity. 𝜂, 𝑣, 𝜀 𝜂, 𝑣, 𝜀 ⋅ 𝜏, 𝑢𝜀 𝜂, 𝑣 , 𝜀 Fig. 3. Lift and drag forces generated by the hydrodynamic wings as a function of the angle of attack of the hydrodynamic wings themselves. In this paper we consider the following approximations (Chwang and Wu [1975]) for such induced forces: 1 L(α + β) = ρV 2 SCL (α + β) (3) 2 1 (4) D(α + β) = ρV 2 SCD (α + β) 2 where ρ is water density, V is the wings speed in the fluid, S is the are of wings surface, while the terms CL and CD are dimensionless coefficient depending on the chosen wings profile and also on the wings angle of attack. 3. UNDERWATER GLIDING CONTROL PROBLEM The gliding control problem we address here is the problem of finding a state-feedback control law uε (η, ν, ε) and the wings orientation α, affecting τ = τ (α), such that a certain motion is achieved by the vehicle. We notice that setting the wings orientation angle α to zero, we achieve the same maneuverability of a glider with fixed wings. Hence we claim that this additional degree of freedom can be actually exploited, especially if the wings are independently controlled. Now, let us also notice what happens if the wings orientation angle α is fixed to zero. In this case, we have that, see Figure 5, the equilibrium glide angle reached by the vehicle is quite “small” if the amount of water contained in the ballast tank is close to its central value, that is 0.5 kg. On the contrary, the vehicle can achieve larger gliding angles whenever we have values of water mass ε far from the central value. Note that, in general, the control of the wings positioned in the tail of the vehicle is not a trivial task because the system suffers of “coupling effects”. In fact, any control input on the wings introduces additional moments along the pitch axis, while the differential control strategy introduces moments along the pitch and the roll axes. 3.1 Preliminaries on the path-following problem The high-level control strategy used in this work is based on the path-following method (Breivik and Fossen [2005]). We indeed refer to this reference for the details on the definition of the path-following problem. Fig. 4. Backstepping control scheme. The feedforward block computes the reference signals and hence the state errors. The feedback block implements the control laws to track the reference signals. The peculiarity of the method in (Breivik and Fossen [2005]) is the development of control laws for a generic ideal model of vehicle, according to the following (backstepping) steps: (a) a point on the vehicle (“actual particle”) tracks a desired trajectory; (b) a control is constructed to achieve the desired speed computed above. This strategy is typical of path-following problems as, unlike trajectory-tracking problems, no time limitations are considered. The actual particle chosen is the CoG, and the goal here is its convergence to the most convenient “path particle”, also named “ideal particle”. In our case, the references are the pitch and the yaw angles of the velocity of the ideal particle. The control scheme is presented in Fig.4. The model dynamics (2b) are implemented in the block Dynamics. The Feedforward block solves the step (a) of the pathfollowing problem described above, in the sense that is computes the distance between the actual particle and the ideal particle, together with the state errors (η̃, ν̃, ε̃). The Feedback block solves the step (b), namely it uses such values to generate the state-feedback control actions. 3.2 Switching state-feedback velocity control In the Feedback block, a switching control is implemented in order to limit the chattering behavior of the ballast actuator close to the equilibrium point. The latter phenomenon would be definitively undesired because, from the practical point of view, actuating the ballast tank at “high” frequency is particularly inefficient from the energy-consumption point of view. Technically, we propose a feedback control of the amount of water in the ballast tank that is purely proportional far from the desired path: 0.1 · sat(Kε ε̃) if (η̃ > , ν̃ > ) ≤ ē uε (η̃, ν̃, ε̃) = (5) 0 otherwise A possible way to regulate the wings angles α is to solve an optimization problem online. Given the current angles α0 , β0 , the current velocity moduluses V0 and a desired force τ ∗ to be reproduced, the angles α can be chosen as follows. α := arg min2 s(x)> Qs(x) + (x − α0 )> R(x − α0 ) 80 Equilibrium Glide Angle [ deg ] 60 40 20 x∈R 0 subject to: α ≤ x ≤ α, ∆α ≤ x − α0 ≤ ∆α where: s(x) := τ ∗ − B̄ (β0 , x, V0 ) x. ï20 ï40 (9) ï60 ï80 0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 Water contained in the ballast tank [ kg ] 0.8 0.9 1 Fig. 5. Steady-state glide angle reached by the vehicle as a function of the water contained in the ballast tank positionated on top of the vehicle’s hull. where Kε ∈ R is the feedback gain and ē ∈ R+ is a certain threshold to be tuned. Namely, whenever the vehicle is “close enough” to the desired path, the control of the ballast tank is disabled to avoid the ballast chattering and only the wings are used to finely reach the desired path. 3.3 Optimization-based wings control According to the force characterization of the hydrodynamic wings, see Section 2.2, the generalized force τ applied to the vehicle’s CoG is τ = B (β, α, V ) α, (6) where B(·) is a nonlinear function of the angles β = (β1 , β2 )> , of the angles α = (α1 , α2 )> and of the wingsvelocities moduluses (V1 , V2 )> = V ∈ R2 . The nonlinear function B(·) comes from the forces of lift L(·) and drag D(·) forces that are shown in Figure 3. The objective here is indeed the choice of α to recover the desired generalized force τ , or a close approximation of it, according to equation (6). For simplicity, in the control synthesis we neglect the drag terms because of about one order of magnitude smaller than the lift ones (in the desired operating conditions). Therefore, we consider an approximate nonlinearity: τ̄ = B̄ (β, α, V ) α (7) with B̄ (β, α, V ) ∈ R2×2 and τ̄ = (τ3 , τ6 )> . We choose this two components because the velocity angles of pitch and yaw are here used as references. In order to obtain a good convergence, an integral term is introduced “close” to the desired path: τ ∗ (η̃, ν̃, ε̃) = Kp · ψ̃θ̃ Z θ̃(t) dt Kp · ψ̃θ̃ + Ki ψ̃(t) if (η̃ > , ν̃ > ) ≤ ē (8) otherwise where Kp and Ki ∈ R2×2 are constant matrix gains to be tuned. The bounds α, α, ∆α, ∆α are free design parameters reflecting the physical limits on the wings actuators. The weight matrices Q, R are positive definite. The problem (9) is a nonlinear optimization problem as s(x) is a nonlinear function of x. Following the approach proposed in (Johansen et al. [2004]), we consider a linearized version of problem (9) leading the following Quadratic Problem (QP) to be solved online. α := arg min2 s̄(x)> Qs̄(x) + (x − α0 )> R(x − αo ) x∈R subject to: α ≤ x ≤ α, ∆α ≤ x − α0 ≤ ∆α where: s̄(x) :=τ ∗ − B̄ (β0 , α0 , V0 )α0 ∂ B̄(β, α, V )α · (x − α0 ). − ∂α (β0 ,α0 ,V0 ) (10) Note that, unlike (Johansen et al. [2004]), the approximation of the original nonlinearity B(·) in (6) with B̄(·) in (7) is such that B̄(β, α, V ) is never singular. Within this simplifying reduction, there is no need to address the problem via sequential QPs. 4. SIMULATIONS Many numerical simulations have been performed in order to tune the free design parameters and also to validate the proposed switching-control strategy. We noticed that in our backstepping control scheme, an undesired chattering behavior of the ballast actuator would be generated without the use of the proposed switching strategy. Our simulation experience confirms what basic intuition would suggest: the action of the ballast tank is more relevant to regulate the pitch variable, while the corrections determined by the independently-controlled hydrodynamic wings play a relevant role in regulating the yaw variable. Basically, a differential control of the hydrodynamic wings allows to generate roll and yaw motions. The numerical parameters used in the implemented QP are α, α = ±15 deg, ∆α, ∆α = ±5 deg, Q = I, R = 20I. We present here the gliding motion of the glider, shown in Figure 6, that has to follow an helical trajectory of radius 40 m, see Figure 7. Such trajectories are particularly efficient to explore and sample underwater sink holes (Andonian et al. [2010a,b]). The initial vehicle states are η0 = (0, 70, −20, 0, 0, 0)> and v0 = (0.05, 0, 0, 0, 0, 0)> . Position error 40 35 é213.4 30 é213.6 25 6P é213.8 éDown é214 15 é214.4 10 é214.6 é214.8 5 é215 29.5 26.5 26 31 25.5 100 200 300 Time [ s ] 400 500 600 North East Fig. 8. Position error over time. Fig. 6. Three-dimensional plot of the vehicle tracking the desired trajectory. Path following Actual Desired Water in the ballast tank [ kg ] 27 0 0 30 30.5 é215.2 100 Ballast tank 1 0.5 0 0 50 100 150 200 250 300 350 400 450 500 300 350 400 450 500 300 350 400 450 500 Left wing _ [ deg ] 100 0 ïz [ m ] 20 é214.2 ï100 50 0 ï50 ï100 0 ï200 50 100 150 200 20 0 ï20 x[m] ï40 ï40 ï20 0 20 40 60 80 _ [ deg ] 100 ï300 40 50 0 ï50 ï100 y[m] Fig. 7. Desired helical trajectory and actual trajectory of a characteristic point of the vehicle. 250 Right wing 0 50 100 150 200 250 Time [ s ] Fig. 9. Actuator signals over time. 5. CONCLUSION The initial position error vector is chosen as η̃0 = (0, 30, −20, 0, 0, 0)> . The initial value of the water contained in the ballast tank is εb = 0.5. The controller gain have been tuned as −6 0 −0.02 0 Kε = 1, Kp = , Ki = . 0 3 0 0.01 Turning off the ballast tank actuator, when the vehicle is “close enough” to the path, contributes in having low energy-consumption by correcting trajectory only through the wings control. Furthermore, the introduction of the integral term helps to track the desired path with small state error as shown in Figure 8. Figure 9 shows the angular wings actuation and the amount of water in the ballast tank. Figure 10 shows the angular errors θ̃ and ψ̃. In this paper we have presented a control-oriented model of an underwater glider with independently controllable hydrodynamic wings. Through the use of a ballast tank and of the hydrodynamic wings, a simple, backstepping, control scheme has been presented to accomplish some particular three-dimensional path-following maneuvers. We have used a switching control scheme to avoid the undesired chattering of the ballast tank actuator whenever the vehicle gets close to the desired path. The control algorithm is validated via numerical simulations. We remark that our switching control law is only justified by simulations heuristics, not by theoretical analysis. The provided example shows the potentialities of using independent actuations for the hydrodynamic wings. In particular, the actuation of the ballast tank can be limited by just exploiting the corrections of the wings. This would Pitch angle error 6e [ deg ] 100 50 0 ï50 ï100 0 100 200 300 500 600 700 800 500 600 700 800 Yaw angle error 200 6s [ deg ] 400 100 0 ï100 0 100 200 300 400 Time [ s ] Fig. 10. Angular errors over time. further increase the energy efficiency of underwater gliders, even if non-trivial maneuvers are to be performed. Therefore we expect that this work can motivate further research studies on the design of more accurate control schemes exploiting the independent actuation of the hydrodynamic wings, besides the physical realization of glider prototypes of the kind here described. From this latter point of view, it would be remarkable the realization of a prototype capable of exploiting its hydrodynamic wings together with the waves energy for the surface navigation, and together with the oceanic currents for the underwater navigation. REFERENCES A.P. Aguiar and A. Pascoal. Global stabilization of an underactuated autonomous underwater vehicle via logicbased switching. Proc. of the IEEE Conf. on Decision and Control, Las Vegas (Nevada, USA), pages 3267– 3272, 2002. M. Andonian, D. Cazzaro, L. Invernizzi, S. Grammatico, and M. Chyba. Geometric control for autonomous underwater vehicles: overcoming a thruster failure. Proc. of the IEEE Conf. on Decision and Control, 2010a. M. Andonian, M. Chyba, S. Grammatico, and A. Caiti. Using geometric control to design trajectories for an auv to map and sample the summit of the loihi submarine volcano. Proc. of the IEEE Autonomous Underwater Conference, Monterey (California, USA), 2010b. M. Arima, N. Ichihashi, and T. Ikebuchi. Motion characteristics of an underwater glider with independently controllable main wings. Proc. of the IEEE Oceans Conference, Kobe (Japan), 2008. M. Arima, N. Ichihashi, and Y. Miwa. Modelling and motion simulation of an underwater glider with independently controllable main wings. Proc. of the IEEE Oceans Conference, Bremen (Germany), 2009. P. Bhatta and N.E. Leonard. A Lyapunov function for vehicles with lift and drag: Stability of gliding. Proc. of the IEEE Conf. on Decision and Control, Atlantis (Bahamas), pages 4101–4106, 2004. M. Breivik and T.I. Fossen. Principles of guidance-based path following in 2D and 3D. Proc. of the IEEE Conf. on Decision and Control, Seville (Spain), pages 627–634, 2005. A. Caffaz, A.Caiti, V.Calabrò, G.Casalino, P.Guerrini, A. Maguer, A. Munafò, J.R. Potter, H.Tay, and A.Turetta. The enhanced Folaga: a hybrid AUV with modular payloads. In Further Advances in Unmanned Marine Vehicles (in press). IET London, 2012. A. Caiti and V. Calabrò. Control-oriented modelling of a hybrid AUV. Proc. of the IEEE Int. Conf. on Robotics and Automation, Anchorage (Alaska, USA), 2010. A. Caiti, V. Calabrò, S. Grammatico, A. Munafò, and M. Stifani. Lagrangian modeling of an underwater wave glider. Ship Technology Research, 59(1):6–13, 2012. A.T. Chwang and T. Wu. Hydromechanics of lowReynolds-number flow, volume 67. Journal of Fluid mechanics, 1975. P. Encarnaçao and A. Pascoal. 3D path following for autonomous underwater vehicle. Proc. of the IEEE Conf. on Decision and Control, Sydney (Australia), pages 2977–2982, 2000. C.C. Eriksen, T.J. Osee, T. Light, R.D. Wen, T.W. Lehmann, P.L. Sabin, J.W. Ballard, and A.M. Chiodi. Seaglider: a long range autonomous underwater vehicle for oceanographic research. IEEE Journal of Oceanic Engineering, 2001. T.I. Fossen. Marine Control Systems: Guidance, Navigation and Control of Ships, Rigs and Underwater Vehicles. Marine Cybernetics, 2002. T.A. Johansen, T.I. Fossen, and S.P. Berge. Constrained nonlinear control allocation with singularity avoidance using sequential quadratic programming. IEEE Trans. on Control Systems Technology, 12(1):211–216, 2004. N.E. Leonard and J.G. Graver. Model-based feedback control of autonomous underwater gliders. IEEE Journal of Ocean Engineering, 26(4):633–645, 2001. N. Mahmoudian and C. Woolsey. Underwater glider motion control. Proc. of the IEEE Conf. on Decision and Control, Cancun (Mexico), pages 552–557, 2008. M.M. Noh, M.R. Arshad, and R.M. Mokhtar. Modeling of usm underwater glider (USMUG). Proc. of the IEEE Int. Conf. on Electrical, Control and Computer Engineering, Pahang (Malaysia), pages 429–433, 2011. J. Sherman, R.E. Davis, W.B. Owens, and J. Valdes. The autonomous underwater glider Spray. IEEE Journal of Oceanic Engineering, 2001. H. Stommel. The Slocum mission. Oceanography, 2:22–25, 1989. D.C. Webb, P.J. Simonetti, and C.P. Jones. Slocum: an underwater glider propelled by environmental energy. IEEE Journal of Oceanic Engineering, 2001.