# Research on roll stabilizing based on energy optimization for autonomous surface vehicle.

1. IntroductionASV (autonomous surface vehicle) rolls severely if it is navigating near water surface and wave disturbance has an obvious effect on its motion attitude. Violent roll motion often discontinues normal working of ASV [1, 2]. So, it is necessary to design an effective control pattern for solution to the problem of ASV motion attitude control. Moreover, it is hard for traditional fin stabilizer to generate enough lift when ASV is navigating with low speed. Consequently roll motion is very difficult to control at the moment. Then a new pattern of fin stabilizer working is required to realize effective roll control in low speed navigation. Marine Research Institute Netherlands, KoopNautic Holland, and Quantum Controls Ltd. have ever cooperated in the research on zero-speed fin stabilizer system [3]. Harbin Engineering University has designed and tested zero-speed fin stabilizers since 2005 [4]. Considering the characteristic of ASV motion with low speed near water surface, roll attitude is controlled by zero-speed fin stabilizer.

Roll attitude is often affected due to strong coupling among yaw, sway, and roll motion [5, 6]. In the design of traditional roll stabilizing system, only roll motion is considered and coupling effect of yaw and sway on roll is neglected [7, 8]. So, control system based on ASV model with single degree of freedom usually cannot attain expected roll stabilizing performance in practical application. It is very hard to establish dynamic model of ASV because of uncertainty in motion model parameters especially for roll damp. There is a great error between theoretical value and actual value. Summing up the above, traditional PID control cannot adapt to parameter variation of ASV model and roll stabilizing performance is also affected as a result.

On the basis of some authentic references [9-11], coupling effect of yaw and sway on roll is considered and made as premise of issue discussion in this paper. GPC (general predictive control) is adopted in system design due to its well robustness for model identification error and uncertain time-lag or order of controlled system [12]. Compared to traditional control, strict requirement is not raised for model structure. In the meantime, time variation, model mismatch, and disturbance uncertainty are also considered in GPC which is fit for roll motion control of ASV working near water surface. Zero-speed fin stabilizer would not generate enough lift force in low speed if it was in the working pattern of traditional fin stabilizer. So, zero-speed fin stabilizer works in another different pattern and usually generates lift force through revolving around its fin axis. Moment for driving fin stabilizer is large enough in order to satisfy roll stabilizing requirement. Consequently, energy consumption for roll attitude control is also very large. For small scale ASV, energy supplied to zero-speed fin stabilizer is often limited. So, it is necessary to reduce energy consumption for driving fin stabilizer, while roll stabilizing performance is satisfactory. Energy consumption and roll stabilizing performance are both considered in performance index of GPC in this paper. Finally, ASV roll attitude control and energy consumption saving are realized at the same time.

To sum up the above ideas, the assumption and associated limitation in this paper can be described as follows.

(a) ASV is navigating with low speed.

(b) Coupling effect of yaw and sway on roll is considered.

(c) Time variation of parameters in ASV motion model and disturbance uncertainty are considered in GPC.

2. Roll Stabilizing Principle of ASV with Low Speed

Schematic diagram of ASV roll stabilizing system is shown in Figure 1.

Roll attitude of ASV with low speed is controlled through actuation of system controller. Wings of fin stabilizer actively flap around fin axis with high frequency in sea water. Lift on the wing surface is generated under driving of servo system. Lift righting moment counteracts wave moment effectively, and then roll motion amplitude is reduced [13]. In Figure 1, [psi], D, and [phi] represent yaw angle, sway displacement, and roll angle, respectively. Similarly, [??], [??], and [??] are measured values of corresponding variables. ASV model discussed in this paper is chosen from [14]. Relevant parameters of fin stabilizer are shown as follows: span length is 0.25 m, chord length is 0.5 m, and navigating speed is 1.832 m/s. According to roll stabilizing theory, lift values of traditional fin stabilizer are very small and several Newtons in quantity if fin size and navigating speed are set as values above. Lift force is too small to satisfy the need of roll stabilizing if traditional fin stabilizer is used under this condition. But conventional zero-speed fin stabilizer, which has the same size, can generate enough lift force to counteract wave disturbance in the case of low speed navigation near water surface. Thus, lift model of conventional zero-speed fin stabilizer [15] is adopted in the following discussion.

Principle of zero-speed fin stabilizer is shown in Figure 2. Considering special working pattern of zero-speed fin stabilizer, force analysis during normal working of fin commits to category of unsteady flow problem [16]. When zero-speed fin stabilizer flaps in perfect fluid or nonperfect fluid, lift generated on the fin canbe analyzed by using potential theory and vortex action theory instead of fix wing theory. The forces on zero-speed fin stabilizer in unsteady flow are similar to tail fin of bionic fish [17]. The difference between them is that resistance produced by rotating is concerned for zero-speed fin stabilizer; however, thrust in the direction of going forward is concerned for bionic fish. The forces on tail fin of bionic fish are analyzed by many scholars. It is usually recognized that the forces can be divided into three types, namely, shape resistance, added mass force, and vortex force. The model of lift will be established by analyzing the forces in hydrodynamics. Through relevant deduction, lift model of zero-speed fin stabilizer [18] can be described as

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (1)

In (1), [e.sub.0] is span length, [rho] is sea water density, [C.sub.d] is coefficient of drag force, k is proportion factor, 2a is chord length, c is distance from fin axis to midpoint of chord length, to is angular rate of fin wings flapping, [J.sub.I] is additional moment of inertia, d is distance from fin axis to the point where force on additional mass acts, and [c.sub.1], [c.sub.2] are both constants.

Because the problem discussed in this paper is roll attitude control of ASV with low speed, it is necessary to consider additional effect of water flow on lift force while sea water flows through fin surface with relative flow speed. The additional lift is in relation to navigating speed, and it is time-variant; namely, additional lift can be denoted as [DELTA][L.sub.lift](V, t). Thus, lift model of fin stabilizer, when ASV is navigating with low speed, can be given by

[L.sub.lift] = [L.sub.zero] + [DELTA][L.sub.lift] (V, t). (2)

If navigating speed is 1.832 m/s, value of [DELTA][L.sub.lift](V, t) is much less than that of L zero. Ratio of additional lift to total lift is 3%-4%. So, (3) can be approximately accepted in simulations. Consider

[L.sub.lift] [approximately equal to] [L.sub.zero]. (3)

3. Calculation of Wave Moment

In research of ASV motion control, Pierson-Moskowitz spectrum with single parameter is often used [19] and its spectral density formula is given by

S([omega]) = [8.1 x [10.sup.-3][g.sup.2]/[[omega].sup.5]] exp [-3.11/[H.sup.2.sub.s][[omega].sup.4]]. (4)

Here, S([omega]) is spectral density ([m.sup.2] x s), to is wave frequency (rad/s), and [H.sub.s] is significant wave height (m). In the following simulation, spectral density S([omega]) is divided into 30 wavebands in frequency domain, and each waveband is [delta][omega] in width.

Then, wave moment relevant to each component wave is added up, and total transient wave moment can be obtained and expressed as

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (5)

Here, [f.sub.i] = [a.sup.2.sub.i][[omega].sup.2.sub.i] exp(-[[omega].sup.2.sub.i]h(t)/g), [a.sub.i] = [[2S([[omega].sub.i])[delta][omega]].sup.1/2], h(t) is navigating depth, [nabla] is volumetric displacement, u is navigating speed, [gamma] is heading angle, [c.sub.M] is a given coefficient of hydrodynamic force, [rho] is sea water density, l is total length of AUV, g is acceleration of gravity, [[omega].sub.e] is encountering frequency, and [[omega].sub.e] = -[omega] - ([[omega].sup.2]u/g) cos [gamma].

4. ASV Motion Model

Coupling horizontal motion model of ASV is considered in this paper. Detailed derivation of ASV motion model is specified in Appendix A.

5. Design of Self-Adaptive GPC Controller

5.1. Basic Structure of GPC. Basic structure of GPC is shown in Figure 3. GPC belongs to the group of "long-range predictive controllers" and generates a set of future control signals in each sampling interval, but only the first element of the control sequence is applied to the system input.

The prediction of the system output y is based on two different components. The "free response" represents the predicted behaviour of the output y(t + j | t) (in the range from t + 1 to t + N), based on old outputs y(t - i | t) and inputs u(t - i | t), assuming a future control action of zero. The "forced response" represents the additional component of the output y resulting from the optimisation criterion.

The total prediction is the sum of both components (for linear systems). Together with the known reference values, the future errors can be calculated by

e(t + jt) = w(t + jt) - y(t + jt), (6)

with j counting from 1 to N (system stability will be improved if N increases, but response rapidity will deteriorate in the same time and vice versa. N can be quantified through combining stability with rapidity). Caused by these "future errors," future control signals are calculated to force the output to the desired reference values.

In addition to its well-known good control performance, the robustness properties make GPC interesting and realizable for practical control applications. For this purpose GPC offers a compact control strategy in terms of model mismatches, variable dead time, and disturbances.

5.2. GPC Algorithm. If wave disturbance is not taken into account, roll motion model of ASV can be expressed as

A([z.sup.-1])[DELTA][phi](k) = B([z.sup.-1])[DELTA][M.sub.fin](k), (7)

where A([z.sup.-1]) = 1 + [a.sub.1][z.sup.-1] + [a.sub.2][z.sup.-2], B([z.sup.-1]) = [b.sub.0] + [b.sub.1][z.sup.-1], and [DELTA] = 1 - [z.sup.-1]. Performance index of GPC is defined as

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (8)

In (8), E represents operation of calculating mathematical expectation, [N.sub.1] [N.sub.2] are minimal time domain and maximal time domain of GPC prediction, respectively, 0 denotes roll angle, [[phi].sub.r](k + j) is expected value of roll angle at the time k + j, and A is weight coefficient of performance index. [DELTA][M.sub.fin](k + j) = 0, j = [N.sub.u], ..., [N.sub.2], where [N.sub.u] is control time domain, which means control input [M.sub.fin](k) keeps invariant after [N.sub.u] steps. [DELTA][[alpha].sub.j] is variation of fin angle. Consider

[[alpha].sub.k+j] = [[alpha].sub.k+j-1] + [[omega]'.sub.k+j] x T, (9)

where ak+j xk+j_1 are fin angles at the time k + j and k + j - 1, respectively, w'k+j is angular rate of fin wings flapping, and T is sampling period. Considering frequent flapping of zero-speed fin stabilizer wings, T is set as 1 ms. From (9), variation of fin angle can be calculated as

[DELTA][[alpha].sub.j] = [[alpha].sub.k+j] - [[alpha].sub.k+j-1] = [[omega]'.sub.k+j] x T. (10)

In order to obtain optimal predictive value of [phi](k + j), the following Diophantine equations are considered firstly:

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII], (11)

where j = 1, ..., [N.sub.2], [E.sub.j] = [e.sub.0] + [e.sub.1][z.sup.-1] + ... + [e.sub.j-1][z.sup.-j+1], [F.sub.j] = [f.sup.j.sub.0] + [f.sup.j.sub.1][z.sup.-1] + [f.sup.j.sub.2][z.sup.-2], [G.sub.j] = [g.sub.0] + [g.sub.1][z.sup.-1] + ... + [g.sub.j-1][z.sup.-j+1], and [H.sub.j] = [h.sup.j.sub.0]. Through deduction from (7) and (11), optimal predictive value of [phi](k + j) is obtained and given by

[phi](k + j) = [G.sub.j][DELTA][M.sub.fin] (k + j) + [F.sub.j][phi](k) + [H.sub.j][DELTA][M.sub.fin] (k), (12)

where j = 1, ..., [N.sub.2]. Equivalent matrix form of (12) is described as

[phi] = G[DELTA][M.sub.fin] + F[phi](k) + H[DELTA][M.sub.fin](k), (13)

where

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (14)

If [MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII], (8) can be expressed as the following matrix form:

J = E{[([phi] - [[phi].sub.r]).sup.T] ([phi] - [[phi].sub.r]) + [lambda] x [DELTA][alpha] x abs ([M.sub.fin])}, (15)

where abs(x) denotes the matrix composed of absolute values of original matrix elements and [lambda] is selected according to the range of roll angle and corresponding energy consumption used for roll stabilizing. For simplification of the following discussion, [N.sub.u] = 1, then

abs ([M.sub.fin]) = sign [[M.sub.fin] (k + 1)] x [M.sub.fin] (k + 1) x [[1, 1, ..., 1].sup.T]. (16)

In (16), sign(x) denotes signum function. Equations (13) and (16) are substituted into 15), and (17) is obtained. Consider

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (17)

In (17),

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII], (18)

If

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (19)

and [p.sup.T] = [1, 0, ..., 0], (17) is multiplied by [p.sup.T]. Through further simplification, (20) is obtained. Consider

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (20)

Since [M.sub.fin](k + 1) = 2 x [L.sub.lift] x [l.sub.f] = 2 x [l.sub.f] x ([c.sub.1][[omega]'.sub.k+1.sup.2] + [c.sub.2][[omega]'.sub.k+1] cos [[alpha].sub.k+1], [[omega]'.sub.k+2] = [[omega]'.sub.k+1] + [[omega]'.sub.k+1] x T, partial derivative of [omega]' with respect to [M.sub.fin] is given by

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (21)

where If is lever of righting moment. So, in (20),

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (22)

Considering [[phi].sub.r] = [[[[phi].sub.r](k + 1), ..., [[phi].sub.r](k + [N.sup.2])].sup.T] = [[0, ..., 0].sup.T], (22) are substituted into (20); then

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (23)

Equation (23) is abbreviated as (24), where [A.sub.1], [A.sub.2], [A.sub.3], [A.sub.4], [B.sub.1] ([z.sup.-1]), [B.sub.2] ([z.sup.-1]), C are coefficients of corresponding terms in (23). Consider

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (24)

So, GPC algorithm can be described as

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (25)

5.3. Recursive Solution to Diophantine Equations. GPC algorithm obtained in Section 5.2 is followed by some relevant conclusions; namely, in Diophantine equations (9)-(10), [E.sub.j]([z.sup.-1]), [F.sub.j]([z.sup.-1]), [G.sub.j]([z.sup.-1]), and [H.sub.j]([z.sup.-1]) vary with predictive step number j and need recalculation. In order to save calculation time and use the information in step backward, [E.sub.j]([z.sup.-1]), [F.sub.j]([z.sup.-1]), [G.sub.j]([z.sup.-1]), and [H.sub.j]([z.sup.-1]) are calculated with recursive method. Through derivation, recursive formulas of coefficients in Diophantine equations are obtained and listed in Appendix B.

5.4. Parameter Estimation of ASV Roll Motion Model. Parameter estimation is necessary due to time-variant parameters in ASV roll motion model. Recursive least square method is used here and algorithm for estimating parameter vector is given in Appendix C.

5.5. Steps of Self-Adaptive GPC Algorithm

(1) Assign values to [N.sub.1], [N.sub.2], [lambda], and [mu].

(2) Set initial vector [theta](0) and initial matrix [OMEGA](0). ([OMEGA](0) is a positive definite matrix.)

(3) Measure current roll angle [phi](k) and fetch corresponding set value [[phi].sub.r].

(4) Estimate parameter vector [theta](k) with recursive least square method and calculate coefficients of corresponding terms in A([z.sup.-1]) and B([z.sup.-1]), namely, [a.sub.1], [a.sub.2], [b.sub.0], and [b.sub.1].

(5) Calculate [E.sub.j]([z.sup.-1]), [F.sub.j]([z.sup.-1]), [G.sub.j]([z.sup.-1]), and [H.sub.j]([z.sup.-1]) according to (B.1).

(6) Substitute [E.sub.j]([z.sup.-1]), [F.sub.j]([z.sup.-1]), [G.sub.j]([z.sup.-1]), and [H.sub.j]([z.sup.-1]) into (25) and then calculate optimal control variable [M.sub.fin](k + 1).

(7) Exert [M.sub.fin](k + 1) on current roll motion model of ASV.

(8) Return to step (3).

6. Results

Total length of ASV is 5.3 m, ASV height is 0.5 m, ASV width is 1 m, and navigating speed is 1.832 m/s. Distance from fin axis to midpoint of chord length is 0.125 m, and maximum of fin angle is 60[degrees]. Parameters of self-adaptive GPC algorithm are set as [N.sub.1] = 1, [N.sub.2] = 5, [N.sub.u] = 1, [lambda] = 3 x [10.sup.-7], and [mu] = 0.5. Initial values for parameter estimation are [theta](0) = [-2.5947, 2.2035, -0.6088, 1.1152 x [10.sup.-4], -2.1877 x [10.sup.-4], 1.0725 x [10.sup.-4]] and [OMEGA](0) = I6x6 (identity matrix with 6 dimensions). Set values of roll angle are all 0; namely, [[phi].sub.r](k + j) = 0(j = 1, 2, 3, 4, 5). Significant wave height and heading angle are denoted by Hs and y, respectively Simulation results under different sea conditions are shown in Figures 4, 5, 6, 7, 8, 9, 10, 11, and 12.

Roll stabilizing performance in Table 1 and energy-saving ratio in Table 2 are calculated according to the following formulas, respectively:

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (26)

Meanings for RSP, SDRA, ESR, and EC are shown as follows:

RSP: roll stabilizing performance, SDRA: standard deviation of roll angle, ESR: energy-saving ratio, EC: energy consumption.

According to [20, 21], expression of J is given by (8). In order to demonstrate the improved performance of roll stabilizing system based on energy optimization design, [J.sub.0] is defined as the performance of GPC only considering roll stabilizing effectiveness; namely,

[J.sub.0] = E {[5.summation over (j=1)] [([phi](k + j) - [[phi].sub.r](k + j)).sup.2]}, (27)

where [phi] denotes roll angle, [[phi].sub.r](k + j) is expected value of roll angle at the time k + j, and E represents operation of calculating mathematical expectation.

Energy consumption is calculated according to the following formula:

EC = [600.summation over (k=1)] [absolute value of [M.sub.fin](k)] [DELTA][[alpha].sub.k]) (28)

where [M.sub.fin] is righting moment generated by zero-speed fin stabilizer and [DELTA][alpha]k is variation of fin angle.

In order to demonstrate the effectiveness of saving energy used for roll stabilizing, energy consumption based on J is compared with energy consumption based on [J.sub.0] as shown in Figure 13. Simulation results shown in Figures 4-12 demonstrate that self-adaptive GPC embodies favorable robustness and satisfactory performance of roll stabilizing. There is no instability phenomenon in ASV roll motion. Conventional zero-speed fin stabilizer is used for roll stabilizing of ASV navigating with low speed near water surface. Roll stabilizing performance is favorable as shown in Table 1. Calculation results of energy consumption in Table 2 demonstrate that energy consumption based on performance index J is less than energy consumption based on performance index [J.sub.0]. In Figure 13, curves of energy consumption versus heading angle are displayed and corresponding maximums in energy consumption both occur in 90[degrees]. The heading angle increases with a step of 20[degrees] in Figure 13. The two curves based on [J.sub.0] and J obey normal distribution approximately, since motion attitude of ASV is obviously dominated by roll when heading angle varies in 75[degrees]-105[degrees] and is mainly affected by pitch and heave in 0[degrees]-15[degrees] or 165[degrees]-180[degrees]. For the same reason, frequency of fin angle differs in Figures 6, 9, and 12; namely, fin flaps more frequently when [gamma] = 90[degrees] than [gamma] = 45[degrees] and 135[degrees]. Since control of [M.sub.fin] is implemented through adjustment of [omega]' and [omega]' with regard to zero-speed fin stabilizer, which is different from fin angle control of traditional fin stabilizer, short-term saturation occurs in the maximal fin angle as shown in Figures 6, 9, and 12 when [omega]' is equal to zero. Figure 13 adequately shows the effectiveness of saving energy used for roll stabilizing. Satisfactory performance of roll stabilizing is also shown in Figures 14-15 and Figures 17-18, which correspond to different significant wave heights (Hs =1.2 m and 1.5 m) when [gamma] = 90[degrees]. Figures 16 and 19 show that the method proposed in this paper is effective on saving energy used for roll stabilizing when sea condition varies.

Through similar derivation, self-adaptive GPC is applied in traditional design of roll stabilizing system, where effects of sway and yaw on roll are disregarded. At this time, roll motion model is given by (D.4) in Appendix D and performance index of GPC is still given by (8). Detailed derivation of control law is not given here. Figures 20 and 21 show the roll stabilizing performances of traditional design. Compared to Figures 15 and 18, roll stabilizing performances in Figures 20 and 21 are not quite satisfied. This result proves that the method in this paper is obviously superior to traditional design method, since roll motion model is more accurate if coupling effects are considered adequately.

In order to prove robustness of self-adaptive GPC controller designed in this paper, simulation experiment is conducted when significant wave height [H.sub.s] is 1 m and wave encounter angle [gamma] = 90 deg. Uncertain parameters in ASV motion model (A.8) are described as [DELTA][bar.[a.sub.1]] = 0.08[1 + sin(0.2t)][bar.[[alpha].sub.1]], [DELTA][bar.[a.sub.2]] = 0.08[1 + sin(0.2f)][bar.[a.sub.1]], [DELTA][[bar.a].sub.1] = 0.1[1 + sin(0.2t)][bar.[b.sub.1]], and [DELTA][bar.[b.sub.2]] = 0.1[1 + sin(0.2t)][bar.[b.sub.2]], where [bar.[a.sub.1]], [bar.[a.sub.2]], [bar.[b.sub.1]], and [bar.[b.sub.2]] are corresponding normalized values of hydrodynamic force coefficients, and [DELTA][bar.[a.sub.1]], [DELTA][bar.[a.sub.2]], [DELTA][bar.[b.sub.1]], and A62 represent their corresponding uncertain sections. Figure 22 shows the curve of roll angle without roll control under above uncertainty conditions, and Figure 23 shows corresponding curve with self-adaptive GPC. Working process of fin stabilizer is also described in Figure 24. Simulation results prove that self-adaptive GPC can be used to avoid parameter uncertainty in ASV motion model. Favorable stability and robustness demonstrate that the designed controller is effective when wave disturbance and ASV parameters are not determined.

Figures 25, 26, and 27 show the simulation results when ASV is navigating under rough sea conditions that significant wave height ([H.sub.s] ) is 3 m. As shown in Figure 25, the curve of roll angle violently varies between -25[degrees] and 25[degrees] when ASV roll motion is not controlled. If self-adaptive GPC is adopted for roll reduction, the range of roll angle is reduced to (-6[degrees], 6[degrees]). Roll stabilizing performance is satisfied, and the ability to cope with rough sea conditions proves the robustness of self-adaptive GPC. Simulation results demonstrate that self-adaptive GPC proposed in this paper is an effective method for the controller design of ASV roll motion, especially under rough sea conditions.

7. Conclusions

In the end, conclusions are drawn from analysis of simulation results; namely, ASV roll stabilizing performance is favorable under self-adaptive GPC, energy consumption can be reduced, and utilization rate of energy resource is raised by means of optimization if energy consumption is considered in performance index of GPC.

http://dx.doi.org/10.1155/2014/347589

Appendices

A. Decoupling and Discretization of ASV Motion Model

Coupling horizontal motion model discussed in this paper is obtained by neglecting relevant parameters of ASV vertical motion (heave and pitch) and introducing the term of wave moment into roll equation. ASV coupling horizontal motion model is expressed as

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (A.1)

where [MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. v, p, and r are sway velocity, roll angular rate, and yaw angular rate, respectively. V is navigating speed, [M.sub.wave] is wave moment, and [M.sub.fin] is righting moment generated by zero-speed fin stabilizer. Meanings for other symbols in (A.1) can be found in [18]. Equation (A.1) is simplified into the following matrix equation:

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (A.2)

Equation (A.2) can be further simplified into (A.3) through linearization and Laplace transformation. Consider

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (A.3)

where [e.sub.11] = [s.sup.2] - [c.sub.11]V x s, [e.sub.12] = -[c.sub.12]V x s - [d.sub.12] x ([partial derivative]g/[partial derivative][phi]), [e.sub.13] = -[c.sub.13]V x s, [e.sub.21] = -[c.sub.21]V x s, [e.sub.22] = [s.sup.2] - [c.sub.22]V x s - [d.sub.22] ([partial derivative]f/[partial derivative][phi]), [e.sub.23] = -[c.sub.23]V x s, [e.sub.31] = -[c.sub.31]V x s, [e.sub.32] = -[c.sub.32]V x s - [d.sub.32] x ([partial derivative]f/[partial derivative][phi]), and [e.sub.33] = [s.sup.2] - [c.sub.33]V x s. From (A.3), equivalent decoupling model of ASV roll motion can be described as

[phi](S) = [f.sub.22]([M.sub.fin] + [M.sub.wave]). (A.4)

Corresponding ASV hydrodynamic parameters in [18] are substituted into (A.1) and expression for [f.sub.22] is obtained through derivation of (A.2) and (A.3). Consider

[f.sub.22] = [0.0002416[s.sup.2] + 0.0002044s + 0.00002912/[s.sup.4] + 2.7629[s.sup.3] + 2.518[s.sup.2] + 0.8899s + 0.095]. (A.5)

Through data fitting of impulse response for transfer function in (A.5), higher-order roll motion model can be reduced into an equivalent second-order roll motion model given by

[f.sub.22] = [0.00018319 (s + 0.0383)/[s.sup.2] + 0.6426s + 0.0232]. (A.6)

Considering the initial conditions, namely, [[phi].sup.(1)](0) = [phi](0) = 0 and [M.sub.fin](0) = [M.sub.wave](0) = 0, (A.6) is substituted into (A.4) and then roll motion model can be expressed as a second-order differential equation through inverse Laplace transformation. Consider

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (A.7)

Through discretization, (A.7) is transformed into a difference equation, which is predictive model of GPC and obtained by applying Euler approximation method. Equivalent difference equation for roll motion is given by

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (A.8)

Here, sampling period for discretization is 1s. In the above deduction, coupling effect of yaw and sway on roll is considered adequately. So, (A.8) is an equivalent equation for roll motion.

B. Coefficient Calculation of Diophantine Equations

If [bar.A]([z.sup.-1]) = A([z.sup.-1])[DELTA] = 1 + [[bar.a].sub.1][z.sup.-1] + [[bar.a].sub.2][z.sup.-2] + [[bar.a].sub.3][z.sup.-3], the following formulas for recursive calculations are obtained:

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII] (B.1)

According to Diophantine equations (9)-(10), initial values for recursive calculations are

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (B.2)

C. Parameter Estimation of Roll Motion Model

Consider the case of time-variant parameters in ASV roll motion model; namely,

[bar.A]([z.sup.-1], k)[phi](k) = B ([z.sup.-1], k) [M.sub.fin](k) + B ([z.sup.-1], k) [M.sub.wave](k), (C.1)

where

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (C.2)

If model parameters and data parameters are expressed as the following vectors respectively, namely,

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII], (C.3)

(C.1) can be transformed into

[phi](k) = [[theta].sup.T](k) x X(k) + [bar.B]([z.sup.-1], k) [M.sub.wave](k). (C.4)

Parameter vector [theta](k) is estimated with recursive least square method and coefficients of corresponding terms in A([z.sup.-1]) and B([z.sup.-1]) are obtained. Then, recursive calculations are performed according to (B.1). [E.sub.j]([z.sup.-1]), [F.sub.j]([z.sup.-1]), [G.sub.j]([z.sup.-1]), and [H.sub.j]([z.sup.-1]) are substituted into (25); as a result, optimal control variable M[f.sub.in](k + 1) can be calculated.

Algorithm for estimating parameter vector with recursive least square method is given by

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII], (C.5)

where [mu] is forgetting factor, 0 < [mu] < 1, and [OMEGA](k) is a positive definite matrix.

D. Model in Traditional Design of Roll Stabilizing System

Considering coupling effects of sway and yaw on roll, which are often disregarded in traditional design of ASV roll stabilizing system, a simplified roll motion model is obtained on the basis of ASV coupling horizontal model and is given by

[a.sub.22][?] = V[b.sub.22]p + f + [M.sub.wave] + [M.sub.fin]; (D.1)

namely,

[a.sub.22][[phi].sup.(2)](t) - V[b.sub.22][[phi].sup.(1)](t) + [z.sub.G]W[phi](t) = [M.sub.wave](t) + [M.sub.fin](t). (D.2)

Relevant parameters are substituted into (D.2), and then (D.3) is obtained through further derivation. Consider

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (D.3)

Through discretization, (D.3) is transformed into a difference equation, which can be regarded as the predictive model of GPC, and is obtained by applying Euler approximation method. Equivalent difference equation for roll motion is given by

[MATHEMATICAL EXPRESSION NOT REPRODUCIBLE IN ASCII]. (D.4)

Here, sampling period for discretization is 1 s. In the above deduction, coupling effect of yaw and sway on roll is disregarded. So, (D.4) can be used as the roll motion model in traditional design of ASV roll stabilizing system.

Abbreviations ASV: Autonomous surface vehicle GPC: General predictive control RSP: Roll stabilizing performance SDRA: Standard deviation of roll angle ESR: Energy-saving ratio EC: Energy consumption. Symbols [psi]: Yaw angle D: Sway displacement [phi]: Roll angle [??]: Measured value of [psi] [??]: Measured value of D [??]: Measured value of [phi] [e.sub.0]: Span length [rho]: Sea water density [C.sub.d]: Coefficient of drag force k: Proportion factor 2a: Chord length c: Distance from fin axis to midpoint of chord length [omega]': Angular rate of fin [J.sub.I]: Additional moment of inertia d: Distance from fin axis to the midpoint where force on additional mass acts [c.sub.1]: Constant [c.sub.2]: Constant [L.sub.lift]: Lift force [L.sub.zero]: Lift force under zero-speed condition [DELTA][[L.sub.lift]: Additional lift force V: Navigating speed w: Future reference value J: Performance index for optimization G(z): General control process u: Input of G(z) y: Output of G(z) [??](z): Model of G(z) e: Future error of GPC E: Mathematical expectation [N.sub.1]: Minimal time domain of GPC prediction [N.sub.2]: Maximal time domain of GPC prediction [[phi].sub.r]: Expected value of 0 [lambda]: Weight coefficient of performance index [N.sub.u]: Control time domain [M.sub.fin]: Righting moment generated by fin stabilizer [angle]: Fin angle T: Sampling period A([z.sup.-1]): Coefficient polynomial of roll motion model B([z.sup.-1]): Coefficient polynomial of roll motion model [E.sub.j]: Coefficient polynomial of Diophantine equation [F.sub.j]: Coefficient polynomial of Diophantine equation [G.sub.j]: Coefficient polynomial of Diophantine equation [H.sub.j]: Coefficient polynomial of Diophantine equation abs(x): Matrix composed of absolute values of original matrix elements sign(x): Signum function [l.sub.f]: Lever of lift force [J.sub.0]: Performance index of GPC considering RSP instead of EC [H.sub.s]: Significant wave height [gamma]: Heading angle [mu]: Forgetting factor [OMEGA]: Positive definite matrix [theta]: Vector of model parameters X: Vector of data parameters v: Sway velocity p: Roll angular rate r: Yaw angular rate [M.sub.wave] Wave moment m: AUV mass l: Total length of AUV [x.sub.G], [y.sub.G], Coordinates of gravity center position [z.sub.G]: in vehicle coordinate system [I.sub.x], [I.sub.y], Moments of inertia around the x-axis, [I.sub.z]: y-axis, and z-axis [I.sub.xy], [I.sub.yz], Products of inertia for XOY plane, YOZ [I.sub.zx]: plane, and XOZ plane [Y'.sub.(x)], Coefficients of hydrodynamic force [K'.sub.(x)], [N'.sub.(x)]: W: AUV self-weight [epsilon](n): Parameter related to propeller rotational rate.

Conflict of Interests

The authors declare that there is no conflict of interests regarding the publication of this paper.

Acknowledgments

The project is financially supported by the National Natural Science Foundation (NNSF) of China under Grant E091002/50979017, Ph.D. Programs Foundation of Ministry of Education of China and Basic Technology under Grant 20092304110008, Research Operation Item Foundation of Central University under Grant HEUCFZ 1026, and Harbin Science and Technology Innovation Talents of Special Fund Project (Outstanding Subject Leaders) under Grant 2012RFXXG083.

References

[1] M.-C. Fang, P.-E. Chang, and J.-H. Luo, "Wave effects on ascending and descending motions of the autonomous underwater vehicle," Ocean Engineering, vol. 33, no. 14-15, pp. 1972-1999, 2006.

[2] G. N. Roberts, "Trends in marine control systems," Annual Reviews in Control, vol. 32, no. 2, pp. 263-269, 2008.

[3] R. P. Dallinga, "Roll stabilization of motor yacht: hydrodynamic aspects of the comparison of anti-roll tanks and fins," 2002, http://www.marin.nl/web/News/News-items/Rollstabilization-of-motor-yacht-Hydrodynamic-aspects-of-the- comparison-of-antiroll-tanks-and-fins.htm.

[4] W. Fan, J. Hongzhang, and Q. Zhigang, "Modeling for active fin stabilizers at zero speed," Ocean Engineering, vol. 36, no. 17-18, pp. 1425-1437, 2009.

[5] H.-Z. Jin, L.-X. Pan, and A.-L. Zou, "Rolling model of surface vehicle and its stabilizing control," Journal of Dalian Maritime University, vol. 36, no. 1, pp. 1-4, 2010 (Chinese).

[6] M. J. Logsdon, Coupled roll and directional stability characteristics of surface ships [Ph.D. dissertation], Naval Postgraduate School, 1992.

[7] F. Carravetta, G. Felici, and P. Palumbo, "Regulation of a manned sea-surface vehicle via stochastic optimal control," in Proceedings of the 17th World Congress, International Federation of Automatic Control (IFAC '08), Seoul, South Korea, July2008.

[8] E. Sahler, Analysis of a single-degree-of-freedom roll motion model: simulation, sensitivity study, and comparison to multidegree-of-freedom models [Ph.D. dissertation], Oregon State University, 1996.

[9] H. Z. Jin, L. X. Pan, and L. L. Wang, "Adaptive variable structure control with neuron for low speed stabilizing of submarine near surface," Control and Decision, vol. 25, no. 4, pp. 562-571, 2010 (Chinese).

[10] H. Z. Jin, L. X. Pan, and L. L. Wang, "Modified variable structure control in rudder roll damping of submarine near free-surface," Journal of Harbin Institute of Technology, vol. 42, no. 9, pp. 1462-1466, 2010 (Chinese).

[11] X. Peng, X. Yang, and X. Zhao, "On-line adaptive neural networks for ship motion control," in Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS '07), pp. 3592-3597, San Diego, Calif, USA, OctoberNovember 2007.

[12] J. V. Salcedo and M. Martinez, "GPC robust design using linear and/or bilinear matrix inequalities," European Journal of Control, vol. 13, no. 5, pp. 451-472, 2007

[13] M.-C. Fang and J.-H. Luo, "On the track keeping and roll reduction of the ship in random waves using different sliding mode controllers," Ocean Engineering, vol. 34, no. 3-4, pp. 479-488, 2007.

[14] T. I. Fossen, Guidance and Control of Ocean Vehicles, John Wiley and Sons, NewYork, NY, USA, 1994.

[15] M. H. Sohn and J. W. Chang, "Flow visualization and aerodynamic load calculation of three types of clap-fling motions in a Weis-Fogh mechanism," Aerospace Science and Technology, vol. 11, no. 2-3, pp. 119-129, 2007.

[16] H.-Z. Jin, Y.-M. Luo, Z.-G. Qi, and Z.-C. Yang, "Investigation of the lifting force of a zero speed fin stabilizer with Weis-Fogh mechanism," Journal of Harbin Engineering University, vol. 28, no. 7, pp. 762-767, 2007 (Chinese).

[17] X. F. Zhang and H. Z. Jin, Fuzzy Control of Fin Stabilizer at Zero Speed Based on Improved Genetic Algorithm, ISKE, Chengdu, China, 2007.

[18] Y. M. Luo, Research on fin stabilizers at zero speed and its electro-servo system for ship [Ph.D. thesis], Harbin Engineering University, 2007 (Chinese).

[19] J. Ringwood, "The dynamics of wave energy," in Proceedings of the Irish Signals and Systems Conference, Dublin, Ireland, June 2006.

[20] L. X. Pan, H. Z. Jin, and L. L. Wang, "Direct self-adaptive general predictive control for roll stabilizing of autonomous surface vehicle," in Proceedings of the 3rd International Conference on Modelling and Simulation, Wuxi, China, June 2010.

[21] X. F. Zhang, Research on modeling and control of fin stabilizer at zero speed [Ph.D. dissertation], Harbin Engineering University, 2008.

Hongjian Wang, (1) Linlin Wang, (1,2) and Lixin Pan (3)

(1) College of Automation, Harbin Engineering University, Harbin 150001, China

(2) College of Information, Inner Mongolia University of Technology, Hohhot 010051, China

(3) Beijing Institute of Control Engineering, China Academy of Space Technology, Beijing 100190, China

Correspondence should be addressed to Linlin Wang; willmaomao@sina.com

Received 11 May 2014; Revised 9 August 2014; Accepted 11 August 2014; Published 1 September 2014

Academic Editor: Engang Tian

TABLE 1: Statistics of roll stabilizing performance. Significant Heading SDRA without wave height (m) angle ([degrees]) roll control ([degrees]) [H.sub.s] = 1 [gamma] = 45[degrees] 2.1861 [H.sub.s] = 1 [gamma] = 90[degrees] 2.8383 [H.sub.s] = 1 [gamma] = 135[degrees] 1.8226 Significant SDRA with GPC RSP (%) wave height (m) ([degrees]) [H.sub.s] = 1 0.4451 79.64 [H.sub.s] = 1 0.5565 80.39 [H.sub.s] = 1 0.3654 79.95 TABLE 2: Calculation of energy consumption for roll stabilizing. Significant Heading angle RSP based on RSP based wave height (m) ([degrees]) [J.sub.0] (%) on J (%) [H.sub.s] = 1 [gamma] = 45[degrees] 79.91 79.64 [H.sub.s] = 1 [gamma] = 90[degrees] 83.76 80.39 [H.sub.s] = 1 [gamma] = 135[degrees] 81.23 79.95 Significant EC based on EC based ESR (%) wave height (m) [J.sub.0] (J) on J (J) [H.sub.s] = 1 419726 358740 14.53 [H.sub.s] = 1 444810 377648 15.10 [H.sub.s] = 1 403842 343871 14.85

Printer friendly Cite/link Email Feedback | |

Title Annotation: | Research Article |
---|---|

Author: | Wang, Hongjian; Wang, Linlin; Pan, Lixin |

Publication: | Journal of Applied Mathematics |

Article Type: | Report |

Date: | Jan 1, 2014 |

Words: | 6587 |

Previous Article: | Ranking DMUs by calculating the interval efficiency with a common set of weights in DEA. |

Next Article: | Estimation of state of charge for lithium-ion battery based on finite difference extended Kalman filter. |

Topics: |