Next Article in Journal
Multi-Server Multi-User Multi-Task Computation Offloading for Mobile Edge Computing Networks
Previous Article in Journal
Dual-Structured Flexible Piezoelectric Film Energy Harvesters for Effectively Integrated Performance
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Nonlinear Attitude Control of a Spherical Underwater Vehicle †

by
Ramon A. Suarez Fernandez
*,
E. Andres Parra R.
,
Zorana Milosevic
,
Sergio Dominguez
and
Claudio Rossi
Centre for Automation and Robotics, Universidad Politecnica de Madrid, 28006 Madrid, Spain
*
Author to whom correspondence should be addressed.
The paper is an extended version of our paper published in Suarez Fernandez, R.A.; Parrar, E.A.; Milosevic, Z.; Dominguez, S.; Rossi, C. Design, Modelling and Control of a Spherical Autonomous Underwater Vehicle for Mine Exploration, In Proceedings of the 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Madrid, Spain, 1–5 October 2018.
Sensors 2019, 19(6), 1445; https://doi.org/10.3390/s19061445
Submission received: 18 February 2019 / Revised: 20 March 2019 / Accepted: 22 March 2019 / Published: 24 March 2019
(This article belongs to the Section Physical Sensors)

Abstract

:
In this work, we present the design, implementation, and testing of an attitude control system based on State Feedback Linearization (FL) of a prototype spherical underwater vehicle. The vehicle is characterized by a manifold design thruster configuration for both locomotion and maneuvering, as well as on a novel pendulum-based passive pitch control mechanism. First, the mechanical design and onboard electronics set up of the spherically shaped hull are introduced. Afterward, a high-fidelity dynamic model of the system is derived for a 6 degree-of-freedom (DOF) underwater vehicle, followed by several experiments that have been performed in a controlled environment to compare the performance of the proposed control method to that of a baseline Proportional-Integral-Derivative (PID) controller. Experimental results demonstrate that while both controllers were able to perform the specified maneuvers, the FL controller outperforms the PID in terms of precision and time response.

1. Introduction

Europe is coming under increased pressure due to its near-complete dependency on the import of mineral raw materials. At the same time, there are an estimated 30,000 inactive mining sites, a considerable number of which still contain raw materials, currently in critical demand [1]. Among these sought-after raw materials there are metallic and industrial minerals, construction materials, and base metals, such as cobalt, gallium, indium, and a range of rare earths necessary for IT appliances [2]. Therefore, there is increased interest for re-opening some of these abandoned mine sites.
Under normal operation conditions, surface and groundwaters filter into the mined tunnels and must be constantly removed to maintain a safe working environment. Once a mine is permanently closed, the dewatering systems cease to operate, and without the existence of any drainage, the tunnels become permanently submerged. Most of these mine sites, presently submerged, are more than a century old, and the information available regarding the structural layout of the tunnels is limited and imprecise, if not totally lacking. The network of tunnels inside a mine can be extremely complicated, so surveying and prospecting by conventional methods such as human divers, can result dangerous or even lethal in unknown deep mine conditions [1]. Therefore, the use of robotic platforms such as underwater vehicles to explore these sites and gather valuable geological and mineralogical information, can help reducing risks for humans and provide important information for determining whether re-opening a mine is plausible and economically feasible.
Underwater vehicles are an active area of research due to their potential applications in a variety of fields, such as maritime security, marine archaeology, search, and rescue. The most common applications of underwater robotics include ocean mining exploration [3], autonomous sea floor mapping [4,5], and data gathering [6,7,8]. It is worth noting that most of the research on underwater robots addresses open water environments, where the restrictions on shapes and sizes of the UVs are not strict. Therefore, most UVs adopt an elongated shape to minimize drag in surge (forward motion) which is the dominant motion in open water.
Nevertheless, for autonomous exploration and 3D mine mapping of flooded mines, these elongated shapes are not efficient. The underwater robot will have to navigate within complex structures of mine tunnels and galleries with dimensions in the range of 1.5 m × 3 m, with the oldest mines tunnel sections as small as 1.5 m × 1 m. As such, the robot must be sufficiently small and agile to navigate the mine corridors and tight turns of the mine system. Furthermore, mine tunnels may contain objects or debris left after closure, which could obstruct paths or become entangled in the AUVs propellers and permanently disable the robot which implies certain design requirements aimed at limiting protruding elements to avoid becoming snared. By adopting a less common streamlined spherical shape design, attitude motions can be made in-place, minimizing the number of moving parts and protruding elements while obtaining high stability and flexibility along with a zero degree turn radius for high maneuverability and lower drag forces.
Although spherical hull designs for underwater vehicles are not commonly found in recent literature, because of the preferred bullet-shape hull, such as the MAYA AUV [9], developed by the National Institute of Oceanography in India, several works can be found which took advantage of this particular shape. The UV design patented by the authors in [10] is one of the first spherical underwater robots where the spherical shape of the prototype is used to obtain lower drag forces during operation. It is composed of four small engines that help stabilize and maneuver the vehicle, and a single engine that is in the center of the sphere for propulsion of the UV. The University of Hawaii developed ODIN-III [11], a prototype robot with a hollow metal sphere housing of 0.315 m in radius and a propulsion system that consisted of 8 screw propellers fixed outside the hull. This platform has been used to test adaptive control methods together with disturbance observers [12]. A micro AUV of 0.075 m in radius and 6 propellers around the hull was developed by the authors of [13,14] for monitoring sub-surface cluttered environments as in nuclear storage ponds.
Screw propeller thrusters have been generally used for propulsion of underwater vehicles, nevertheless, other types of propulsion methods such as water-jet thrusters have been designed and tested for spherical UV. The robot developed in [15] is a prototype that has a spherical hull with a diameter of 0.40 m and uses 4 vector water-jets as propulsion to maneuver, which is based on the design patented in [16]. Although this UV has 4 vector water-jet inside, it is only capable of performing motions in 3 DOF [17,18,19]. The authors in [20] make use of the spherical UV SUR-II, which is equipped with water-jet thrusters as propulsion, to design and develop attitude stabilization methods as well as buoyancy control with a variable ballast tank. Whereas, spherical AUVs with reaction wheel internal actuators have been designed and developed in [21,22]. One key disadvantage of these UV designs is the presence of external propulsion systems which could become entangled with objects encountered during operation. Taking into account the benefits and drawbacks of these systems, the UV design in this work shown in Figure 1, has a manifold thruster configuration where the propulsion elements are embedded into the spherical hull to avoid foreign objects from damaging the propellers and effectively eliminating the possibility of ensnarement.
The work presented in this paper describes a scaled prototype UV, realized to study, develop, and compare control strategies, to be later deployed, with suitable adaptations, in the actual robotic explorer for the UNEXMIN project, hereby named UX-1. Here, we focus on three aspects: the mechanical and electrical design of the spherical UV prototype, the derivation of the equations of motion that describe the dynamics of the system and the implementation of control methods for performance analysis in real underwater experiments. The rest of this paper is organized as follows: Section 2 introduces the mechanical and electronic design of the UV, while in Section 3 the 6 DOF equations of motion for an UV are derived. Section 4 explains the control system implemented on the UV, while the underwater experimental tests and discussions are reported in Section 5. Finally, conclusions and future works are presented in Section 6.

2. Underwater Vehicle Design

The mechanical design of the scaled UV prototype (Figure 1) is focused on complying to the expected requirements of the real UNEXMIN UX-1 robot being developed and deployed in real mine scenarios for the task of flooded tunnel navigation. For efficiency in design, development, and testing of the UV prototype, low-cost COTS mechanical and electronic components were used, when available, so that any component damaged during testing could be easily replaced. The final prototype’s mechanical and electronic design has been thoroughly explained in [23] and can be divided into three main components, which are: external hull, manifold system for propulsion and a pendulum mechanism for pitch movement.

2.1. External Hull

The design requirements for the external hull are based on the smallest area where the robot will have to navigate. In most flooded mine tunnels this area will be found in the staircases interconnecting tunnels and galleries. The size restriction was fixed at a maximum diameter of 60 cm. Thus, the external hull of the UV prototype was chosen as two acrylic hemispheres of 50 cm in diameter integrated with the manifold system and rigidly attached to a watertight enclosure for electronics shown in Figure 2.

2.2. Manifold Propulsion System

In the scaled UV prototype, the manifold component, shown in Figure 3, is assembled from 3D-printed ABS and incorporated into each lateral hemisphere (port and starboard) of the streamlined spherical shape of the hull, along with two counter rotating vertical and horizontal motors.
Given the implicit symmetry of the manifold design and the properties of fluid dynamics, a translation in any direction is possible without changing the heading of the UV [24], nevertheless, pitch rotational motion is not possible. Figure 4 shows the id of each actuator and the direction of the thrust for each motion possible which are outlined in Table 1.
As can be seen in Figure 4a, Surge (red) and Heave (blue) motions are accomplished by applying equal force to port and starboard thrusters, while Yaw (red) and Roll (blue) motions (Figure 4b) are obtained by differential control inputs. Finally, Sway motion, shown in Figure 4c, is performed by rotating the thrusters on each manifold in the same direction (outward/inward), thus directing the flow of water through the center orifice of the manifold.

2.3. Pendulum Mechanism

In the foreseen exploration missions, navigation will be mainly performed with the front of the robot facing the direction of movement, since most of the sensors for 3D mapping and localization on the UX-1 are in the front of the robot. Thus, if it is expected that vertical or steep tunnels are to be explored, and a given pitch angle must be maintained for relatively long periods of time, the sustained use of propellers would consume significant battery power. Hence, passive pitch stabilization is achieved with the use of an internal pendulum mechanism that rotates a mass suspended below the CB around the y b axis of the vehicle.
To the best of our knowledge, this is the first time this design is used for pitch control of a spherical underwater vehicle. As seen in Figure 5 the design consists of two fixed bases and an electronics tray rigidly mounted to the watertight enclosure’s flange seal (Figure 2), and a mobile base that is moved along the rotation axis by two DC motors and a rack-and-pinion gear design.

3. Equations of Motion

The 6 DOF equations of motion for an UV are derived according to the SNAME nomenclature [25]. Given that for the experiments performed in this work the UV is not meant to be actuated in all degrees of freedom, reduced order models are presented for longitudinal motion (Section 3.2.1) and lateral motion (Section 3.2.2), such as in [23]. As can be seen in Figure 6, we make use of an inertial frame in NED configuration { n } , with orthonormal basis { x n , y n , z n } and origin o n represented in world coordinates, as well as the body-fixed reference frame { b } with orthonormal basis { x b , y b , z b } and origin o b also in world coordinates.

3.1. Nonlinear 6 DOF Model

Since the equations of motion of an UV moving at high speeds are highly nonlinear and coupled, in this work the vehicle is restricted to perform low speed maneuvers in translation motions, namely, the speed of the robot will be limited to a maximum of 0.25 m/s. Furthermore, this value has been chosen as the maximum normal operating speed for the UX-1 robot during future exploration missions. We consider the nonlinear equations of motion developed in [23,26] for an UV:
η ˙ = J Θ ( η ) ν
M ν ˙ + C ( ν ) ν + D ( ν ) ν + g ( η ) = τ
with:
η = P b / n n Θ n b = [ x , y , z , ϕ , θ , ψ ]
J Θ ( η ) = R b n ( Θ n b ) 0 3 × 3 0 3 × 3 T Θ ( Θ n b )
ν = v b / n b ω b / n b = [ u , v , w , p , q , r ]
τ = f b b m b b = [ X , Y , Z , K , M , N ] .

3.1.1. Nomenclature

The dynamic equations in (2) are composed of the system inertia matrix M, the Coriolis and Centripetal term matrix C(ν), the hydrodynamic damping matrix D(ν), and the vector of hydrostatic forces and moments g(η). In (3), we denote the position ( P b / n n ) and orientation (Θnb) vector in the NED coordinate system as η ∈ ℝ3 × S3, where P b / n n ∈ ℝ3 is defined as the distance of the point ob with respect to {n} expressed in {n} and ΘnbS3 is a vector of Euler angles between {n} and {b}. The linear ( v b / n b ) and angular ( ω b / n b ) velocity vectors in the body-fixed reference frame are denoted as ν ∈ ℝ6 in (5). JΘ(η) is a 6 × 6 transformation matrix formed by a rotation matrix R b n (Θnb), for transforming v b / n b in {b} to {n}, and a transformation matrix TΘ(Θnb) to relate ω b / n b in {b} to the Euler rate vector Θ . n b . Lastly, τ ∈ ℝ6 is used to describe the forces ( f b b ) and moments ( m b b ) acting on the vehicle in the body-fixed reference frame.

3.1.2. System Inertia Matrix

The system inertia matrix is a positive semi-definite matrix composed of the rigid-body inertia matrix M R B and the added mass inertia matrix M A , composed as follows:
M = M R B + M A , M = M > 0
with,
M R B = m 0 0 0 m z g - m y g 0 m 0 - m z g 0 m x g 0 0 m m y g - m x g 0 0 - m z g m y g I x x - I x y - I x z m z g 0 - m x g - I y x I y y - I y z - m y g m x g 0 - I z x - I z y I z z
which satisfies, M R B = M R B > 0 and M ˙ R B = 0 6 × 6 . In (8), m is the mass of the vehicle, { I x x , I y y , I z z } are the moments of inertia about { b } axes, { I x y = I y x , I x z = I z x , I y z = I z y } are the products of inertia, and { x g , y g , z g } are the distances from the geometrical center of the vehicle to the CG. In the case of a spherical UV with symmetry in the x z , y z and x y planes ( x g = y g = z g 0 ), the rigid-body matrix can be approximated by:
M R B = M R B d i a g { m , m , m , I x x , I y y , I z z } .
The 6 × 6 inertia matrix of added mass terms M A describes the mass that the UV must displace while moving, and the inertia due to the displaced mass while rotating [27]. Given that the UV is restricted to low speed maneuvers and the fact that the vehicle design in this work has three planes of symmetry, the contribution of the off-diagonal elements in M A can be neglected. Hence,
M A = M A - d i a g { X u ˙ , Y v ˙ , Z w ˙ , K p ˙ , M q ˙ , N r ˙ } .
The added mass matrix elements X u ˙ , Y v ˙ , Z w ˙ , K p ˙ , M q ˙ and N r ˙ are the hydrodynamic derivatives of added mass forces as explained in [27]. These forces can be described by an axial component ( X u ˙ , Y v ˙ , Z w ˙ ) and a rolling component ( K p ˙ , M q ˙ , N r ˙ ). Assuming that the shape of the UV can be approximated by an ellipsoid, the axial component of the hydrodynamic added mass force X along the x axis due to an acceleration u ˙ in the x direction is computed as:
X u ˙ = 4 β ρ π 3 d 2 3
where ρ is the water density, d is the diameter of the vehicle, and β is a coefficient based on the ratio between the vehicle length and diameter. Similar considerations hold for the axial components of the hydrodynamic added mass force, Y and Z. Furthermore, the mass displaced while rotating the spherical UV is negligible, consequently the last three elements of (10) can be approximated to zero.

3.1.3. Coriolis-Centripetal Matrix

The Coriolis and Centripetal term matrix (12) is caused by the rotation of the body with respect to the inertial reference frame.
C ( ν ) = C R B ( ν ) + C A ( ν )
C R B ( ν ) and C A ( ν ) are the rigid-body and hydrodynamic Coriolis and Centripetal matrices, respectively. The theory and proofs of these matrices can be found thoroughly explained in literature [26]. It is generally good practice to design the system with the CG located lower than the CB to stabilize the system. For the spherical UV if the CG and the CB are located vertically on the z axis, that is, x b = x g 0 and y b = y g 0 and I x y , I x z , I y z ≈ 0, the rigid-body Coriolis and Centripetal matrix is defined as:
C R B ( ν ) = 0 0 0 m z g r m w - m v 0 0 0 - m w m z g r m u 0 0 0 - m α 1 - m α 2 0 - m z g r m w m α 1 0 I z z r - I y y q - m w - m z g r m α 2 - I z z r 0 I x x p m v - m u 0 I y y q - I x x p 0
with
α 1 = ( z g p - v ) , α 2 = ( z g q + u ) .
The nonlinear hydrodynamic Coriolis and Centripetal matrix C A ( ν ) due to a rotation of the body reference frame about the inertial frame can be derived using an energy formulation based on the added mass matrix M A [27].
C A ( ν ) = 0 0 0 0 - Z w ˙ w Y v ˙ v 0 0 0 Z w ˙ w 0 - X u ˙ u 0 0 0 - Y v ˙ v X u ˙ u 0 0 - Z w ˙ w Y v ˙ v 0 - N r ˙ r M q ˙ q Z w ˙ w 0 - X u ˙ u N r ˙ r 0 - K p ˙ p - Y v ˙ v X u ˙ u 0 - M q ˙ q K p ˙ p 0

3.1.4. Damping Matrix

The total hydrodynamic damping matrix D ( ν ) is the sum of the linear term D and the nonlinear term D n ( ν ) such that
D ( ν ) = D + D n ( ν )
If the UV is maneuvering at low speeds, the motions can be considered uncoupled, thus D ( ν ) could be assumed mathematically as [26]:
D ( ν ) = - d i a g { X u , Y v , Z w , K p , M q , N r } - d i a g { X | u | u | u | , Y | v | v | v | , Z | w | w | w | , K | p | p | p | , M | q | q | q | , N | r | r | r | }
where { X u , Y v , Z w , K p , M q , N r } are the linear damping coefficients of D and { X | u | u , Y | v | v , Z | w | w , K | p | p , M | q | q , N | r | r } are the axial and rolling drag parameters of D n ( ν ) . Definitions and theory can be found in [28].

3.1.5. Vector of Gravitational Forces and Moments

Conforming to the SNAME nomenclature, the weight and buoyancy of a submerged vehicle is given by
W = m g , B = ρ g
where g is the acceleration of gravity in NED, ∇ is the volume of fluid displaced by the vehicle and ρ is the density of water. As in Section 3.1.3, if x b = x g 0 and y b = y g 0 , the Euler angle representation of hydrostatic forces and moments for the gravitational and buoyant forces acting on the vehicle is given by [27]:
g ( ν ) = ( W - B ) sin θ - ( W - B ) cos θ sin ϕ - ( W - B ) cos θ cos ϕ ( z g W - z b B ) cos θ sin ϕ ( z g W - z b B ) sin θ 0 .
As can be seen in (19) if the UV is close to neutrally buoyant ( W = B ), the gravitational forces only affect the rotations in the x and y axes.

3.2. Reduced Order Models

In certain cases, the nonlinear equations of motion presented in Section 3.1 can be divided into two slightly interacting subsystems. In the longitudinal subsystem the states are chosen to be { u , w , q , θ } while the remaining states (e.g., { v , p , r , ϕ , ψ } ) are those of the lateral subsystem. From the diagonal structure of (7)–(10), it can be observed in (20) that the two subsystems are clearly decoupled.
M l o n g = M 11 0 0 0 M 33 0 0 0 M 55 M l a t = M 22 0 0 0 M 44 0 0 0 M 66

3.2.1. Longitudinal Model

In the longitudinal model, the states of the lateral subsystem are assumed to be small ( v = p = r = ϕ = ψ 0 ). Therefore, the longitudinal kinematics for u, w and θ are [27],
x ˙ z ˙ θ ˙ = sin θ 0 cos θ 0 0 1 w q + cos θ - sin θ 0 u .
To reduce the complexity of the system, the higher order damping terms D n ( ν ) in (16) are neglected. Nevertheless, the Coriolis-Centripetal matrix (12) is modelled assuming that v , w , p , q and r are small and u > > 0 . Thus, using (13)–(15),
C R B ( ν ) ν 0 0 0 0 0 - m u 0 0 0 u w q
C A ( ν ) ν 0 0 0 0 0 X u ˙ u 0 ( Z w ˙ - X u ˙ ) u 0 u w q .
Therefore, according to (2), (7), (17), (19), the dynamics become
m - X u ˙ 0 0 0 m - Z w ˙ 0 0 0 I y - M q ˙ u ˙ w ˙ q ˙ + - X u 0 0 0 - Z w 0 0 0 - M q u w q + 0 0 0 0 0 γ 1 u 0 ( Z w ˙ - X u ˙ ) u 0 u w q + ( W - B ) sin θ - ( W - B ) cos θ cos ϕ ( z g W - z b B ) sin θ = τ 1 τ 3 τ 5
for γ 1 = ( X u ˙ - m ) . As mentioned before, the longitudinal motions for Surge (u) and Heave (w) are controlled using the thruster configuration with the manifolds while the pitch ( ϕ ) motion is controlled using the internal pendulum mechanism (Section 2.3).

3.2.2. Lateral Model

For the lateral model, the longitudinal subsystem states { u , w , q and θ } and the roll angle ( ϕ ) are assumed to be small. The lateral kinematics result in
y ˙ ϕ ˙ ψ ˙ = cos ψ 0 0 0 1 0 0 0 1 v p r .
As in the previous Section 3.2.1, the higher order terms in (16) are neglected and the Coriolis terms in (12) are modelled assuming that v , w , p , q , and r are negligible. Hence from (13)–(15),
C R B ( ν ) ν 0 0 m u 0 0 - m z g u 0 0 0 v p r
C A ( ν ) ν 0 0 - X u ˙ u 0 0 0 ( X u ˙ - Y v ˙ ) u 0 0 v p r
Therefore, the dynamics of the lateral subsystem become
m - Y v ˙ 0 0 0 I x - K p ˙ 0 0 0 I z - N r ˙ v ˙ p ˙ r ˙ + - Y v 0 0 0 - K p 0 0 0 - N r v p r + 0 0 γ 2 u 0 0 - m z g u γ 4 u 0 0 v p r + - ( W - B ) cos θ sin ϕ γ 3 cos θ sin ϕ 0 = τ 2 τ 4 τ 6
where, γ 2 = ( m - X u ˙ ) ; γ 3 = ( z g W - z g B ) ; γ 4 = ( X u ˙ - Y v ˙ ) .

4. Control System Design

The spherical UV prototype was developed to test advanced control algorithms before implementing them in the UX-1 system during future mine site tests. In this work a State Feedback Linearization (FL) control algorithm is implemented and compared to a baseline controller developed and tested previously in [23].

4.1. State Feedback Linearization Controller

The State FL control method, shown in Figure 7, has been implemented and validated in a number works in the literature. In [29], the authors developed a FL controller for an UV with a linear Proportional-Derivative compensator for stabilization. The authors in [30,31] implemented heading controllers using a closed-loop gain shaping algorithm and a fault tolerant heading control system using the method of input-output FL, respectively. The main principle with FL is the transformation of the nonlinear dynamics of the system into a linear system:
η ¨ = a n
ν ˙ = a b
to which traditional control methods (e.g., Linear Quadratic Regulator, pole-placement) can be applied [27]. In (29), a n is interpreted as the commanded acceleration in the NED frame and in (30), a b is interpreted as the body-fixed commanded acceleration vector. We consider the nonlinear kinematic and kinetic equations from Section 3.1 in the form
η ˙ = J Θ ( η ) ν
M ν ˙ + n ( ν , η ) = τ
where η and ν assumed to be measurable and n is the nonlinear vector of model parameters such that
n ( ν , η ) = C ( ν ) ν + D ( ν ) ν + g ( η )
The FL algorithm considers a complete knowledge of the nonlinear vector of model parameters in (33). As seen in Section 3, these parameters are generally hard to estimate and often inaccurate. This is a critical step since parametric inaccuracy can destabilize a feedback control system. Often better results are obtained when uncertain terms are chosen to be zero in the controller [27]. Nevertheless, by understanding the physical properties of the model (e.g., geometry, symmetry), it is possible to know which terms in the model can be omitted when deriving a model-based nonlinear controller. The control law is selected such that the nonlinearities of the system dynamics can be canceled out
τ = M a b + n ( ν , η )
Differentiating (31) with respect to time and applying the control law (34) to the UV dynamics in (32) yields
M ( ν ˙ - a b ) = M J Θ - 1 ( η ) [ η ¨ - J ˙ Θ ( η ) ν - J Θ ( η ) a b ] = 0
From (35) it can be seen that by choosing
a n = J ˙ Θ ( η ) ν + J Θ ( η ) a b
results in the linear decoupled system M * ( η ¨ - a n ) = 0 where M * = J Θ - ( η ) M J Θ - 1 ( η ) > 0 . From (36) it can be concluded that the commanded acceleration in the body-fixed frame a b can be calculated by
a b = J Θ - 1 ( η ) [ a n - J ˙ Θ ( η ) ν ]
a n = η ¨ d - K d η ˜ ˙ - K p η ˜ - K i 0 t η ˜ ( τ ) d τ
where η d is the desired position and orientation vector in NED, η ˜ = η - η d the position and orientation tracking error and K p , K i and K d are positive definite matrices of the controller gains which can be chosen such that the error dynamics
η ¨ d + K d η ˜ ˙ + K p η ˜ + K i 0 t η ˜ ( τ ) d τ = 0
is globally exponentially stable.

4.2. Pole-Placement

Let Λ > 0 be defined as a diagonal design matrix
Λ = d i a g { λ 1 , λ 2 , , λ n }
used to specify the control bandwidth, η d the desired position and orientation vector in NED, and η ˜ = η - η d the position and orientation tracking error. Then the commanded acceleration in the NED frame can be chosen as a PID control law with acceleration feedforward,
a n = η ¨ d - K d η ˜ ˙ - K p η ˜ - K i 0 t η ˜ ( τ ) d τ
where K p , K i and K d are positive definite matrices of the controller gains which can be chosen such that the error dynamics
η ¨ d + K d η ˜ ˙ + K p η ˜ + K i 0 t η ˜ ( τ ) d τ = 0
is globally exponentially stable. A simple pole-placement algorithm for PID control can be chosen as:
( s + λ i ) 3 0 t η ˜ ( τ ) d τ = 0 ( i = 1 , 2 , , n )
where the poles for each DOF are in s = - λ i ( i = 1 , 2 , , n ) , which yields
K p = 3 Λ 2 = d i a g { 3 λ 1 2 , 3 λ 2 2 , , 3 λ n 2 } K i = Λ 3 = d i a g { λ 1 3 , λ 2 3 , , λ n 3 } K p = 3 Λ = d i a g { 3 λ 1 , 3 λ 2 , , 3 λ n } .

5. Experiments and Discussion

The experimental tests were designed to compare the performance of the FL controller, presented in Section 4.1, with the PID controller previously implemented and tested in [23] for a regulation problem scenario [32]. Thus, by comparing the ability of the UV to reach and maintain a desired position for longitudinal motions and heading control, an appropriate controller can be chosen for implementation in the real UX-1 robot. This type of maneuver is key for the overall purpose of the UNEXMIN project, which involves data gathering from sensitive scientific instruments (e.g., multi-spectral cameras) and a 3D mapping of the environment at specific locations inside the flooded mine tunnels which must not be corrupted by unstable control.

5.1. Experimental Setup

A 2 m × 1 m × 1 m water tank was used as the controlled environment to evaluate the position hold performance of the UV in several underwater tests. The feedback for the control algorithms was obtained using various methods. Surge (x) positions and Yaw ( ψ ) angles were acquired based on the works presented by [33,34], where the fiducial marker ArUco [35] was placed on the UV to estimate the attitude of the vehicle regarding a submersible camera installed inside the tank, as shown in Figure 8; Heave (z) depth measurements were read from the onboard pressure sensor and the Pitch ( θ ) feedback was obtained from the onboard gyroscope measurements in the Pixhawk Autopilot.
All hardware interfaces have been implemented in Python or c++ in Ubuntu 16.04 and data communications are handled using the ROS (https://www.ros.org/) middleware standard messages. Given the lack of available small low frequency wireless communication modules, a tether cable was used for real time data visualization, acquisition, and tuning. As can be seen in (18) the buoyancy of the vehicle depends on the volume of fluid displaced by the body. In the case of the UV in this work, the buoyancy is much larger than the weight of the vehicle and thus dead weights must be added in order to obtain approximate neutral buoyancy; however, in practice, it is a common practice to trim the weight of the robot as to have slightly positive buoyancy so that the UV in case of failure does not sink to the bottom. Lead weights were added in the flanges inside the watertight enclosure in addition to a sand bag weight around the watertight container for a total of 6kg in dead weight.

5.2. Underwater Experiments

In this work, the longitudinal motions (Surge (x), Heave (z) and Pitch ( θ )) as well as the Yaw ( ψ ) of the UV were tested in underwater experiments of position hold performance with the FL controller. Given that the Roll ( ϕ ) movement will not be used in data collection during the missions and the Sway (y) motion could cause turbulence because of the flow through the manifold, these motions are not taken into account in these experiments. For the experiments performed, the pole-placement algorithm in Section 4.2 was used to calculate the initial values for the FL controller gains which were finely tuned in situ once the robot was in the water. The theoretical values for the model parameters have been calculated using CAD software and the equations for hydrodynamic derivatives of the added mass force in (11), while omitting the linear and quadratic damping terms in (17).
Table 2, Table 3, Table 4 and Table 5 show the results of the transient state and steady-state time analysis evaluated on the response of both the PID and the FL control systems for each motion tested. The time response metrics chosen for the comparison of the performance were: overshoot percentage ( O S % ), rise time ( T r ), fall time ( T f ), settling time ( T s ) and mean error in steady state ( e S S ). To evaluate the effectiveness of the FL controller developed in this work, the results obtained with the PID controller will be interpreted as the baseline for the desired controller responses. Thus, an effective control of the spherical UV with the FL controller will present lower errors in steady-state and faster transient times.

5.2.1. Surge Motion

The experiments for the movement in surge were designed to validate the response of the UV to reference commands in the vehicles forward and backward directions of motion (x axis). Due to the limited FOV of the camera used to calculate the position feedback, the reference commands sent to the robot were constrained to a reduced range, thus, small steps were commanded. Figure 9 shows the position displacement in the x axis of the vehicle for the surge motion test. The UV was given an initial reference of 0.5 m which is movement in the forward direction towards the frame of the camera. Afterwards, multiple references are sent to verify the dynamics in each direction of movement.
As can be seen in Figure 9, the response of the FL controller is evidently more stable than that of the PID controller with clear overshoot by the PID controller for the set-points commanded at approximately t = 5 s and t = 85 s. Table 2 shows the comparison of the results obtained. During these tests, the FL controller was able to achieve less O S % while significantly reducing the T r from 6.83 s for the PID to 3.77 s and the T s from 24.94 s to 7.02 s. The PID controller averaged an e S S of 0.0083 m which is notable and sufficient for navigation purposes, while the FL controller obtained a lower e S S value of 0.0056 m. Nevertheless, during the FL controller tests, large fluctuations in the signal were detected from t = 40 s to t = 78 s which were a result of detection errors from the fiducial marker localization measurements due to turbidity in the experimental tank.

5.2.2. Heave Motion

The depth hold performance is especially significant due to the working environment the UV will have. Therefore, high precision is needed to validate a controller as suitable to be tested in the real UNEXMIN mine tunnel exploring robot. The depth references sent to the UV were 10 cm steps to analyze the performance of the vehicle in maintaining precise depth positions.
The dynamics of the heave tests, seen in Figure 10, showed very similar behaviors to the surge tests mentioned previously for both the PID and FL controllers. This was to be expected since the UV is symmetric in all three planes and thus must have similar dynamics in the linear motions. Both the PID controller and the FL controller achieved a similar T r , while the FL controller once again outperformed the PID controller in terms of T s with values of 7.9 s and 17.8 s, respectively, and a considerable decrease in the e S S from 0.0063 m to 0.0020 m. Nevertheless, the PID controller obtained a lower O S % for the upward movement set-point at t = 45 s and a faster T f than the developed FL controller. This change in O S % could be due to differences in trimming the robot to be as neutrally buoyant as possible, thus changing the buoyant force and the behavior when surfacing.

5.2.3. Yaw Motion

Figure 11 presents the results for the yaw ( ψ ) underwater experimental tests. During this test, the depth was kept at a static set-point to examine the rotational dynamics individually. Even though the UV was equipped with an onboard autopilot which measures heading angles with an embedded magnetometer, the measurements obtained in initial testing were not useful and presented significant noise. Therefore, the visual marker pose estimation was used for yaw measurements as well. With the reduced size of the test tank (Figure 8), the FOV of the camera used for the fiducial marker localization allowed an interval of approximately [105°, 140°] for command references in yaw to validate the PID and FL controllers.
As can be seen in Table 4, the FL yaw controller provided an O S % of 1.07%, lower than the 4.24% achieved by the PID controller, as well as lower T s and e S S . The PID yaw controller, on the other hand, had a much faster T r and T f . Nevertheless, as can be seen in Figure 11, the response for the PID controller showed undesirable oscillatory behavior in steady-state ( S S ) with a constant frequency and amplitude around the reference angle set at 130°. The response of the yaw controller should produce symmetric responses for both directions; however, the addition of the tether cable for data acquisition produced undesired drag in lateral direction which caused different control responses. Nonetheless, the controller compensated for these external disturbances and reached the reference angles.

5.2.4. Pitch Motion

As explained in Section 2 the pitch ( θ ) motion of the UV is achieved by the movement of an internal pendulum device which shifts the center of gravity. This movement in pitch allows the UV to navigate nose down (negative angles) or nose up (positive angles). The tests for the pitch motion had a duration of approximately 188 s. During this time, the UV was given steps in forward angle references of −30° (nose down) and backward references of +45° (nose up). The angle output of the UV to the reference step commands is shown in Figure 12.
The pitch angle of the UV is expected to be changed during normal operation in exploration tasks. One scenario is navigating nose down ( θ = 90 ° ) in a vertical shaft and afterwards shifting the pitch to enter a horizontal tunnel. Therefore, fast transient response in pitch control is desired as well as a low error in steady state. As can be seen in Figure 12, both the PID and FL controllers were able to effectively control the pitch angle in transient and steady state. However, the performance of the FL controller exceeded that of the PID with faster rise and fall times of 5.11 s and 4.25 s, respectively, while obtaining a settling time 7.16 s faster and an error in steady-state of 0.9347°. Nonetheless, the PID controller achieved a substantially lower O S % of 1.28% compared to the 8.03% achieved by the FL controller. This difference could be due to the slower and less aggressive tuning of the PID controller where higher values tended to oscillate and become unstable.

6. Conclusions

In this paper, the design and control of a scaled prototype spherical underwater vehicle for flooded mine tunnel exploration was presented. The mechanical and electrical designs have been validated, as well as a novel pendulum mechanism for passive pitch control and a manifold thruster configuration for propulsion. The 6 DOF equations of motion of the underwater vehicle have been derived and simplified to reduced ordered models of longitudinal and lateral states. Surge, heave, pitch and yaw motions were tested in real underwater position hold experiments to evaluate the performance of the State FL controller and compare these to a baseline PID controller.
Results demonstrate that the spherical underwater vehicle was able to achieve all the required motions and that the State FL control method outperformed the classical control scheme in terms of lower overall errors and faster transient responses. Thus, The FL control algorithm tested experimentally in this work will be extended and implemented on the UX-1 robot for field testing in real underwater mine scenarios.
One of the unique features expected of this UV is the ability to stabilize in a completely nose-down (−90°) or nose-up (+90°) orientation which increases maneuverability and aids navigation tasks. Pitching the vehicle while navigating in the forward or backward direction, offers the possibility of adjusting to any slope found without the need for extra actuation of the UV heave motion. Due to the limitations of the scaled prototype used, in this work the 90 degrees pitch movement was not tested. Improvements will be made to achieve this range of pitch motion in future tests. Nevertheless, the pitch control results validate the pendulum mechanism design implemented in this work as an appropriate solution for the pitch stabilization and control of a spherical UV.
Future work on the development of this prototype can be divided in three areas: parameter identification, software, and hardware. To evaluate the effects of uncertainties in the model parameter calculations, used for these initial tests, experimental identification tests will be performed to obtain accurate model parameters to improve the controllers’ overall performance and explore parameter uncertainty adaptation limits with the current control method. The work to be performed on improving the hardware includes testing low frequency communication modules for wireless operation, testing the lateral system dynamics generated by the manifold system configuration, and obtaining the full expected motion of the pitch using the pendulum mechanism. The software to be implemented for future works includes the implementation and validation of additional advanced control techniques such as sliding mode control and L 1 Adaptive Control and sensor fusion algorithms to enhance the localization of the UV in underwater tests. Additionally, the redundancy in the use of 8 motors for propulsion will be tested by simulating motor failures during operation and evaluating the reliability of the design.

Author Contributions

Conceptualization, R.A.S.F. and C.R.; methodology, R.A.S.F.; software, R.A.S.F.; hardware, E.A.P.R.; validation, R.A.S.F. and E.A.P.R.; writing—original draft preparation, R.A.S.F., E.P., S.D., Z.M., and C.R.; writing—review and editing, R.A.S.F., Z.M., E.A.P.R., C.R. and S.D.

Funding

This work was supported by the UNEXMIN project with funding from the European Union’s Horizon 2020 research and innovation programme under Grant Agreement No. 690008, and has been co-funded by the RoboCity2030-III-CM project (Robotica aplicada a la mejora de la calidad de vida de los ciudadanos. fase III; S2013/MIT-2748), funded by Programas de Actividades I+D en la Comunidad de Madrid and co-funded by Structural Funds of the EU.

Conflicts of Interest

The authors declare no conflict of interest.

Abbreviations

The following abbreviations are used in this manuscript:
AUVsAutonomous Underwater Vehicles
UVUnderwater Vehicle
COTSCommercial off-the-shelf
CGCenter of Gravity
CBCenter of Buoyancy
DOFDegrees of Freedom
ROSRobot Operating System
SNAMESociety of Naval Architects and Marine Engineers
GPIOGeneral-Purpose Input/Output
ESCElectronic Speed Controllers
NEDNorth-East-Down
FLFeedback Linearization
PIDProportional-Integral-Derivative

References

  1. UNEXMIN.eu. Project Overview: Developing Science and Technology. 2016. Available online: http://www.unexmin.eu/the-project/project-overview/ (accessed on 1 March 2018).
  2. Opinion of the European Economic and Social Committee on “Securing essential imports for the EU–through current EU trade and related policies”. Off. J. Eur. Union 2014, C67, 47–53.
  3. Senke, W. Applications of autonomous underwater vehicles (AUVs) in ocean mining exploration. In Proceedings of the 2013 OCEANS, San Diego, CA, USA, 23–27 September 2013; pp. 1–3. [Google Scholar]
  4. Bergh, K.; Hagen, O.K.; Berglund, E. Autonomous mapping with AUVs using relative terrain navigation. In Proceedings of the OCEANS 2017, Anchorage, AK, USA, 18–21 September 2017; pp. 1–7. [Google Scholar]
  5. Roman, C.; Singh, H. A Self-Consistent Bathymetric Mapping Algorithm. J. Field Robot. 2007, 24, 23–50. [Google Scholar] [CrossRef]
  6. Yu, X.; Dickey, T.; Bellingham, J.; Manov, D.; Streitlien, K. The application of autonomous underwater vehicles for interdisciplinary measurements in Massachusetts and Cape Cod Bays. Cont. Shelf Res. 2002, 22, 2225–2245. [Google Scholar] [CrossRef]
  7. Fernandes, P.G.; Brierley, A.S.; Simmonds, E.J.; Millard, N.W.; McPhail, S.D.; Armstrong, F.; Stevenson, P.; Squires, M. Fish do not avoid survey vessels. Nature 2000, 404, 35–36. [Google Scholar] [CrossRef] [PubMed]
  8. Nadis, S. Real time oceanography adapts to sea changes. Science 1997, 275, 1881–1882. [Google Scholar] [CrossRef]
  9. Afzulpurkar, S.; Maurya, P.; Navelkar, G.; Desa, E.; Mascarenhas, A.; Dabholkar, N.; Madhan, R.; Prabhudesai, S. Acoustic communication for Maya autonomous underwater vehicle—Performance evaluation of acoustic modem. In Proceedings of the 2015 IEEE Underwater Technology (UT), Chennai, India, 23–25 February 2015. [Google Scholar]
  10. Gongwer, C.A. Spherical Underwater Vehicle. U.S. Patent US4455962A, 26 June 1984. [Google Scholar]
  11. Choi, H.T.; Hanai, A.; Choi, S.K.; Yuh, J. Development of an underwater robot, ODIN-III. In Proceedings of the 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453), Las Vegas, NV, USA, 27–31 October 2003; Volume 1, pp. 836–841. [Google Scholar]
  12. Zhao, S.; Yuh, J. Experimental study on advanced underwater robot control. IEEE Trans. Robot. 2005, 21, 695–703. [Google Scholar] [CrossRef]
  13. Watson, S.A.; Crutchley, D.J.P.; Green, P.N. The design and technical challenges of a micro-autonomous underwater vehicle (uAUV). In Proceedings of the 2011 IEEE International Conference on Mechatronics and Automation, Beijing, China, 7–10 August 2011; pp. 567–572. [Google Scholar]
  14. Watson, S.; Crutchley, D.J.P.; Green, P.N. The mechatronic design of a micro-autonomous underwater vehicle (uAUV). IJMA 2012, 2, 157–168. [Google Scholar] [CrossRef]
  15. Lin, X.; Guo, S.; Tanaka, K.; Hata, S. Development of a spherical underwater robot. In Proceedings of the 2011 IEEE/ICME International Conference on Complex Medical Engineering, Harbin, China, 22–25 May 2011. [Google Scholar]
  16. Xiufen, Y.; Lin, X.; Guo, S. Miniature Spherical Underwater Vehicle Based on Water Jet Propulsion. Chinese Patent CN101318548A, 10 December 2008. [Google Scholar]
  17. Li, Y.; Guo, S.; Yue, C. Study on the control system of a novel spherical underwater robot. In Proceedings of the 2015 IEEE International Conference on Mechatronics and Automation (ICMA), Beijing, China, 2–5 August 2015; pp. 2100–2105. [Google Scholar]
  18. Li, Y.; Guo, S.; Wang, Y. Design and characteristics evaluation of a novel spherical underwater robot. Robot. Auton. Syst. 2017, 94, 61–74. [Google Scholar] [CrossRef]
  19. Yue, C.; Guo, S.; Li, M.; Li, Y. Passive and active attitude stabilization method for the spherical underwater robot (SUR-II). In Proceedings of the 2013 IEEE International Conference on Robotics and Biomimetics (ROBIO), Shenzhen, China, 12–14 December 2013; pp. 1019–1023. [Google Scholar]
  20. Agrawal, A.; Prasad, B.; Viswanathan, V.; Panda, S.K. Dynamic modeling of variable ballast tank for spherical underwater robot. In Proceedings of the 2013 IEEE International Conference on Industrial Technology (ICIT), Cape Town, South Africa, 25–28 February 2013. [Google Scholar]
  21. Schultz, C.; Woolsey, C. An Experimental Platform for Validating Internal Actuator Control Strategies. In Proceedings of the IFAC Guidance and Control of Underwater Vehicles, Newport, UK, 9–11 April 2003. [Google Scholar]
  22. Krogstad, T.; Gravdahl, J.; Pettersen, K.; Børhaug, E. AUVSAT: An experimental platform for spacecraft formation flying. In Proceedings of the 59th International Astronautical Congress, Glasgow, UK, 29 September–3 October 2008. [Google Scholar]
  23. Suarez Fernandez, R.A.; Andres Parrar, E.; Milosevic, Z.; Dominguez, S.; Rossi, C. Design, Modelling and Control of a Spherical Autonomous Underwater Vehicle for Mine Exploration. In Proceedings of the International Conference on Intelligent Robots and Systems (IROS 2018), Madrid, Spain, 1–5 October 2018. [Google Scholar]
  24. Zavari, S.; Heininen, A.; Aaltonen, J.; Koskinen, K.T. Early stage design of a spherical underwater robotic vehicle. In Proceedings of the 2016 20th International Conference on System Theory, Control and Computing (ICSTCC), Sinaia, Romania, 13–15 October 2016; pp. 240–244. [Google Scholar]
  25. Nomenclature for Treating the Motion of a Submerged Body Through a Fluid. Available online: https://www.itk.ntnu.no/fag/TTK4190/papers/Sname%201950.PDF (accessed on 24 March 2019).
  26. Fossen, T.I. Nonlinear Modeling and Control of Underwater Vehicles. Ph.D. Thesis, Department of Engineering Cybernetics, Norwegian University of Science and Technology, Trondheim, Norway, 1991. [Google Scholar]
  27. Fossen, T.I. Handbook of Marine Craft Hydrodynamics and Motion Control; John Wiley and Sons: New York, NY, USA, 2011. [Google Scholar]
  28. Ueno, M. Hydrodynamic derivatives and motion response of a submersible surface ship in unbounded water. Ocean Eng. 2010, 37, 879–890. [Google Scholar] [CrossRef]
  29. Chellabi, A.; Nahon, M. Feedback linearization control of undersea vehicles. In Proceedings of the OCEANS 1993, Victoria, BC, Canada, 18–21 October 1993. [Google Scholar]
  30. Cheng, X.; Yan, Z.; Bian, X.; Zhou, J. Application of linearization via state feedback to heading control for Autonomous Underwater Vehicle. In Proceedings of the 2008 IEEE International Conference on Mechatronics and Automation, Takamatsu, Japan, 5–8 August 2008; pp. 477–482. [Google Scholar]
  31. Luo, Y.; Wen, X.; Fu, L.; Li, S.; Zhou, M.; Gong, X. Fault-Tolerant and Guaranteed Cost Control Based on the Feedback Linearization of Autonomous Underwater Vehicle. In Proceedings of the 2010 Second International Conference on Intelligent Human-Machine Systems and Cybernetics, Nanjing, China, 26–28 August 2010; pp. 169–173. [Google Scholar]
  32. Watson, S.A.; Green, P. Depth Control for Micro-Autonomous Underwater Vehicles (uAUVs): Simulation and Experimentation. Int. J. Adv. Robot. Syst. 2014, 11. [Google Scholar] [CrossRef]
  33. Dos Santos Cesar, D.B.; Gaudig, C.; Fritsche, M.; dos Reis, M.A.; Kirchner, F. An evaluation of artificial fiducial markers in underwater environments. In Proceedings of the OCEANS 2015, Genoa, Italy, 18–21 May 2015. [Google Scholar]
  34. Caccia, M. Vision-based ROV horizontal motion control: Near-seafloor experimental results. Control Eng. Pract. 2007, 15, 703–714. [Google Scholar] [CrossRef]
  35. Garrido-Jurado, S.; Muñoz-Salinas, R.; Madrid-Cuevas, F.J.; Marín-Jiménez, M.J. Automatic generation and detection of highly reliable fiducial markers under occlusion. Pattern Recognit. 2014, 47, 2280–2292. [Google Scholar] [CrossRef]
Figure 1. Spherical underwater vehicle prototype during pool tests.
Figure 1. Spherical underwater vehicle prototype during pool tests.
Sensors 19 01445 g001
Figure 2. Watertight Enclosure used for electronic devices in the prototype UV.
Figure 2. Watertight Enclosure used for electronic devices in the prototype UV.
Sensors 19 01445 g002
Figure 3. Final placement of the manifolds in a hemisphere of the prototype UV.
Figure 3. Final placement of the manifolds in a hemisphere of the prototype UV.
Sensors 19 01445 g003
Figure 4. Thruster direction for UV movement. (a) Surge (red) and Heave (blue) motions; (b) Yaw (red) and Roll (blue) motions (c) Sway motion (red) and flow force direction (green).
Figure 4. Thruster direction for UV movement. (a) Surge (red) and Heave (blue) motions; (b) Yaw (red) and Roll (blue) motions (c) Sway motion (red) and flow force direction (green).
Sensors 19 01445 g004
Figure 5. (a) Pendulum mechanism assembled in flange of watertight container (b) front view and (c) side view of pitch motion acquired by pendulum shift.
Figure 5. (a) Pendulum mechanism assembled in flange of watertight container (b) front view and (c) side view of pitch motion acquired by pendulum shift.
Sensors 19 01445 g005
Figure 6. Schematics of the developed underwater vehicle with the frames of reference used in the equations of motion.
Figure 6. Schematics of the developed underwater vehicle with the frames of reference used in the equations of motion.
Sensors 19 01445 g006
Figure 7. Feedback Linearization control block diagram with nonlinear decoupling in NED frame and transformation to the Body frame.
Figure 7. Feedback Linearization control block diagram with nonlinear decoupling in NED frame and transformation to the Body frame.
Sensors 19 01445 g007
Figure 8. Underwater tests experimental setup. A submergible camera was installed inside the tank to estimate the position of the UV.
Figure 8. Underwater tests experimental setup. A submergible camera was installed inside the tank to estimate the position of the UV.
Sensors 19 01445 g008
Figure 9. Experimental results obtained in underwater tests in Surge.
Figure 9. Experimental results obtained in underwater tests in Surge.
Sensors 19 01445 g009
Figure 10. Experimental results obtained in underwater tests in Heave.
Figure 10. Experimental results obtained in underwater tests in Heave.
Sensors 19 01445 g010
Figure 11. Experimental results obtained in underwater tests in Yaw.
Figure 11. Experimental results obtained in underwater tests in Yaw.
Sensors 19 01445 g011
Figure 12. Experimental results obtained in underwater tests in Pitch.
Figure 12. Experimental results obtained in underwater tests in Pitch.
Sensors 19 01445 g012
Table 1. Actuator Configuration for Spherical UV.
Table 1. Actuator Configuration for Spherical UV.
MotionThruster Configuration
Surge { T 1 , T 5 , - T 3 , - T 7 }
Yaw { T 3 , T 5 , - T 1 , - T 7 }
Heave { T 4 , T 8 , - T 2 , - T 6 }
Roll { T 4 , T 6 , - T 2 , - T 8 }
Sway { T 1 , T 2 , T 3 , T 4 , - T 5 , - T 6 , - T 7 , - T 8 }
Table 2. Surge Time Response Results in Underwater Experiments for PID and FL Controllers.
Table 2. Surge Time Response Results in Underwater Experiments for PID and FL Controllers.
MetricsPIDFLUnits
OS%13.1611.98[%]
T r 6.833.77[s]
T f 3.172.18[s]
T s 24.947.02[s]
e S S 0.00830.0056[m]
Table 3. Heave Time Response Results in Underwater Experiments for PID and FL Controllers.
Table 3. Heave Time Response Results in Underwater Experiments for PID and FL Controllers.
MetricsPIDFLUnits
OS%2.965.92[%]
T r 2.742.27[s]
T f 1.702.52[s]
T s 17.807.93[s]
e S S 0.00630.0020[m]
Table 4. Yaw Time Response Results in Underwater Experiments for PID and FL Controllers.
Table 4. Yaw Time Response Results in Underwater Experiments for PID and FL Controllers.
MetricsPIDFLUnits
OS%4.241.07[%]
T r 1.112.61[s]
T f 1.344.05[s]
T s 7.836.99[s]
e S S 0.65220.6179[°]
Table 5. Pitch Time Response Results in Underwater Experiments for PID and FL Controllers.
Table 5. Pitch Time Response Results in Underwater Experiments for PID and FL Controllers.
MetricsPIDFLUnits
OS%1.288.03[%]
T r 7.055.11[s]
T f 8.594.25[s]
T s 16.349.18[s]
e S S 1.5310.9347[°]

Share and Cite

MDPI and ACS Style

Suarez Fernandez, R.A.; Parra R., E.A.; Milosevic, Z.; Dominguez, S.; Rossi, C. Nonlinear Attitude Control of a Spherical Underwater Vehicle. Sensors 2019, 19, 1445. https://doi.org/10.3390/s19061445

AMA Style

Suarez Fernandez RA, Parra R. EA, Milosevic Z, Dominguez S, Rossi C. Nonlinear Attitude Control of a Spherical Underwater Vehicle. Sensors. 2019; 19(6):1445. https://doi.org/10.3390/s19061445

Chicago/Turabian Style

Suarez Fernandez, Ramon A., E. Andres Parra R., Zorana Milosevic, Sergio Dominguez, and Claudio Rossi. 2019. "Nonlinear Attitude Control of a Spherical Underwater Vehicle" Sensors 19, no. 6: 1445. https://doi.org/10.3390/s19061445

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop