Design of a Heading Autopilot for Mariner Class Ship with Wave Filtering Based on Passive Observer 1 Mridul Pande, K K Mangrulkar 1, Aerospace Engg Dept DIAT (DU), Pune Email: 1 mridul_pande000@yahoo.com Abstract : In this paper, the heading control of a large Mariner class platform is improved in order to counteract the undesirable effect of waves on the actuator system. Wave filter used here is a linear passive observer and includes features like estimation of both the low frequency heading and heading rate from the measurement devices which give values post addition of disturbances due to sea waves. Matlab/Simulink tool is used to show the proposed solution in the control loop. The experimental results confirm the suitable filtering, the estimating properties of the observer and navigation response expected, reducing control action and thus the vibrations of the rudder. I. INTRODUCTION This paper is based on theory, methods and problems described by Professor Thor Ivar Fossen in Marine Control Systems, 00. A part of this paper is to identify the so called Nomoto approximation model for the Mariner Class Vessel, based on identification methods in Matlab. The obtained model has been used to design a heading autopilot for the tanker using a simple PD/PID control routine. To ensure robustness of the autopilot, a Leuenberger wave filter has been implemented. In section 3, the model has been tested through an open-loop analysis, a so called pullout manoeuvre. Identification and verification of the Nomoto approximation is carried out in section 4 using the turning circle test. Section 5 is devoted to the design of a PID controller for the autopilot. Further section 6 introduces the model for wave force and wave induced motion in addition to a description of the Leuenberger wave filter. The wave model that uses Linear Models and an observer is quite advantageous and has been tested by other researchers in various Marine applications. II. RIGID BODY SHIP DYNAMICS Ship response in waves is considered as 6 degree of freedom motion in space. For manoeuvring study 3 DOF motion namely surge,sway, yaw is considered. Fossen (1994) derives the 3 DOF non linear model for a marine vessel written in vectorial setting as: Where v [u v r] T is a generalised velocity vector with body fixed reference frame and τ RB [X Y N] T is a generalised vector of external forces and moments (includes added mass, damping and control input terms), while M RB is system inertia matrix and C RB is the rigid body coriolis and centripetal matrix.. The Hydro and Aerodynamic laboratory in Lyngby, Denmark has performed both planar motion mechanism tests and full scale manoeuvring predictions for a Mariner class vessel, the main data and dimensions of which are Length overall 171.8 m Length between perpendiculars L PP 160.93 m Maximum Beam 3.17 m Design Draft 8.3 m Design Displacement 18451 m 3 Design Speed 15 knots For this vessel the dynamic equations of motion in surge, sway and yaw are: m X u 0 0 0 m Y v m x G Y r 0 m x G N v I z N r u v r X Y N where the non linear forces and moments X, Y and N are defined as (Prime system I with L PP and U as normalisation variables. Here Y v indicates the hydrodynamic derivative of the sway force Y to the sway speed v evaluated at the reference condition; m is the mass of the ship; I z is the moment of inertia about the z-axis; v is the sway speed; u is the surge speed and r is the yaw rate; ψ is the heading angle defined by ψ r. The non-dimensional co-efficient in this model are m 798 10 5, I z 39. 10 5 x G -0.03 M RB v +C RB v v τ RB 30
Figure 1 Sway-yaw-roll motion coordinate system. Mariner Model is a full Non Linear Dynamics MIMO model of a generic ship. The dynamic aspects of the model have been referenced from Marine GNC Toolbox which is available on TTK 4190 Guidance and Control at NTNU and are not further discussed in this paper. III. OPEN LOOP ANALYSIS To investigate the ship s stability a pullout manoeuvre is done under ideal conditions, i.e no environmental disturbances. The test is performed by turning the rudder to a certain prescribed angle (corresponding to a time limited step input before turning it back to neutral after the ship has attained a steady turning rate). The simulation was performed with both positive and negative rudder angles of 10 degrees with step time of 1000 seconds. The yaw rate was plotted versus time in the figure below: Figure Yaw Rate plotted against time for pullout manoeuvres According to Fossen, a ship is said to be straight line stable if both curves from the pullout manoeuvre converge to the same value, which is the case for this particular model. Ideally the ship should sail with zero yaw rate after the rudder has been set to neutral, the static offset from zero is regarded as imperfection in the ship dynamics and would require a rudder offset to be corrected. However, we may conclude that the ship is straight line stable due to mutual convergence of the two independent tests. IV. IDENTIFICATION AND EVALUATION 4.1 The Nomoto Approximation As mentioned in section, the model is considered as a full non linear model presented as M RB v +C RB v v τ RB + w where w is the environmental disturbance. To make the identification and control of the model feasible we use the Nomoto second order approximation which describe the heading dynamics of the ship through a simple transfer function as follows:- r K(1+T 3 s) δ 1+T 1 s (1+T s) where, the zero (1+ T 3 s) and the pole (1 + T s) are due to the coupling effect from the sway mode on the yaw dynamics and where K is the static yaw rate gain, and T1, T and T3 are time constants, In practice, because the pole term (1 + T s) and the zero term (1 + T 3 S) nearly cancel each other, a further simplification of can be done to give the first order Nomoto model: ψ δ K s(1+ts ) This linear model is a transfer function from the commanded rudder angle δ to the ship s heading angle ψ, and has only two parameters to be identified, the Nomoto gain K and the time constant T. These both will be identified before designing a controller for the ship. Nomoto s approximations are valid under the assumptions of small angle perturbations, low ship velocity and movement in vertical plane. Thus the Nomoto model may be considered as a linear approximation for the full model ship. 4. Identification of First Order Nomoto Parameters The transfer function needed for observer design is the response yaw angle versus the rudder angle. To determine the Nomoto parameters and thus obtain an identified model of the ship a so called turning circle manoeuvre is performed by using an open loop scheme i.e some step variation in rudder position are introduced (in form of step inputs in simulation) and rate of yaw output is registered. The input signal δ and output yaw rate r are processed in System Identification Toolbox of Matlab obtaining the following parameters for Nomoto second order Nomoto approximation. r δ 0.0049807 (s+0.009087 ) s + 0.0533 s+0.000163 The non linear response is plotted along with reduced second order model to ascertain the level of approximation and the following results were achieved: 31
limited by resulting bandwidth of the rudder ω δ (rad/sec) and the ship dynamics 1/T (rad/sec) according to 1 T < ω n (1 ζ + (4ζ 4 4ζ + )) < ω δ Figure 3 Non Linear response together with Nomoto s second order approximation Expressing the transfer function in terms of Time constant and further reducing it to Nomoto s First order model where (TT1+T-T3) as per section 4.1 we come to the following approximation:- ψ 0.803 δ s(1+47.44s) Thus obtaining K 0.803 and T47.44. The non linear response is plotted along with reduced first order model For a critically damped ship (ζ 1), the closed loop bandwidth ω b is related to the natural frequency ω n of the closed loop system by a factor of 0.64ω n. The values of K P and K d are dependent on ω n and ζ (which are treated as design parameters), by following relations K P Tω n K, K d Tζω n 1 K 5. Bode Plot Analysis Recalling the Nomoto transfer function G(s) and the PD controller C(s), the corresponding open loop transfer function C(s) G(s) is given by ψ ψ ref KK P +KK d s Ts + KK d +1 s+kk P Below is the Bode plot of the OLTF for damping ratio (ζ 1) and (ω n 0.15), K 0.803 and T47.44 resulting in K P and K d 3.80 and 47.06 respectively. Figure 4 Non Linear response together with Nomoto s First order approximation 5.1 Choice of Controller V. CONTROL DESIGN We have chosen to apply a PID/PD controller for the autopilot. To ensure robustness and to reduce the wear and tear of the actuators, the controller is implemented with a wave filter which is described in section 6.1. Considering a control law of PD type, in the form δ K P (ψ d ψ)- K d ψ Here K P and K d are the controller design parameters. The closed loop dynamics resulting from the ship dynamics and the PD controller are Tψ +(1+KK d ) ψ +KK P ψ KK P ψ d This expression corresponds to a nd order system of the form ψ +ζω n ψ +ω n ψ ω n ψ d with natural frequency ω n (rad/s) and relative damping ratio ζ. The relative damping is typically chosen in the interval 0.8 < ζ < 1.0, whereas the choice of ω n will be Figure 5 Bode Plot for the OLTF with PM 78.6 deg (at 0.89 rad/s) To test the stability of the non linear plant with the proposed PD controller with above gains, we give a transport delay of (4.5 second) corresponding to the phase margin of 78.6 degrees achieved on the reduced model. Now we increase the transport delay till we 3
achieve sustained oscillations indicating marginal stability and thus corresponding phase margin for the controller with non linear plant. The sustained oscillations for the plant are achieved on introducing a transport lag of 9seconds, which corresponds to 81 degrees phase margin. Thus, the proposed controller gains are viewed to be suitable for autopilot control of the non linear model. parameter related to wave intensity that is adjusted on the level of affectation of waves or the wave intensity. In addition, the wave frequency response of the ship is generated by using the principle of linear superposition. The total motion can be separated in LF and HF components as shown in fig 7 below thus obtaining the expression:- Figure 7 Total motion of the vessel as sum of LF and HF components ψ ψ L + ψ H Taking this into consideration we can write the LF yaw dynamics and HF motion as ψ L r L Figure 6 Sustained oscillations achieved on inducing 9 seconds transport delay VI. MODEL FOR WAVE FORCE AND WAVE INDUCED MOTION The main environmental disturbances affecting marine vehicles during navigation are waves generated by winds and ocean currents. Taking into account the effect of waves, the initial equation may be modified as: τ RB τ + τ Waves and Here τ Waves represents the moment and forces caused by waves. Wave forces are modelled as sum of linear and Non- linear components as: τ Waves τ Wlin + τ Wnlin The second term on the right hand side of the expression corresponds to low frequency component and is commonly treated as input disturbance and is modelled by a Bias term, hence it is not discussed here. On the other hand the Linear high frequency component is usually modelled by wave elevation transfer function approximation of the wave spectrum selected. In this paper a nd order wave transfer function approximation is considered of the following form: K w s ψ H { }w(s) s +ζω n s+ω n Where K w ζω n σ Here ω n is the dominating frequency, ζ is the relative damping ratio, ψ H is the yaw angle induced by the waves, w is a zero mean Gaussian white noise and σ is a r L 1 T r L + K T δ ξ H ψ H ψ H - ζω n ψ H - ω n ξ H +K w w Where ψ L and r L are LF states, ψ H is the HF yaw and ξ H is HF state form introduced to represent in state space form the HF wave induced motion. 6.1 Observer Structure The main purpose of the observer or the state estimator is to reconstruct the unmeasured LF components from disturbed measurements since the measurement consists of both LF and a HF component. This is crucial in heading control because the oscillatory motion due to 1 st order wave induced disturbance will, if it enters the feedback back loop, cause wear and tear of the actuators and increase control energy consumption. Therefore the filtering must be accomplished before the signals are used in feedback control. Figure 8 Model Used by the observer 33
Observer Equations To obtain the observer equations, injection terms have to be added to the dynamic equations states. Taking this into account the fixed gain observer is simulated as per Figure 9: ψ L r L +K 1 ψ r L 1 T r L + K T δ + K ψ ξ H ψ H + K 3 ψ ψ H - ζω n ψ H - ω n ξ H +K w w + K 4 ψ Where ψ ψ ψ L - ψ H, is the estimation error, ψ is the yaw angle measurement, ψ L and r L is the LF yaw and yaw rate estimates respectively, ψ H is HF yaw estimate and K 1, K, K 3, K 4 are the estimator gains to be found. Using the notation, Δx x x, the estimation error dynamics are written in the state space form as: Δψ L Δr L Δξ H Δψ H K1 1 0 K1 K 1 0 K T K3 0 0 1 K3 K4 0 ω n ζω n K4 Δψ l Δr l Δξ H Δψ H The characteristic equation equation of the error dynamic can be found by det [si-m] and takes the form Π s s 4 + a 3 s 3 +a s +a 1 s +a 0 To obtain the gains for the observer design, the error dynamics must be satisfied: 4 Π i1 (s-p i ) π(s) Where p i (i1..4) are the four designed parameters specifying the values of desired location of error dynamics poles. The gains of the observer are calculated by KP 1 Q, where P And Q ω n /T ω n 0 0 ω n + ζω n /T ζω n ω n /T 0 ζω n + 1/T 1 ω n 1/T 1 0 0 1 P 134 (P 14+13+34+134 + ω n /T) P 1+4+3+14+13+34 (ω n + ζω n /T) (P 1++3+4 + ζω n + 1/T) 6. TUNING PROCEDURE To minimize the estimation errors and to satisfy faster convergence of the error dynamics that correspond to the LF states, the real components of the two poles associated with these states of the observer (P 1, P ) are chosen slightly left to the open loop poles of the 1 st order Nomoto model. The other two poles are chosen to the left of these two poles to guarantee that the HF estimation error corresponding to the 1 st order wave disturbance should converge much faster than the LF Figure 9 Simulation scheme VII. RESULTS AND DISCUSSION The aim of the observer is to smooth the control action, with reduction of HF components and therefore minimizing the positioning error and reducing vibrations of the actuator. Initially, the proposed controller along with the observer acting as a wave filter is simulated with the Linear model. The simulation is performed with controller parameters K P and K d 3.80 and 47.06 respectively as discussed in Section 5.. Parameters of wave disturbance correspond to a moderate weather condition. The wave model damping ratio is fixed at ζ 0.1, ω n 0.5 rad/sec and K w 0.03 [Fossen]. The desired yaw angle was chosen to be 10 degrees. The state estimates were computed by choosing the poles as according to:- p1-1.1/t; p -10 4 ; p3p4-15 ζω n ; which yields the estimator gain vector as: 0.0109 0.0006 1.786 1.3946 Using these estimator gains, the following result were obtained with the Linear Model. 34
Figure 10 Disturbed and LF output of yaw along with estimation error Figure 13 Disturbed and LF output of yaw along with estimation error Figure 11 Disturbance and Disturbance Estimation Figure 1 Control requirement smoothening when controller was used with the wave filter VIII. RESULTS ON NON LINEAR PLANT The same controller gains were applied on the 3 DOF non linear plant for achieving heading control. However, the estimator gains need to be recalculated to compensate for the non linear plants pole location. The satisfactory estimator gains yielded were 4.3819 6.0733 9.489 19.3956 The high gains result in slightly higher estimation errors, however the control effort reduction is still considerably high. The results of simulation with non linear plant are as follows : Figure 14 Control requirement reduction when controller was used with the wave filter IX. CONCLUSION The application of a passive wave filter along with design and application of a PD controller on a 3 DOF non linear marine model is presented. A better performance of the heading control loop is evident. The HF motion caused by the ocean waves is reduced and only desirable control action is received by the actuator. Simulation results are given to support the results. Further the observer algorithm is fairly simple and easy to implement. REFERENCES [1] Fossen, T.I., Guidance and Control of Ocean Vehicles, John Wiley and Sons, NY (1994). [] Marine GNC ToolBox for MATLAB by T.I Fossen, T Perez [3] Astrom, K.J. and Kallstrom, C.G., Identification of Ship Steering Dynamics, Automatica, Vol. 1, pp. 9- (1976). [4] Fossen T. I., Non Linear Passive Control and Observer design for ship, Tutorial Workshop, Karlsruhe,1999 35
[5] Salman, S.A., Sreenatha, A.Anavatti. and Ashokan, T., Adaptive Fuzzy Control of unmanned underwater vehicles, Indian Journal of Geo Marine Science, Vol. 40(011), pp.168-175 [6] Tzeng and Lin Adaptive ship steering autopilot design with saturating and slew rate limiting actuator International Journal Of Adaptive Control And Signal Processing (000) [7] Viorel Nicolau The Influence Of The Ship s Steering Machine Over Yaw And Roll Motions The Annals Of "Dunarea De Jos" University Of Galati (003) [8] L. Morawski, J. Pomirski and A. Rak Design Of The Ship Course Control System International Design Conference (006) [9] Tristan Perez Ship Motion Control Springer- Verlag London Limited (005) [10] S.Hammoud Ship motion control using multi controller structure Journal of Maritime Research (011) 36