towards autonomous underwater iceberg profiling using a...

7
Towards Autonomous Underwater Iceberg Profiling using a Mechanical Scanning Sonar on a Underwater Slocum Glider Mingxi Zhou Ralf Bachmayer Faculty of Engineering and Applied Science Memorial University of Newfoundland St.John’s, NL, Canada Brad deYoung Department of Physics and Physical Oceanography Memorial University of Newfoundland St.John’s, NL, Canada Abstract—A Slocum underwater glider is been modified to map the underside of icebergs for monitoring iceberg deterioration off the coast of Newfoundland, Canada. The vehicle is equipped with a mechanical scanning sonar to map the iceberg surface, and a thruster for level-flight at a higher surging speed. In this paper we are presenting a profile-following controller that uses the sonar ranges to compute desired headings guiding the Slocum glider traveling safely around icebergs. A vehicle-attached occupancy map (VOM) is updated using sonar measured ranges with a dynamic inverse-sonar model. A desired path is then generated from the VOM by applying polynomial regression on the occupied cells. The line-of-sight guidance law is implemented to compute the desired heading to follow the desired path. The algorithm is initially evaluated in a simulation environment. The vehicle operation is simulated on a real-time hardware simulator, while the sonar is modeled in ray-tracing method. The iceberg is derived from an iceberg database with additional translational and rotational motion emulating a floating iceberg. After that, the guidance system is applied on a set of field data collected in 2015. During the trial, the Slocum glider was deployed to profile an underwater ramp feature in Conception Bay, Newfoundland, Canada. The feasibility of the porposed controller is indicated by the outcomes from this paper. Keywords: Slocum glider, profile-following control, iceberg, AUV. I. MOTIVATION Icebergs originating from the glacier in Western Greenland have drawn attentions from the offshore production in the northern Atlantic Ocean. A deep-keel iceberg has a potential of scouring the seafloor leading a risk of destroying underwater pipelines, while bergy bits and growlers broke up from ice- bergs may damage the underwater infrastructures near offshore platforms. To prevent potential damages posed by icebergs, ice management is introduced to monitor surrounding icebergs, to predict the iceberg drift, assess the risk of collision, and take preventive actions such as towing to redirect threatening icebergs [1]. The underwater portion of an iceberg, about 90% of the overall volume, is one of the most critical factors affecting the iceberg trajectory and stability [2]. Therefore, an increased knowledge about the underside of an iceberg will result in a potentially more accurate prediction in iceberg drift and a safer operation when redirecting the iceberg. In 1978, an analysis about profiling the iceberg using a teth- ered submersible equipped with a depth sensor and an upward- looking sonar was proposed in [3]. In 1980, a submerged tow- fish with a side-scanning sonar was used to map icebergs with a surface vessel [4]. However, the underwater location of the submerged tow-fish is hard to be determined. Currently, the underside of icebergs is usually measured using a horizontal plane scanning sonar lowered from a surface vessel. With the development of underwater navigation, the position of the sonar can be determined from dead-reckoning with an inertial- measurement unit (IMU) or acoustic methods. The resulting underwater shape is composed from the sonar measurements at multiple locations around the iceberg. In [5] and s [6], Autonomous Underwater Vehicles (AUVs) which have been extensively used for oceanography surveys are selected as excellent candidates for underwater iceberg mapping. The advantage of AUVs is not limited to profile the target at a constant distance for maintaining consistent sensor footprints, but also they can simultaneously collect other scientifical information such as temperature, salinity and water circulation. The multi-modal information about icebergs is a great help in improving iceberg drift prediction and iceberg stability analysis for iceberg management. The research on AUV based iceberg mapping has been conducted by various groups. In [7], and [8], the authors are focus on the AUV navigation relative to a floating iceberg using the information about the relative speed of the AUV to the iceberg from a Doppler-Velocity-Log (DVL). Then the iceberg shape can be derived from vertical sonar swath from a side-looking multibeam sonar. In [9], an AUV equipped with an upward- looking multibeam sonar was deployed to travel underneath an ice island, a massive tabular iceberg. As a result, the depth of the ice island was measured along the preprogrammed vehicle’s path. However, multibeam sonars and the DVLs are not affordable on some AUVs due to the limitations in expense, power consumption, or space for integration. In [10], an adaptive heading controller was developed on a Slocum underwater glider. The desired heading of the vehicle was adjusted based on the measurements from a side forward-looking mechanical scanning sonar. Only the sonar

Upload: others

Post on 26-Jun-2020

4 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: Towards Autonomous Underwater Iceberg Profiling using a …ncfrn.mcgill.ca/members/pubs/autoIce.pdf · Towards Autonomous Underwater Iceberg Profiling using a Mechanical Scanning

Towards Autonomous Underwater Iceberg Profilingusing a Mechanical Scanning Sonar on a

Underwater Slocum GliderMingxi Zhou Ralf BachmayerFaculty of Engineering and Applied Science

Memorial University of NewfoundlandSt.John’s, NL, Canada

Brad deYoungDepartment of Physics and Physical Oceanography

Memorial University of NewfoundlandSt.John’s, NL, Canada

Abstract—A Slocum underwater glider is been modified to mapthe underside of icebergs for monitoring iceberg deterioration offthe coast of Newfoundland, Canada. The vehicle is equipped witha mechanical scanning sonar to map the iceberg surface, and athruster for level-flight at a higher surging speed. In this paper weare presenting a profile-following controller that uses the sonarranges to compute desired headings guiding the Slocum glidertraveling safely around icebergs. A vehicle-attached occupancymap (VOM) is updated using sonar measured ranges with adynamic inverse-sonar model. A desired path is then generatedfrom the VOM by applying polynomial regression on the occupiedcells. The line-of-sight guidance law is implemented to computethe desired heading to follow the desired path. The algorithmis initially evaluated in a simulation environment. The vehicleoperation is simulated on a real-time hardware simulator, whilethe sonar is modeled in ray-tracing method. The iceberg isderived from an iceberg database with additional translationaland rotational motion emulating a floating iceberg. After that,the guidance system is applied on a set of field data collected in2015. During the trial, the Slocum glider was deployed to profilean underwater ramp feature in Conception Bay, Newfoundland,Canada. The feasibility of the porposed controller is indicatedby the outcomes from this paper.

Keywords: Slocum glider, profile-following control, iceberg,AUV.

I. MOTIVATION

Icebergs originating from the glacier in Western Greenlandhave drawn attentions from the offshore production in thenorthern Atlantic Ocean. A deep-keel iceberg has a potential ofscouring the seafloor leading a risk of destroying underwaterpipelines, while bergy bits and growlers broke up from ice-bergs may damage the underwater infrastructures near offshoreplatforms. To prevent potential damages posed by icebergs, icemanagement is introduced to monitor surrounding icebergs,to predict the iceberg drift, assess the risk of collision, andtake preventive actions such as towing to redirect threateningicebergs [1]. The underwater portion of an iceberg, about90% of the overall volume, is one of the most critical factorsaffecting the iceberg trajectory and stability [2]. Therefore, anincreased knowledge about the underside of an iceberg willresult in a potentially more accurate prediction in iceberg driftand a safer operation when redirecting the iceberg.

In 1978, an analysis about profiling the iceberg using a teth-ered submersible equipped with a depth sensor and an upward-looking sonar was proposed in [3]. In 1980, a submerged tow-fish with a side-scanning sonar was used to map icebergs witha surface vessel [4]. However, the underwater location of thesubmerged tow-fish is hard to be determined. Currently, theunderside of icebergs is usually measured using a horizontalplane scanning sonar lowered from a surface vessel. Withthe development of underwater navigation, the position of thesonar can be determined from dead-reckoning with an inertial-measurement unit (IMU) or acoustic methods. The resultingunderwater shape is composed from the sonar measurementsat multiple locations around the iceberg.

In [5] and s [6], Autonomous Underwater Vehicles (AUVs)which have been extensively used for oceanography surveysare selected as excellent candidates for underwater icebergmapping. The advantage of AUVs is not limited to profilethe target at a constant distance for maintaining consistentsensor footprints, but also they can simultaneously collectother scientifical information such as temperature, salinity andwater circulation. The multi-modal information about icebergsis a great help in improving iceberg drift prediction and icebergstability analysis for iceberg management. The research onAUV based iceberg mapping has been conducted by variousgroups. In [7], and [8], the authors are focus on the AUVnavigation relative to a floating iceberg using the informationabout the relative speed of the AUV to the iceberg froma Doppler-Velocity-Log (DVL). Then the iceberg shape canbe derived from vertical sonar swath from a side-lookingmultibeam sonar. In [9], an AUV equipped with an upward-looking multibeam sonar was deployed to travel underneathan ice island, a massive tabular iceberg. As a result, the depthof the ice island was measured along the preprogrammedvehicle’s path. However, multibeam sonars and the DVLsare not affordable on some AUVs due to the limitations inexpense, power consumption, or space for integration.

In [10], an adaptive heading controller was developed ona Slocum underwater glider. The desired heading of thevehicle was adjusted based on the measurements from a sideforward-looking mechanical scanning sonar. Only the sonar

Page 2: Towards Autonomous Underwater Iceberg Profiling using a …ncfrn.mcgill.ca/members/pubs/autoIce.pdf · Towards Autonomous Underwater Iceberg Profiling using a Mechanical Scanning

measured ranges in a single scan were used for computing thedesired heading, and the influence from the wide beamwidthof the sonar (35 degrees) was unconsidered. Furthermore, theperformance of the controller was limited in the field thatthe Slocum glider was not able to follow the iceberg profilewhen the shape is suddenly changed. In this paper, we areproposing a profile-following controller as an improvementfrom [10] for a better performance. The controller is evaluatedin a simulation environment and then applied on a set of datacollected from a field trial near an underwater ramp feature.

II. ICE-PROFILING SLOCUM GLIDER AT AOSL

For the purpose of underwater mapping and profiling, aSlocum underwater glider has been modified in the Au-tonomous Ocean Systems Laboratory (see Figure 1). In thenose, a Tritech Micron mechanical scanning sonar is installedin a free-flooded acoustically transparent extension section(white section shown in Figure 1). The sonar is mounted on atilting plate allowing the change of its forward-looking angleon the starboard side. As shown in the Figure 1, the sonaris controlled to scan about the Zs axis and has a beamwidthof 35 degrees in the top view. The forward-looking angle isconfigured to 35 degrees for this particular sonar. To avoid anycollisions with icebergs, the forward-looking angle provides anominal forward-looking distance about 40 meters that is twicethe minimum turning radius of the glider. An acoustic modemis integrated for improving the underwater navigation if pairedwith an acoustic navigation and communication system fromthe surface that measures the range together with azimuthangle and elevation angle to the vehicle. Thus, the locationof the glider can be determined with known locations of thesurface unit measured by a Global Positioning System (GPS).It provides an alternative source for underwater navigationbesides the default method, model based dead-reckoning.Beyond that, a thruster is also integrated on the glider for level-flight operation, and a conductivity-temperature-depth (CTD)sensor is installed on the mid-section under the wing.

Downward-looking altimeter and a underwater modem.

Tritech Micron mechanical scanning

sonar

Folding thruster

Top-view of the nose

Zs�

35O�

35O�

CTD

Fig. 1: Ice-profiling Slocum glider modified in AOSL

III. SONAR BASED PROFILE-FOLLOWING CONTROL

To help the understanding of the concept, the terms used inthe remaining sections are defined as follows,

• Xe−Ye−Ze is the inertial coordinate system. Its originis located at a known Latitude and Longitude on the seasurface. The x-axis is pointed north, y-axis is pointedeast and z-axis is pointed downward (NED coordinatesystem);

• ψt is the vehicle’s heading at time t refers to the truenorth;

• xet , yet is the origin of the center of buoyancy of the

vehicle at time t in the Xe − Ye − Ze;• Rt is a range measured by the sonar at time t;• σ(t) is the scanning angle of the sonar at time t relative

to the horizontal plane of the vehicle;• β is the forward-looking angle of the sonar, 35 degrees;• Mv

xvt ,y

vt

is the vehicle-attached occupancy map (VOM) attime t, its origin coincides with the CB;

• xvt , yvt is the index of a cell in VOM at time t;

• P (Mvxvt ,y

vt|R1, ..., Rt) is the probability of occupancy of

the cell with the index xvt , yvt in the VOM at time t. The

probability of occupancy is updated based on the sonarmeasured ranges from time 1 to time t;

• ltx,y is the log-odds presentation of P (Mvxvt ,y

vt|R1, ..., Rt).

Ye

Xe

Xv

Yv

Fig. 2: The vehicle-attached occupancy map. The sonar is oriented to have aforward-looking angle (β).

As shown in Figure 2, a vehicle-attached occupancy map(VOM) is used to present the 2-dimensional environmentaround the vehicle in the form of gridded cells. A probabilityof occupancy ranging from zero to one is associated with eachcell. Only the environment on the starboard side of the vehicleis included because the sonar is oriented to have a forward-looking angle on the starboard side resulting a backward-looking angle on the opposite side. Therefore, the vehicleis limited to circumnavigated around an object only in theclockwise direction. The origin of the VOM is located at thecenter of buoyancy (CB) of the vehicle, while the y-axis ispointed starboard and x-axis is pointed forward.

Page 3: Towards Autonomous Underwater Iceberg Profiling using a …ncfrn.mcgill.ca/members/pubs/autoIce.pdf · Towards Autonomous Underwater Iceberg Profiling using a Mechanical Scanning

Due to the change of the location and orientation of thevehicle from time t-1 to t, a cell in the Mv

xvt−1,y

vt−1

hasto be projected into Mv

xvt ,y

vt

prior the update from a sonarmeasured range at time t. Equation 1 to 3 show the con-version from xvt−1, y

vt−1 to xvt , y

vt , meanwhile, the proba-

bility of occupancy P (Mvxvt−1,y

vt−1|R1, ..., Rt−1) is projected

to P (Mvxvt ,y

vt|R1, ..., Rt−1). Then, the sonar measured range

at time t, Rt, is used to update P (Mvxvt ,y

vt|R1, ..., Rt−1)

to P (Mvxvt ,y

vt|R1, ..., Rt) based on the log-odds using the

Bayes’ theorem [18]. The calculation of the log-odds ofP (Mv

xvt ,y

vt|R1, ..., Rt−1) is shown in Equation 4. The log-

odds at index (xvt , yvt ) is updated in Equation 5 using an

inverse-sonar model. In this particular sonar configuration,the wide beamwidth is aligned in the moving direction ofthe vehicle. Unlike the multibeam sonar, the echo intensityreceived at different angles relative to the transducer is notavailable. Therefore, an uncertainty in resolving the locationof the target with the measured ranges will be introduced. Adynamic inverse-sonar model [11] is now used in Equation5, while a static inverse-sonar model is optional from [19].In Equation 5, P (MV

xvt ,y

vt|Rt) is the probability of occupancy

derived from the inverse-sonar model, lt−1x,y is the log-oddsbased on the sonar measured range from time 1 to t-1, andl0x,y is the initial log-odds assumed by the user. For example,l0x,y is equal to zero if the probability of occupancy of thecells in the VOM are initialized at 0.5 in Equation 1. After thelog-odds is updated with the sonar measurements, the updatedprobability of occupancy is calculated in Equation 6.

[∆xt−1t

∆yt−1t

]=

[cosψt−1 sinψt−1− sinψt−1 cosψt−1

] [xet − xet−1yet − yet−1

](1)[

xvtyvt

]= M ·

[xvt−1 −∆xt−1t

yvt−1 −∆yt−1t

](2)

M =

[cos(ψt − ψt−1) sin(ψt − ψt−1)− sin(ψt − ψt−1) cos(ψt − ψt−1)

](3)

lt−1x,y = logP (Mv

xvt ,y

vt|R1, ..., Rt−1)

1− P (Mvxvt ,y

vt|R1, ..., Rt−1)

(4)

ltx,y = logP (Mv

xvt ,y

vt|Rt)

1− P (Mvxvt ,y

vt|Rt)

+ lt−1x,y + l0x,y (5)

P (MVxvt ,y

vt|R1, ..., Rt) = 1− 1

1 + eltx,y

(6)

The effective sector [σL, σH ] is introduced to control theupdate on VOM. With this feature, only the targets close tothe depth of the vehicle are included. The targets outside theeffective sector, such as the surface returns and the seafloorreturns, are excluded to avoid unnecessary reactions. Theeffective sector is usually [−5o, 5o] to include the returnsfrom 5 meters above and below the vehicle. The desiredtrajectory will be generated everytime the sonar swept the

effective sector. The overall procedures of updating the VOMare summarized as follows,

1) VOM is initialized, i.e. P (Mvxv0 ,y

v0) = 0.5 and l0x,y = 0;

2) vehicle moved from xet−1, yet−1 to xet , y

et with the head-

ing changed from ψt−1 to ψt;3) if σ(t) ∈ [σL, σH ] then go to step 4), else jump to step

10);4) projects P (Mv

xvt−1,y

vt−1|R1, ..., Rt−1) to

P (Mvxvt ,y

vt|R1, ..., Rt−1) with Equation 1 to 3 based on

the change of vehicle’s location and orientation ;5) calculate lt−1x,y , the log-odds of P (Mv

xvt ,y

vt|R1, ..., Rt−1),

in Equation 4;6) a sonar measured range Rt is obtained at time t;7) calculate P (Mv

xvt ,y

vt|Rt), the probability of occupancy

from an inverse-sonar model and projected into theVOM;

8) update the log-odds in the VOM, ltx,y , using Equation5;

9) calculate P (MVxvt ,y

vt|R1, ..., Rt), the updated probability

of occupancy from ltx,y using Equation 6;10) if σ(t) /∈ [σL, σH ] and σ(t − 1) ∈ [σL, σH ], calculate

the desired trajectory from the VOM;11) repeat the step 2) to 10).

0 20 40 60 80 100−10

0

10

20

30

40

50

60

70

80

90

yvt

xv t

0

0.1

0.2

0.3

0.4

0.5

0.6

0.7

0.8

0.9

1y = b1x + b0

y = b2x2 + b1x + b0y = b3x3 + b2x2 + b1x + b0

Fig. 3: An example of VOM, the profile of the terrrain is estimated by applyingpolynomial regression on the occupied cells.

Figure 3 shows an example of the VOM updated fromsonar measurements in multiple scans. The cells with theprobability of occupancy higher than 0.5 are highlighted ingreen. The polynomial regression is then applied on thesecells to generate the desired trajectory for the path-followingcontrol. The red, blue and yellow curves show the estimatedprofile of the target from first-order, second-order and third-order polynomial regressions.

The resulting profile from the first-order polynomial re-gression is shifted left in the VOM with a standoff distanceto obtain our desired path. Although the resulting curvesfrom polynomial regression at higher order have a betterpresentation on the occupied cells, it takes more time incomputing the regression coefficients and more complicated

Page 4: Towards Autonomous Underwater Iceberg Profiling using a …ncfrn.mcgill.ca/members/pubs/autoIce.pdf · Towards Autonomous Underwater Iceberg Profiling using a Mechanical Scanning

for the chosen guidance law, line-of-sight (LOS). Reader arerecommended to read [13] to [17] for the application of LOSon a curved desired path.

(0, 0)

XT YT

s v !!

!!t

Fig. 4: The sketch for computing the desired heading to follow the desiredpath in the VOM.

χV (eT ) = ψvs + arctan(−eT

∆) (7)

limt→∞

eT = 0

limt→∞

ψvs = 0

(8)

χV (eT ) = ψvs + arctan(−Kp · eT

+Ki ·∫ t

0−eT (t)dt+Kd

d(−eT (t))dt )

(9)

ψd = χV (eT ) + ψt (10)

As shown in Figure 4, the vehicle is located at (0,0) in theVOM. On a straight-line desired path, the cross-track error eTis calculated by converting the vehicle location to a coordinatesystem attached to the desired path, e.g. XT − YT . Here, thecomputation of eT can be simplified by finding the shortestdistance from the vehicle to the desired path if the desired pathis a straight-line. In the looking-ahead LOS control, a forward-looking distance, ∆, is defined by the user. The desiredheading refered in the VOM, χV (eT ), can be calculated inEquation 7 in order to satisfy the control objectives [16] inEquation 8. Furthermore, Equation 7 can be expanded intoEquation 9 that is similar to a PID controller [12]. As shownin Figure 4, eT is negative when the vehicle is on the right-hand-side of the desired path. The vehicle requires a positiveturning command in order to follow the desired path. Thus,a negative sign is added on eT in Equation 7 and Equation9. Since the desired heading commanded to the vehicle isbased on an inertial coordinate system, the desired headingis obtained by offsetting χV (eT ) with the vehicle heading ψt

in Equation 10.

IV. SIMULATION RESULT

The designed controller is initially evaluated in a simulatedenvironment with the diagram shown in Figure 5. The sonarand the iceberg are modeled in the MATLAB, while theSlocum glider is simulated on a hardware glider simulator.The glider simulator emulates the real-time glider missionwith modeled sensor output, i.e. altitude measurements anddepth measurements. The designed controller is implementedon a single-board-computer (SBC). The information exchangebetween the platforms is implemented via the serial commu-nication line.

Glider operation

Profile-following controller

Iceberg modelSonar model

Shoebox simulator SBC MATLAB

Location & orientation

ψd Rt , σ(t)

Location & orientation

Fig. 5: Simulation environment setup for evaluating the GNC

P eVehicle trackIceberg at time tIceberg at time 0Iceberg trackIceberg coordinate at time 0Iceberg coordinate at time t

Fig. 6: Results from the simulated iceberg profiling operation

In the simulation, the sonar is configured to scan at a rate of5 Hz within the ±45 degrees off the x-y plane of the vehiclewith a forward-looking angle of 35 degrees. The forward-looking distance, ∆, in the controller is calculated based onthe sonar configuration. As shown in Figure 2, the maximumforward-looking distance at desired standoff distance (Sd) can

Page 5: Towards Autonomous Underwater Iceberg Profiling using a …ncfrn.mcgill.ca/members/pubs/autoIce.pdf · Towards Autonomous Underwater Iceberg Profiling using a Mechanical Scanning

be calculated in Equation 11. In our scenario, the standoffdistance Sd is 40 meters, β is 35 degrees, and max(δ) is 17.5degrees for the sonar integrated on the Slocum glider. Thisconfiguration results in a forward-looking distance of about30 meters (see Equation 11). Several attempts were conductedto tune other parameters in the Equation 9. The Kd is tunedto 0.5 for a minimized overshot in tracking the desired pathKi is set to zero since it was found to have a destabilizingeffect that can result in a significant influence on the overshootcausing the potential collision onto the iceberg that draws moreconcerns in operation.

∆ = Sd · sin(β + max(δ)) (11)

An iceberg profiling operation is simulated with the profile-following controller on a modeled floating iceberg. The icebergmotion is assumed to consist of a northward velocity of 0.05m/s, and a rotational velocity of 0.025 degrees/s about thevertical axis located at the centroid of the water-plane. Therolling, pitching, and heave motion are limited to zero.

Figure 6 shows the top view and perspective view of theresults from the simulation. The glider traveled around theiceberg two times in one hour and produced a trajectory shownin red. The glider was traveling horizontally at a nominal depthof 20 meters at a speed about 0.6 m/s. As a result the icebergprofile at depth from zero to 60 meters (about 50% of theoverall volume of the target iceberg) is obtained. In Figure 6,the sonar detected iceberg surface is displayed in the blue dots.The initial and final iceberg pose are shown in green and cyanrendering with a blue line showing the path of the coordinatesystem attached to the iceberg during the mission.

0 500 1000 1500 2000 2500 3000 350020

40

60

80

Mission time [second]

Sta

nd

off

dis

tan

ce

[m

] rms = 49.6 m mean = 48.4 m

std= 10.8m

0 500 1000 1500 2000 2500 3000 35000

100

200

300

400

Mission time [second]

ψ [

de

gre

es]

Fig. 7: The standoff distance from the vehicle to the cross-sectional profileof the iceberg at depth of 20 meters. The vehicle’s heading is also include inthe bottom plot.

To evaluate the performance of the profile-following control,the distance from the vehicle to the cross-sectional profile ofthe iceberg at the depth of 20 meters is calculated and shownin Figure 7. The resulting standoff distance has a root-mean-square (RMS) of 49.6 meters, a mean value of 48.4 metersand a standard deviation of 10.8 meters. The RMS and themean value are offset from the desired standoff distance of40 meters may be caused by the lack of the integral gain,

Ki, resulting in a steady-state error. Moreover, the generateddesired path in the VOM shown Figure 3 is tilted towardsthe vehicle caused by the arc shape from the inverse-sonarmodel. As shown in Figure 3, the profile of the occupied cellsis relative straight, but an arc shape is formed at xvt equalsto 20 and higher. Therefore, the slope of the resulting pathwill become smaller when applying the polynomial regressionon the occupied cells, and the computed desired heading willbe smaller than the actual terrain profile because the cross-track error is reduced due the decreased slope. The bottomplot in Figure 7 shows the vehicle heading. Observed in Figure7, the overshoots in the cross-track error appeared 6 timeswhen the vehicle is turning at iceberg corners leading a steepincrease in vehicle heading. The overshoots may be caused bythe limited control on the heading, a deflecting fin, resultinga slow response to the desired control value.

V. PRELIMINARY FIELD RESULT

The modified Slocum glider was deployed near an underwa-ter ramp feature in Conception Bay, Newfoundland, Canada.The glider was programmed to follow waypoints located about40 meters on the east side of the underwater feature. Thevehicle was operated in the gliding mode between the depthof 40 meters to 25 meters, and the sonar was configured toscan a sector on the starboard side of the vehicle within the±45 degrees off its horizontal plane.

−53.128−53.127

−53.126−53.125 47.44

47.441

47.442

−10

0

10

20

30

40

50

60

70

80

North [m]

East [m]

De

pth

[m

]

20

25

30

35

40

45

50

55

60

65

70

Fig. 8: The sonar measured ramp feature along the vehicle’s trajectory

The mission objective was to map along the side of anunderwater slope and use the data for simulation purposes.As a result, the seafloor feature was captured by the sonar andpresented in Figure 8 with the three-dimensional trajectoryof the vehicle shown with the blue line. Figure 9 shows themeasured depth of the vehicle during the mission. The colorof the markers indicates the water density estimated from theconductivity, temperature, and pressure measured from theCTD sensor on the vehicle. Because the feature is locatedat an entrance of a cove (the Chapel Cove, Conception Bay,Newfoundland, Canada), a freshwater outflow from shore mayform a freshwater current near the ramp as shown in Figure10. In Figure 9, a freshwater stream is found at depth about

Page 6: Towards Autonomous Underwater Iceberg Profiling using a …ncfrn.mcgill.ca/members/pubs/autoIce.pdf · Towards Autonomous Underwater Iceberg Profiling using a Mechanical Scanning

32.5 meters that is preventing the vehicle from climbing to thetarget depth when the buoyancy pump was moving within the80% of the maximum range. A surface event was programmedin the mission that will be triggered when the vehicle has notcommunicated with the operator for 30 minutes. In the surfaceevent the ballast pump is moved to the maximum position,so the vehicle is able to climb to the surface after it wassubmerged for 1800 seconds.

0 500 1000 1500 2000

0

10

20

30

40

50

Mission time [second]

Dep

th [m

]

1022

1023

1024

1025

1026

1027

Ballast = 100%

Ballast = 80%

Fig. 9: The measured water density at different depth

Water surface

Seafloor

glider

Fig. 10: Fresh water current near the ramp, the effective sector of the glideris modified to [−10o, 0o].

−200 −150 −100 −50 0−60

−40

−20

0

20

40

60

80

East [m]

Nor

th [m

]

Floating

Floating

Seafloor detectionDiving and surfacing locationVehicle trajectoryDesired heading from controller

Fig. 11: The desired heading computed from the presented profile-followingcontroller with the sonar measurements shown in blue dots.

The profile-following controller is applied to the field datato compute the desired heading along the vehicle’s path. The

effective sector is defined as [−10o, 0o] (see the blue regionin Figure 10), hence, the seafloor can be detected within theeffective sector even when the vehicle is slightly above theshallow side of the ramp. Figure 11 shows the resulting desiredheading computed from the profile-following controller on thevehicle’s trajectory and the seafloor detection by the sonarwhen the scanning angle is inside the effective sector.

600 800 1000 1200 1400 1600 1800 2000−80

−60

−40

−20

0

20

40

60

Mission time [second]

[m]

[deg

rees

]

Pvy

χV(eT)

eTψv

s

600 800 1000 1200 1400 1600 1800 2000180

200

220

240

260

280

300

Mission time [second]

ψt [d

egre

es]

Fig. 12: Top: vehicle heading during the mission; bottom: the terms generatedby the profile-following controller.

The important values calculated in the profile-followingcontroller are shown in Figure 12. The blue line shows thesonar measured ranges within the effective sector correctedinto the vehicle-attached coordinate system. These measure-ments are used to update the vehicle-attached occupancy map(VOM) for estimating the desired path (YT = b1XT + b0),cross-track error (eT ) and computing the desired heading(ψd). Shown in Figure 12, the eT is changing correspondingto the PV

y that a large PVy is resulting a large cross-track

error leading a positive χV (eT ) turning the vehicle towardsthe ramp feature. At the time around 1600 seconds, the eTis near zero with PV

y is about 40 meters but χV (eT ) is apositive value turning the vehicle towards the starboard. Thenon-zero χV (eT ) is induced by the ψV

s that the trend ofthe vehicle’s heading is not aligned with the desired path.To fulfill the objectives of the LOS introduced in Equation8, the resulting positive χV (eT ) leads to a vehicle headingadjustment. Although the computed desired heading is notused in the actual trial, the correlation of the variation betweenthe χV (eT ) and the heading of the vehicle indicates thefeasibility of the designed profile-following controller thatχV (eT ) is leading the change of the vehicle’s heading.

Page 7: Towards Autonomous Underwater Iceberg Profiling using a …ncfrn.mcgill.ca/members/pubs/autoIce.pdf · Towards Autonomous Underwater Iceberg Profiling using a Mechanical Scanning

VI. CONCLUSION AND FUTUREWORKS

In this paper, we have introduced a Slocum underwaterglider modified in the Autonomous Ocean Systems Laboratory(AOSL). With the integration of a mechanical scanning sonar,the vehicle is intended to be deployed for mapping the under-side of icebergs. A sonar-based profile-following controller ispresented to autonomously guide the vehicle to circumnavigatearound the iceberg at a standoff distance. A vehicle-attachedoccupancy map (VOM) is used to represent the environmentaround the vehicle using a probabilistic sonar model. Thedesired path is generated from the VOM by applying polyno-mial regression on the occupied cells. A line-of-sight guidancelaw is used to compute the desired heading derived fromthe desired path to update the pre-existing low-level headingcontroller on the glider. The profile-following controller is firstevaluated in a simulation environment on a floating iceberg.As a result from the assessment, the vehicle circumnavigatedaround the iceberg twice without any collision. An offsetbetween the performed standoff distance and the desired valueis observed, and overshoots in standoff distance are observedfrom the simulation. The performance of the profile-followingcontrol is acceptable for future implementations that a furthertuning of the control parameters or a modified controllerstructure may eliminate such effects. The controller is furtherevaluated with a set of field data. In the field trial, the Slocumglider was programmed to map an underwater ramp feature inConception Bay, Newfoundland, Canada. The results from theevaluation indicate the potential of the controller in guiding thevehicle to follow the profile of icebergs. The control algorithmwill be evaluated and implemented in the field to map theunderside of icebergs during field trials.

ACKNOWLEDGMENT

The authors thank the Ocean Industries Student ResearchAward (OISRA) from Research & Development Corporation(RDC) of Newfoundland and Labrador, the captain, andcrew of the Midnight Shadow who supported us during theiceberg expedition at Twillingate. This work was supportedby the Natural Sciences and Engineering Research Council(NSERC) through the NSERC Canadian Field Robotics Net-work (NCFRN), and by Memorial University of Newfound-land, by Canada through the Atlantic Canada OpportunitiesAgency, the Government of Newfoundland and Labrador, theResearch and Development Corporation of Newfoundland andLabrador, the Marine Institute and Suncor Energy-Terra NovaProject.

REFERENCES

[1] C-Core and B. Wright and Associates Ltd., An Assessment of CurrentIceberg Management Capabilities, PERD/CHC Report 20-33, November,1998.

[2] S. Smith and N. Donaldson, Dynamic Modelling of Iceberg Drift usingCurrent Profiles, Candian Technical Report of Hydrography and OceanSciences, No. 91, 1987.

[3] B. Sukhov, Underwater Profiling of Iceberg using Submersibles,OCEANS’ 78, Washington, DC, USA, September, 1978.

[4] J. 0. Klepsvik and B. A. Fossum, Studies of Icebergs, Ice Fronts and IceWalls using Side-scanning Sonar, Annals of Glaciology, Vol. 57, No. 71,March 2016.

[5] M. Zhou, R. Bachmayer, and B. deYoung, Working Towards Seafloor andUnderwater Iceberg Mapping with a Slocum Glider, AUV 2014, October,2014.

[6] P. Kimball and S. Rock, Sonar-Based Iceberg-relative Navigation forAutonomous Underwater Vehicles, Deep-Sea Research II, Vol. 58, Issues11-12, June, 2011.

[7] P. Kimball and S. Rock, Mapping of Translating, Rotating IcebergsWith an Autonomous Underwater Vehicle, IEEE Journal of OceanicEngineering, VOL. 40, NO.1, January, 2015.

[8] M. Mammond and S. Rock, Enabling AUV Mapping of Free-DriftingIcebergs Without External Navigation Aids, IEEE/MTS OCEANS 2014,St. John’s, Canada, September, 2014.

[9] A. Forrest, V. Schmidt, B. Laval, and A. Crawford, Digital TerrainMapping of Petermann Ice Island Fragments in the Canadian High Arctic,21st IAHR International Symposium on Ice, 2012.

[10] M. Zhou, R. Bachmayer, and B. deYoung, Adaptive Heading Controlleron an Underwater Glider for Underwater Iceberg Profiling, ArcticTechnology Conference, St. John’s, 2016.

[11] M. Zhou, R. Bachmayer, and B. deYoung, Mapping for Control inan Underwater Environment using a Dynamic Inverse-sonar Model,OCEANS’ 16, Monterey, 2016.

[12] P. Norgren and R. Skjetne, Line-of-sight Iceberg Edge-following usingan AUV Equipped with Multibeam Sonar, 10th IFAC Conference onManoeuvring and Control of Marine Craft, August 2015.

[13] R. Skjetne, U. Jorgensen, and A. R. Teel, Line-of-sight Path-followingalong Regularly Parametrized Curves Solved as a Generic ManeuveringProblem, IEEE Conference on Decision and Control and EuropeanControl Conference, Orland, FL, USA, December, 2011.

[14] A. Lekkas, and T. Fossen, Line-of-sight Guidance for Path Followingof Marine Vehicles, Chapter 5, Advanced in Marine Robotics, LAPLAMBERT Academic Publishing, 2013.

[15] J. Ghommam, F. Mnif, A. Benali, and N. Derbel, Nonsingular Serret-Frenet Based Path Following Control for an Underactuated SurfaceVessel, Journal of Dynamic Systems, Measurement and Control, Vol. 131,March, 2009.

[16] S. Moe, Path Following of Underactuated Marine Vessels in the Presenceof Ocean Currents, Master of Science in Engineerging Cybernetics,Department of Engineering Cybernetics, Norwegian University of Scienceand Technology.

[17] T. I. Fossen, K. Y. Pettersen and R. Galeazzi, Line-of-Sight PathFollowing for Dubins Paths with Adaptive Sideslip Compensation of DriftForces, IEEE Transactions on Control Systems Technology, VOL. 23, NO.2, March 2015.

[18] S. Thrun, W. Burgard, D. Fox, Probabilistic Robotics, MIT Press, 2015.[19] A. Elfes, Sonar-Based Real-World Mapping and Navigation, IEEE

Journal of Robotics and Automation, Vol. RA-3, 1987.