design and development of low cost variable buoyancy

13
1 Design and Development of Low Cost Variable Buoyancy System for the Soft Grounding of Autonomous Underwater Vehicles Jeffery S. Riedel, Anthony J. Healey, David B. Marco and Bahadir Beyazay Naval Postgraduate School Center for AUV Research Monterey, CA 93943-5000 408.656.1146 voice, 408.656.2238 fax {jsriedel, healey, marco, bbeyazay}@me.nps.navy.mil ABSTRACT To provide a vehicle with the ability to hold position in a coastal environment requires a significant amount of onboard power. This power requirement either forces the vehicle size to increase to allow for suitable mission duration or reduces the amount of time the vehicle has to conduct its mission. To relax the power requirement, we propose to develop vehicles that can employ a bottom-sitting or soft grounding behavior. To obtain this behavior requires vehicles that have the capability to self- ballast. By optimally positioning itself and sitting on the bottom, the AUV can be placed in a sleep mode, with only monitoring sensors awake, thereby conserving power. In this paper we present the preliminary work conducted in the areas of simulation, design and testing of a Variable Buoyancy System (VBS) for an Autonomous Underwater Vehicle (AUV). This buoyancy system will be integrated into the new NPS AUV which is currently under construction, to support the upcoming joint operations with the University of Lisbon's MARIUS vehicle. We will discuss the tradeoffs and analysis that went into the design of the system, as well as the challenges associated with the integration of such a behavior and system into the vehicle. INTRODUCTION Energy storage is limited in AUV’s. To assist with energy management, data gathering missions have been proposed where the vehicle should sit on the bottom and gather acoustic/video/chemical data over extended periods of time. In this grounding scenario, thrusters may be used. However, there are two disadvantages for this method: high energy consumption and restricted use close to the ocean bottom. The motivation for this paper is to study a low cost, simple soft grounding capability for a submersible vehicle using controllable ballast. For simplicity, water ballast is considered. The design of the control system is based on the NPS Phoenix AUV. The ballast system is designed to control the weight addition into or out of the two ballast tanks. Ballast control of vehicles is not a new subject and we can find many examples beginning in the 1900’s, the non-rigid airships are very good examples of ballast control. One of the most important elements of a non-rigid airship is the ballonet-system. A ballonet as seen in Figure 1 is an airbag (one or two of them) inside the envelope, which is provided with air from a blower or directly from the engine unit. The air could be removed from the ballonet through the valves. If the airship has a front and aft ballonet then the height and pitch of the airship can be steered. For example, if the aft bag is filled with more air, then the airship will become heavier in the rear part of the envelope and the ship will incline increasing the altitude of the ship by using the engines. As Figure 1 depicted, the airship can also be statically trimmed [1]. Control was manual. For most underwater vehicles, the depth / pitch control is normally provided by hydroplanes. As an example, consider the NPS Phoenix AUV, the MIT Odyssey and the WHOI Remus. At low speed however, the control surfaces provide reduced control authority and the ballast control problem is very complex due to nonlinear, time-varying, uncertain hydrodynamics. Inherent lags arising from the integration of ballast water flow rate commands into weight change makes the control difficult to stabilize. There are some designs that used a bang-bang control system [2]. The ARPA’s Unmanned Undersea Vehicle (UUV) employed a fuzzy logic ballast controller which was claimed to be comparable with the performance that can be obtained from standard control techniques, but does not require traditional linear or nonlinear design methods. Figure 1. Sectional elevation of the Parseval-Airship "PL VI", 1910.

Upload: others

Post on 12-Jun-2022

2 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: Design and Development of Low Cost Variable Buoyancy

1

Design and Development of Low Cost Variable Buoyancy System for the SoftGrounding of Autonomous Underwater Vehicles

Jeffery S. Riedel, Anthony J. Healey, David B. Marco and Bahadir BeyazayNaval Postgraduate SchoolCenter for AUV ResearchMonterey, CA 93943-5000

408.656.1146 voice, 408.656.2238 fax{jsriedel, healey, marco, bbeyazay}@me.nps.navy.mil

ABSTRACT

To provide a vehicle with the ability to hold position ina coastal environment requires a significant amount of onboardpower. This power requirement either forces the vehicle size toincrease to allow for suitable mission duration or reduces theamount of time the vehicle has to conduct its mission. To relaxthe power requirement, we propose to develop vehicles that canemploy a bottom-sitting or soft grounding behavior. To obtainthis behavior requires vehicles that have the capability to self-ballast. By optimally positioning itself and sitting on the bottom,the AUV can be placed in a sleep mode, with only monitoringsensors awake, thereby conserving power.

In this paper we present the preliminary workconducted in the areas of simulation, design and testing of aVariable Buoyancy System (VBS) for an Autonomous UnderwaterVehicle (AUV). This buoyancy system will be integrated into thenew NPS AUV which is currently under construction, to supportthe upcoming joint operations with the University of Lisbon'sMARIUS vehicle. We will discuss the tradeoffs and analysis thatwent into the design of the system, as well as the challengesassociated with the integration of such a behavior and systeminto the vehicle.

INTRODUCTION

Energy storage is limited in AUV’s. To assistwith energy management, data gathering missions havebeen proposed where the vehicle should sit on the bottomand gather acoustic/video/chemical data over extendedperiods of time. In this grounding scenario, thrusters maybe used. However, there are two disadvantages for thismethod: high energy consumption and restricted use closeto the ocean bottom. The motivation for this paper is tostudy a low cost, simple soft grounding capability for asubmersible vehicle using controllable ballast. Forsimplicity, water ballast is considered. The design of thecontrol system is based on the NPS Phoenix AUV. Theballast system is designed to control the weight additioninto or out of the two ballast tanks.

Ballast control of vehicles is not a new subjectand we can find many examples beginning in the 1900’s,

the non-rigid airships are very good examples of ballastcontrol. One of the most important elements of a non-rigidairship is the ballonet-system. A ballonet as seen in Figure1 is an airbag (one or two of them) inside the envelope,which is provided with air from a blower or directly fromthe engine unit. The air could be removed from theballonet through the valves. If the airship has a front andaft ballonet then the height and pitch of the airship can besteered. For example, if the aft bag is filled with more air,then the airship will become heavier in the rear part of theenvelope and the ship will incline increasing the altitude ofthe ship by using the engines. As Figure 1 depicted, theairship can also be statically trimmed [1]. Control wasmanual.

For most underwater vehicles, the depth / pitchcontrol is normally provided by hydroplanes. As anexample, consider the NPS Phoenix AUV, the MITOdyssey and the WHOI Remus. At low speed however,the control surfaces provide reduced control authority andthe ballast control problem is very complex due tononlinear, time-varying, uncertain hydrodynamics.Inherent lags arising from the integration of ballast waterflow rate commands into weight change makes the controldifficult to stabilize. There are some designs that used abang-bang control system [2]. The ARPA’s UnmannedUndersea Vehicle (UUV) employed a fuzzy logic ballastcontroller which was claimed to be comparable with theperformance that can be obtained from standard controltechniques, but does not require traditional linear ornonlinear design methods.

Figure 1. Sectional elevation of the Parseval-Airship"PL VI", 1910.

Page 2: Design and Development of Low Cost Variable Buoyancy

Report Documentation Page Form ApprovedOMB No. 0704-0188

Public reporting burden for the collection of information is estimated to average 1 hour per response, including the time for reviewing instructions, searching existing data sources, gathering andmaintaining the data needed, and completing and reviewing the collection of information. Send comments regarding this burden estimate or any other aspect of this collection of information,including suggestions for reducing this burden, to Washington Headquarters Services, Directorate for Information Operations and Reports, 1215 Jefferson Davis Highway, Suite 1204, ArlingtonVA 22202-4302. Respondents should be aware that notwithstanding any other provision of law, no person shall be subject to a penalty for failing to comply with a collection of information if itdoes not display a currently valid OMB control number.

1. REPORT DATE 2005 2. REPORT TYPE

3. DATES COVERED -

4. TITLE AND SUBTITLE Design and Development of Low Cost Variable Buoyancy System for theSoft Grounding of Autonomous Underwater Vehicles

5a. CONTRACT NUMBER

5b. GRANT NUMBER

5c. PROGRAM ELEMENT NUMBER

6. AUTHOR(S) 5d. PROJECT NUMBER

5e. TASK NUMBER

5f. WORK UNIT NUMBER

7. PERFORMING ORGANIZATION NAME(S) AND ADDRESS(ES) Naval Postgraduate School,Center for AUV Research,Monterey,CA,93943-5000

8. PERFORMING ORGANIZATIONREPORT NUMBER

9. SPONSORING/MONITORING AGENCY NAME(S) AND ADDRESS(ES) 10. SPONSOR/MONITOR’S ACRONYM(S)

11. SPONSOR/MONITOR’S REPORT NUMBER(S)

12. DISTRIBUTION/AVAILABILITY STATEMENT Approved for public release; distribution unlimited

13. SUPPLEMENTARY NOTES The original document contains color images.

14. ABSTRACT To provide a vehicle with the ability to hold position in a coastal environment requires a significant amountof onboard power. This power requirement either forces the vehicle size to increase to allow for suitablemission duration or reduces the amount of time the vehicle has to conduct its mission. To relax the powerrequirement, we propose to develop vehicles that can employ a bottom-sitting or soft grounding behavior.To obtain this behavior requires vehicles that have the capability to selfballast. By optimally positioningitself and sitting on the bottom, the AUV can be placed in a sleep mode, with only monitoring sensorsawake, thereby conserving power. In this paper we present the preliminary work conducted in the areas ofsimulation, design and testing of a Variable Buoyancy System (VBS) for an Autonomous UnderwaterVehicle (AUV). This buoyancy system will be integrated into the new NPS AUV which is currently underconstruction, to support the upcoming joint operations with the University of Lisbon’s MARIUS vehicle.We will discuss the tradeoffs and analysis that went into the design of the system, as well as the challengesassociated with the integration of such a behavior and system into the vehicle.

15. SUBJECT TERMS

16. SECURITY CLASSIFICATION OF: 17. LIMITATION OF ABSTRACT

18. NUMBEROF PAGES

12

19a. NAME OFRESPONSIBLE PERSON

a. REPORT unclassified

b. ABSTRACT unclassified

c. THIS PAGE unclassified

Standard Form 298 (Rev. 8-98) Prescribed by ANSI Std Z39-18

Page 3: Design and Development of Low Cost Variable Buoyancy

2

In another fuzzy logic control model, a 15 stateKalman filter was developed to provide estimates of themotion variables and the applied lift and torque acting onthe UUV. The control law decided between three possiblecontrol actions; pump water in both tanks, pump water outof both tanks and turn both pumps off. The fuzzy inputstate space was composed of depth error and depth rate,and each is divided into partitions. The fuzzy controllerinterpolated between the partitions allowing the control tovary smoothly as the states move from one partition toanother. These movements of states were provided by onand off of ballast pumps [3].

In this paper we outline the development of adepth controller using sliding mode control techniques fora neutrally buoyant vehicle. The sliding mode controller isdesigned on the basis of the simplified four degrees offreedom vertical plane equations of motion. A linearquadratic regulator (LQR) proportional approach is thenutilized for the design of the ballast controller, whichproduces flow rate commands, allowing the vehicle tohave a soft grounding behavior. These two controllers usea logic based depth regulator to provide realisticsimulation of the vehicle’s flight and grounding operationsin a single mission.

VEHICLE MODELING AND EQUATIONS OFMOTION

We will deal with only vertical plane variables;i.e., heave, pitch, and surge. The vertical plane stabilityanalysis involves heave and pitch motions. However, thesurge equation couples into pitch and heave through theoffset, zG. This is a dynamic coupling, and could beeliminated by redefining hydrodynamic coefficients withrespect to the ship’s center of gravity instead of itsgeometric center.

Restricting the motions of the vehicle to thevertical (dive) plane, the only significant motions that mustbe incorporated to model the vehicle in the dive plane are,the surge velocity (u), the heave velocity (w), the pitchvelocity (q), the pitch angle (θ ) and the global depthposition (Z).

q=θ&

θθ

ρδα δδ

sin)(cos)(

)()(

2

1)(

)()()(

32

BzWzBxWx

xdxxqw

xqwxbCMMUUwM

wqmzUqmxMqMIwMmx

BGBG

nose

tail

Dsw

GGqqywG

bs

−−−

−−−

−+++

−−=−+−−

&& &&

θθ cossin wUZ +−=& (1)

These equations can be linearized for a levelflight path when the following are obtained :

=

−+−+−−

Z

q

w

MIMmx

ZmxZm

qywG

qGw

&

&

&

&

&&

&&

θ

1000

0)()(0

0)()(0

0001

δ

θ

δ

δ

+

−−−−+

0

0

001

0)()(

0)(0

0100

2

2

MU

ZU

Z

q

w

U

UmxMUMWzz

UmZUZ

GqwBG

qw

(2)For the cases considered during this work,

the vehicle has also two ballast tanks which weredesigned to be used during the grounding. Theseballast tanks can be seen in Figure 2.

L1 L2

BallastTank1

BallastTank2

pump1 pump2

1δw 2δw

Figure 2. The Location of Ballast Tanks in the AUV

The new forces are δw1 and δw2 and sincethe ballast tanks are not located in the same distancefrom the center of gravity of the vehicle there will bealso two moments, L1δw1 and L2δw2. There will bealso small change in moment of inertia. So all thesechanges can be listed as;

21 wwWW o δδ ++=

( )g

wwWm o 21 δδ ++

= ,

and the new equations of motion become,

( )( )

−+−

−−−

=

1

0

0

0

0

)(

)(

0

0

0

0

0

0

1

qy

qG

wG

w

MI

Zmx

Mmx

Zm

&

&

&

&M

Page 4: Design and Development of Low Cost Variable Buoyancy

3

( )( )

( )

−+

−−=

0

0

0

0

0

1

1

0

0

0

UmxM

UZm

uM

uZ

u

BzWz Gq

q

w

w

BGoA

−=

0

0

0

1

0

0

1

0

2

2

21 UM

UZ

LLd

doB

=

s

w

w

δδδ

2

1

U

=

Z

q

wiablesstate

θ

var_

wherex& = M-1Aox + M-1Bou

CONTROL SYSTEM DESIGN

Flight Control

Flight control and weight control compose twomain subsystem of a soft grounding system. In flightcontrol the vehicle is kept neutrally buoyant and the planeangles are the control inputs. However in weight control,the flow rates for both ballast tanks are controlled withzero forward velocity and plane angle. These twocomponents of the designed control system were explainedin following sections.

The dynamics of underwater vehicles aredescribed by highly nonlinear systems of equations withuncertain coefficients and disturbances that are difficult tomeasure. An automatic controller for this kind of vehiclemust satisfy two conflicting requirements: First, it must besophisticated enough to perform its mission in an openocean environment with ever-changing vehicle/environment interactions. Second, it must be simpleenough to achieve real-time control without nonessentialcomputational delays. Sliding mode control theory yields adesign that fulfills the above requirements. It providesaccurate control of nonlinear systems despite un-modeledsystem dynamics and disturbances. Furthermore, a slidingmode controller is easy to design and implement. A veryeffective sliding mode controller can be developed fromthe linearized equations of motion for an underwatervehicle [7], where the control law becomes [7],

)/sgn()( 1 φη xsBskxu TT sat−−−= (3)

The gain vector k can be found easily by using Matlab.The Matlab command place accepts as inputs the A and B

matrices along with a vector of the desired closed looppoles and returns the vector k.

Weight Control

The vehicle’s grounding behavior can besimulated by adding weight proportionally to both tanks atconstant flow rate and by using zero plane angle. It isneeded to add weight proportionally to eliminate themoment effect since these ballast tanks are not located inthe same distance from the center of gravity. As it can beseen from the Figure 2, L1 > L2.

To get zero moment,

12

12 w

L

Lw δδ =

Since ballast control is achieved throughcommanded pump flow rate, two more state equations areadded to those existing four states,

22

11

fw

fw

=

=&

&

δδ

where iw&δ represents change of weight in tank i and fi

represents flow rate of pump i. So the ballast controlequations of motion become :

−−−−−−

2

1

100000

010000

001000

000)()(0

000)()(0

000001

w

w

z

qMIMmx

ZmxZm

qywG

qGw

&

&

&

&

&

&

&&

&&

δδ

ωθ

+

−−−−−

+

=2

1

2

1

21

10

01

00

00

00

00

000000

000000

00001

0)()(

110)(0

000100

f

f

w

w

z

q

u

LLUmxMuMBzWz

UZmuZ

GqwBoG

qw

δδ

ωθ

Flow rates for ballast tanks are control inputs.

Weight Control With Linear Quadratic Regulator

The system above is given as,BuAxx +=&

and the closed loop optimal control law can be found by

SxBRu T1−=where S can be found by solving the algebraic Riccatiequation for the positive-definite S ,

0QSBSBRSASA T1T =+−+ −

In Matlab, the commandlqr(A,B,Q,R)

Page 5: Design and Development of Low Cost Variable Buoyancy

4

gives the continuous-time, linear, quadratic regulatorproblem and the associated Riccati equation. Thiscommand calculates the optimal feedback gain matrix Kfor control law which minimizes the well knownperformance index.

GROUNDING WITH VERTICAL THRUSTERS

The bladed thrusters are the essential elements ofimproved vehicle positioning systems. With automaticposition control, the thrusters enable important scientificand industrial tasks such as automatic docking, stationkeeping, precise surveying, inspection, sample gatheringand manipulation. Incorporating precise models of thrusterdynamics into the feedback control systems of marinevehicles promises improved vehicle positioning [9].

Most small-to-medium sized underwater vehiclesare powered by electric motors driving propellers mountedin ducts. The propeller is mounted in a duct or shroud inorder to increase the static and dynamic efficiency of thethruster. Thrusters are subject to serious degradation due toaxial and cross flow effects. Axial flow effects can bereasonably approximated by the modeling of the thrusterunit alone, the velocity of the fluid entering the thrustershroud effectively changes the angle of attack of thepropeller , thus altering the force produced. Cross floweffects are much more difficult to model and are highlydependent on the position of the thruster on the vehicle.The amount of force produced by the thruster will reducethe overall gain of a control system unless these effects arespecifically in the controller design [10].

For this work, NPS Phoenix vehicle is taken as anexample. Figure 3 shows the locations of vertical andhorizontal thrusters on the vehicle. Those four tubesrepresent the thruster shrouds. In Figure 3, the verticalthruster tubes can be seen throughout the vehicle. Thrusterblades are located close to the bottom of those tubes.

Thruster moment and force equations weredeveloped by Whitcomb and Yoerger [9], amongst others.In that paper, the control system for these thrusters wasalso discussed. But in this study, these thruster force andmoments were assumed as some constant parameters andalso no control law was developed to control them. Sincethe main element for grounding is the weight control, thethrusters were just used as auxiliary elements of thisprocedure in order to increase depth rate. By usingthrusters in addition to the weight control, followingchanges should be made to heave and pitch rate equations,

θδδ cos)()()()( 212 wwUwZqmzUqZmqZmxwZm wGqqGw +++++=−−+− && &&

thruster

nose

tail

D Zdxxqw

xqwxbC +

−−

− ∫3)(

)(2

1 ρ

∫ −−

+−−=−+−−nose

tailD

wGGqqywG

xdxxqw

xqwxbC

UwMwqmzUqmxMqMIwMmx

3)()(

2

1

)()()(

ρ

&& &&

qMwLwLBzWzBxWx thrusterBGBoG −+−+−−−− θδδθθ cos)(sin)(cos)( 2211

(4)where Zthruster and Mthruster are thruster force and thrustermoment respectively.

Zverthrust1

Zverthrust2

Zhorthrust1

Zhorthrust2

Figure 3 Horizontal and Vertical Thrusters of NPSPhoenix AUV

RESULTS AND DISCUSSION

In previous chapters, the mathematical models ofthe control system were developed. To prove the validityof the flight and weight controllers, the system wassimulated by using the parameters of NPS Phoenix AUV.First the AUV was controlled by a flight controller (slidingmode control) during its diving from surface to acommanded flight depth. Second, the flight controller andthe different cases of weight controller were simulated onthe vehicle.

Flight Control

In the NPS Phoenix vehicle, there are fourvertical control planes powered by servo motors. Using theparameters of NPS Phoenix AUV and a nominal speed of4 ft/sec, A and B matrices become

−−−−−

=

0014

09667.06027.01086.0

09247.04119.30155.0

0100

A

−−

=

0

0123.0

7139.0

0

B

Page 6: Design and Development of Low Cost Variable Buoyancy

5

By choosing the poles as p = [-2, -2.1, -2.2, 0], the vectork was calculated, k = [-18.3998 , -2.4217 , -15.6369 , 0]

(5.3)AC is calculated from AC = A – Bk

=

0 0 1 4.0-

0 1.1592- 0.5729 0.3352-

0 12.0882- 5.1408- 13.1205-

0 1 0 0

CA

The eigenvector of ATC for the pole at the origin is the

sliding surface s = [-0.8733 ; -0.0272 ; -0.4692 ; 0.1287]as a result with 1.0=φ , the control law becomes

q6319.154217.23998.18 −−−= ωθδ

.1.0/(1287.0

4692.00272.08733.0sgn)4.0(

)

+−−−−

comzz

qsat

ωθ

(5)The motion of the vehicle is restricted to the

vertical plane. The motion profiles for depth and pitchhave been specified using sliding mode control. For themaneuver, the commanded depth was 4 ft and the vehiclewas originally at the surface. As can be seen from theFigure 4, during the flight, maximum pitch angle becomes0.042 rad (~ 2.5 degrees). When the vehicle reaches thecommanded depth as seen in Figure 5, the pitch anglebecomes zero as expected . The controller produces thedive plane angle command according to the depth error. Inthe beginning the depth error is large, so the systemproduces higher values of plane angle command in order toeliminate this error. With the full state feedback, thevehicle responded very well to these commands.

Adding Weight To Both Tanks Without Control

After completion of the flight to the commandeddepth, the vehicle gets water to both tanks in order tobecome heavy. Figure 6 shows the weight increase in thetanks. During grounding, the planes kept at zero degrees asdepicted in Figure 7. To keep depth rate within limits, themaximum weight pumped in was limited at 5 lb. for eachtank. With this additional weight, the vehicle sat on theground (10 ft.) with 0.6 ft/sec depth rate. Even though theweight was added proportionally ( 1212 )/( wLLw δδ = ) to

get zero moment effect, there is still some moment becauseof the vehicle motion. As a result, the pitch angle increasessince there is no control on either depth rate or pitch angle.As seen on Figure 8 and Figure 5-6, at the end of a 6 ft.drop, the pitch angle becomes 0.6 rad. (35 degrees). Thismethod can be used for very short grounding depths (2-3ft), but for other cases, it is not recommended since thesystem is completely unstable.

0 5 10 15 20 25 30 35 40-0.045

-0.04

-0.035

-0.03

-0.025

-0.02

-0.015

-0.01

-0.005

0Pitch angle vs time

Time (sec)

Pitc

h A

ngle

(R

ad.)

Figure 4. Pitch Angle Plot During The Flight

0 5 10 15 20 25 30 35 40-0.5

0

0.5

1

1.5

2

2.5

3

3.5

4Depth vs time

Time (sec)

Dep

th (

ft)

Figure 5. Depth Change As A Function Of TimeDuring The Flight.

0 5 10 15 20 25 30 35 40 45 500

0.5

1

1.5

2

2.5

3

3.5

4

4.5

5Weight in balast tank vs time

Time - sec

Wei

ght i

n ba

last

tank

(lb

)

Figure 6. Weight Addition During Grounding With NoControl On Flow Rates

Page 7: Design and Development of Low Cost Variable Buoyancy

6

0 5 10 15 20 25 30 35 40 45 50-0.05

0

0.05

0.1

0.15

0.2

0.25

0.3

0.35

0.4Plane angle vs time

Time - sec

Plan

e an

gle

(rad

)

Figure 7. Plane Angle During Flight And Grounding

0 5 10 15 20 25 30 35 40 45 50

0

2

4

6

8

10

Depth vs time

Time - sec

Dep

th (

ft)

Figure 8. Depth Change During The Flight AndGrounding

0 5 10 15 20 25 30 35 40 45 50-0.7

-0.6

-0.5

-0.4

-0.3

-0.2

-0.1

0Pitch angle vs time

Time - sec

Pitc

h an

gle

(rad

)

Figure 9. Pitch Angle Change For Flight AndGrounding

Weight Control With Linear Quadratic Regulator

In order to keep the depth rate and pitch anglewithin limits, the linear quadratic regulator technique wasused in designing a weight control. The parameters of NPSPhoenix vehicle were used for simulation. With theseknown parameters and 0.1 ft/sec forward velocity, A and Bmatrices become,

−−−−

−−

=

000000

000000

000011.0

0065.00130.000242.00151.01086.0

0196.00223.000231.00853.00155.0

000100

A

=

10

01

00

00

00

00

B

In practice, high values of pitch angle (> 15degrees) are not desired for a safe and stable grounding ofthe vehicle. So the designed control law should not toleratelarge pitch angles. Choosing larger elements of Q for thepitch angle compared with the others can provideimproved control. So, the Q and R matrices were chosen asfollows:

=

100000

010000

0010000

000100

000010

0000010

2

4

Q

××

=5

5

1030

0103R

By using lqr command in Matlab, the control gain matrixK can be obtained, as

−=

0613.00365.00120.00021.01294.00322.0

0365.00754.00138.00526.01263.00608.0K

Since grounding to the ocean floor from a certain depthdesired, the command matrix should be xcom = [0 0 0 zgr 00]’ where zgr = (ground depth) - (the depth wheregrounding is started). So the control law becomes,

u = -Kxerror

where

xerror = x - xcom

The simulation of the system with this controllaw can be seen in Figure 10 through Figure 17.

Positive flow rate represents water inlet to theballast tanks, and negative flow represents the opposite.The pumps are not allowed to pump out when there is nowater in ballast tanks. Figure 10 and Figure 11 show whenthe weight in a ballast tank and the pump flow rate becomezero. This is provided by a simple controller whichcompares the weight in ballast tank (δw) and flow rate (f).If δw is equal to zero and flow rate is a negative number,than the control input (f) of that pump becomes zero.

Page 8: Design and Development of Low Cost Variable Buoyancy

7

At the commanded depth, the speed control unitslows down the vehicle to an almost zero forward velocity(U = 0.1 ft/sec). The speed controller's other duty is tocontrol the longitudinal position. During the flight, thespeed control unit compares the vehicle’s location (X) withcommanded location (Xcom) which is a longitudinaldistance from the original position. When the vehicle is atthe commanded depth of flight, a deceleration procedurestarts. A simple algorithm was used to calculate theminimum distance needed for deceleration to reach thecommanded location at the end of the grounding. Thechange of forward velocity due to the depth change can beseen in the Figure 16.

The depth rate as seen in Figure 14 is very low inthis method because of the command given to the weightcontrol. The weight control produces its control values dueto the errors that are the differences between thecommanded and the actual states. In the above case, onlythe depth (Z) command has a value, the commands forother states are zero. At the end of the simulation, the pitchangle becomes almost zero as seen in Figure 15. In the firsthalf of the grounding, Figure 12 and Figure 13 show anincrease in weight for both tanks, but in the second half,the system tries to make the vehicle neutrally buoyant asexpected.

LQR With Positive Weight Command

So when the vehicle reaches the ground, therewill be almost no water in ballast tanks. But for thestability of the grounding, the vehicle should be heavier.For this reason, in addition to the depth command, theweight can also be commanded to increase the depth rateor the weight of the vehicle at the end of the grounding.So, the command vector, xcom is changed to,

xcom = [0 , 0 , 0 , zground , δwcom1 , δwcom2]’

where δwcom are some positive numbers and represent thecommand for additional weight and the system wassimulated with these new parameters. Figure 18 throughFigure 23 show the plot of this simulation. In this case,pitch angle reaches a maximum value of 0.18 rad (10.31degrees) which is 4 times greater than the previoussimulation. With increasing pitch angle, there is also anincrease in the depth rate. The depth rate becomes 0.35ft/sec which is again almost 4 times greater than theprevious simulation. Since the commanded depth for thecontrol law is the depth of the ground, the system tries tomake the vehicle neutrally stable to keep the vehicle onthat depth by pumping water out of ballast tanks. Aftergrounding, pumps should pump water in ballast tanks untilthey are full. Because this additional weight is needed tokeep the vehicle sitting on the ground against the current.

Another method for increasing the depth rate is tocommand with a depth value that is greater than the actualground depth. Because in the beginning the error will behigher, the weight controller will produce higher values offlow rate.

0 10 20 30 40 50 60 70 80 90 100 110-0.02

0

0.02

0.04

0.06

0.08

0.1Flow rate of pump-1 vs time

Time - sec

Flow

rat

e fo

r pu

mp1

(lb/

sec)

Figure 10. Flow Rate As A Function Of Time ForPump-1 With Depth Command Only

0 10 20 30 40 50 60 70 80 90 100 110-0.02

-0.01

0

0.01

0.02

0.03

0.04

0.05

0.06

0.07

0.08Flow rate for pump-2 vs time

Time - sec

Flow

rat

e fo

r pu

mp-

2 (l

b/se

c)

Figure 11. Flow Rate As A Function Of Time ForPump-2 With Depth Command Only

Page 9: Design and Development of Low Cost Variable Buoyancy

8

0 10 20 30 40 50 60 70 80 90 100 110-0.1

0

0.1

0.2

0.3

0.4

0.5

0.6Weight in tank-1 vs time

Time - sec

Wei

ght i

n ta

nk-1

(lb

)

Figure 12. Weight Change In Ballast Tank-1 WithDepth Command Only

0 10 20 30 40 50 60 70 80 90 100 110-0.05

0

0.05

0.1

0.15

0.2

0.25

0.3

0.35

0.4

0.45Weight in tank-2 vs time

Time - sec

Wei

ght i

n ta

nk-2

(lb

)

Figure 13. Weight Change In Ballast Tank-2 WithDepth Command Only

0 10 20 30 40 50 60 70 80 90 100 110

0

2

4

6

8

10

Depth vs time

Time - sec

Dep

th (

ft)

Figure 14. Depth Change During Flight AndGrounding

0 10 20 30 40 50 60 70 80 90 100 110-0.05

-0.04

-0.03

-0.02

-0.01

0

0.01Pitch angle vs time

Time - sec

Pitc

h an

gle

(rad

)

Figure 15. Pitch Angle Change With Depth CommandOnly

0 10 20 30 40 50 60 70 80 90 100 110

0

2

4

6

8

10

Change in depth and forward velocity

Time - sec

Velocity

------- Depth

Figure 16. Comparison of Depth and Forward VelocityChange

0 50 100 150 200 250-10

-9

-8

-7

-6

-5

-4

-3

-2

-1

0

1Distance from the original position vs depth

X (ft)

Z (

ft)

Figure 17. Response Of The Vehicle To TheLongitudinal Position Command

Page 10: Design and Development of Low Cost Variable Buoyancy

9

0 10 20 30 40 50 60-0.05

0

0.05

0.1

0.15

0.2

0.25

0.3

0.35Flow rate for pump -1 vs time

Time - sec

Flow

rat

e fo

r pu

mp-

1 (l

b/se

c)

Figure 18. Flow Rate For Pump-1 With Weight AndDepth Commands

0 10 20 30 40 50 60-0.05

0

0.05

0.1

0.15

0.2

0.25

0.3Flow rate for pump -2 vs time

Time - sec

Flow

rat

e fo

r pu

mp

-1 (l

b/se

c)

Figure 19. Flow Rate For Pump-2 With Weight AndDepth Commands

0 10 20 30 40 50 600

0.5

1

1.5

2

2.5Weight in tank-1 vs time

Time - sec

Wei

ght i

n ta

nk -

1 (l

b)

Figure 20. Weight Change In Ballast Tank-1 WithDepth And Weight Commands

0 10 20 30 40 50 600

0.2

0.4

0.6

0.8

1

1.2

1.4

1.6

1.8Weight in tank - 2 vs time

Time - sec

Wei

ght i

n ta

nk -

2 (l

b)

Figure 21. Weight Change In Ballast Tank-2 WithDepth And Weight Commands

0 10 20 30 40 50 60

0

2

4

6

8

10

Depth vs time

Time - sec

Dep

th (

ft)

Figure 22. Depth Change With Weight And DepthCommands

0 10 20 30 40 50 60-0.2

-0.18

-0.16

-0.14

-0.12

-0.1

-0.08

-0.06

-0.04

-0.02

0Pitch angle vs time

Time - sec

Pitc

h an

gle

(rad

)

Figure 23. Pitch Angle As A Function Of Time WithWeight And Depth Commands

Page 11: Design and Development of Low Cost Variable Buoyancy

10

Grounding With Thrusters In Addition To Weight Control

NPS Phoenix AUV’s cross-body thrusters consistof a 3 in. ID aluminum tube with a centrally located 4blade brass propeller. A spur gear is mounted around a 3in. diameter propeller and driven by a pinion connected toa 24 Vdc motor giving a 2.5:1 gear reduction. The twist ofthe propeller blade is symmetric enabling bi-directionaloperation delivering approximately 2.0 pound of bollardpull force in either direction [11]. The system wassimulated with the new state equations and the sameweight control conditions defined in section C of thischapter. Figure 24 through Figure 29 show the result ofthis simulation. The depth rate becomes 0.5 ft/sec and thepitch angle reaches a higher value since there is no controlon thrusters. Because the thrusters are dominant in thiscase, the weight controller losses most of its effect on pitchcontrol.

Bottom Stability

The ground also affects the vehicle closing to thebottom. The theory explained by Hoerner and Borst [12],predicts that roughly below CL =1.5 (CL represents liftcoefficient), lift will be increased in proximity of theground. Even though no experimental data is provided forNPS Phoenix AUV, it can be assumed that lift coefficientwill be less than 1.5. For study of the bottom stability, twodifferent cases of grounding were considered. Figure 30shows these two cases.

In the case that the vehicle’s stern touched to thebottom first, the lift will decrease the weight and increasethe angle of attack. This reduces the stability and makesgrounding more difficult. But this feature can be veryhelpful when leaving the ground. In the other case, thebow of the vehicle touches the ground first. This time liftmakes the vehicle heavier and decreases the angle of attackproviding more stable grounding. After the completion ofgrounding process, the vehicle sits on the bottom with nolift since the lift coefficient, CL is assumed zero because ofthe symmetric shape of the NPS Phoenix AUV. Figure 31shows the ocean current that the vehicle can stand withdifferent ballast weights sitting on soil with 0.7 frictioncoefficient. When both ballast tanks are filled with watercompletely (~23.4 lb. water in each tank), the vehicle cankeep its position against 1.52 m/sec (~3 knots) of current.

0 10 20 30 40 50 60-0.04

-0.02

0

0.02

0.04

0.06

0.08

0.1Flow rate for pump-1 vs time

Time - sec

Flow

rat

e fo

r pu

mp-

1 (l

b/se

c)

Figure 24. Flow Rate For Pump-1 With Thrusters AndWeight Control

0 10 20 30 40 50 60-0.04

-0.02

0

0.02

0.04

0.06

0.08Flow rate for pump-2 vs time

Time - sec

Flow

rat

e fo

r pu

mp-

2 (lb

/sec

)

Figure 25. Flow Rate For Pump-2 With Thrusters AndWeight Control

0 10 20 30 40 50 60-0.05

0

0.05

0.1

0.15

0.2

0.25

0.3

0.35Weight in tank-1 vs time

Time - sec

Wei

ght i

n ta

nk-1

(lb)

Figure 26. Weight Change In Ballast Tank-1 WithThrusters And Weight Control

Page 12: Design and Development of Low Cost Variable Buoyancy

11

0 10 20 30 40 50 60-0.05

0

0.05

0.1

0.15

0.2

0.25

0.3

0.35Weight in tank-2 vs time

Time - sec

Wei

ght i

n ta

nk-2

(lb

)

Figure 27. Weight Change In Ballast Tank-2 WithThrusters And Weight Control

0 10 20 30 40 50 60-0.045

-0.04

-0.035

-0.03

-0.025

-0.02

-0.015

-0.01

-0.005

0Pitch angle vs time

Time - sec

Pitc

h an

gle

(rad

)

Figure 28. Pitch Angle As A Function Of Time WithThrusters And Weight Control

0 10 20 30 40 50 60

0

2

4

6

8

10

Depth vs time

Time -sec

Dep

th (

ft)

Figure 29. Depth Change During Flight AndGrounding With Thrusters And Wt. Cont.

B

LwwW 21 +δ+δ+

CV

LB +

21 wwW δ+δ+

CV

Figure 30. Forces Acting On The Vehicle In Two CasesOf Grounding

0 0.5 1 1.50

5

10

15

20

25Weight in Each Ballast Tank vs. Current

Current (m/sec)

Wei

ght i

n B

alla

st T

ank

(lb)

Figure 31. The Current That Vehicle Can Keep ItsPosition

REFERENCES

1. Schenkenberger, J., “Jens Schenkenberger’sLuftschiff Homepage.” [http://people. Frankfurt.netsurf.de/Jens.Schenkenberger/]. 1998

2. Motyka, P., and Bergmann, E., “The Design of aControl System for the Ballast and Trim of anUnmanned Submersible”, Proceedings of the1984 American Control Conference, San Diego,California, v.3, pp. 1786-1793, 6 June 1984

3. DeBitetto, P.A., “Fuzzy Logic for Depth Controlof Unmanned Undersea Vehicles”, IEEE Journalof Oceanic Engineering , v.20, no.3, pp. 242-247,July 1995

4. Healey, A.J., Dynamics and Control of MobileRobotic Vehicles, Lecture Notes, chp. 2, pp. 3-19,1995

Page 13: Design and Development of Low Cost Variable Buoyancy

12

5. Riedel, J.S., Pitchfork Bifurcations and DivePlane Reversal of Submarines at Low Speeds,Engineer’s Thesis, Naval Postgraduate School,Monterey, California, June 1993

6. Papoulias, F.A., Dynamics of Marine Vehicles,Lecture Notes, chp. 4, pp 48-61, 1993

7. Hawkinson, T.D., Multiple Input Sliding ModeControl for Autonomous Diving and Steering ofUnderwater Vehicles, Master’s Thesis, NavalPostgraduate School, Monterey, California,December 1990

8. Papoulias, F.A., Modern Control Systems,Lecture Notes, chp. 6, pp 95-101, 1992

9. Whitcomb, L.L., and Yoerger, D.R.,“Comparative Experiments in the Dynamics andModel-Based Control of Marine Thrusters”,Proceedings of the 1995 IEEE OceansConference, San Diego, California, v.1, pp 1019-1028, October 1995

10. Yoerger, D.R., Cooke, J.G., and Slotine, J.E.,“The Influence of Thruster Dynamics onUnderwater Vehicle Behavior and TheirIncorporation Into Control System Design”, IEEEJournal of Oceanic Engineering, v. 15, no. 3, pp167-178, July 1990

11. Marco, D.B., Autonomous Control of UnderwaterVehicles and Local Area Maneuvering, Ph.D.Dissertation, Naval Postgraduate School,Monterey, California, September 1996

12. Hoerner, S.F., and Borst, H.V., Fluid DynamicLift, chp. 20-21, Mrs. Liselotte A. Hoerner, 1975

ACKNOWLEDGEMENTS

The authors wish to thank the Office of Naval Research forfinancial support of the NPS AUV program under WorkRequest N0001498WR30175. This work is based on theMSME thesis of LTJG Bahadir Beyazay, Turkish Navy,