Adaptive fuzzy ship autopilot for track
Transcription
Adaptive fuzzy ship autopilot for track
Adaptive fuzzy ship autopilot for track-keeping 指導教授:曾 慶 耀 學 號:10267036 學 生:潘 維 剛 1 Outline 1. Introduction 2. System description 3. Adaptive fuzzy track-keeping autopilot 4. Simulation results 5. Conclusion 2 1. Introduction • The approach taken in this paper tries to overcome the need for ship’s mathematical model(s) by using the fuzzy logic autopilot which is augmented by the capability of adjustment of its scaling factors. • The proposed adaptive fuzzy autopilot emerges as a viable practical alternative for coastal sailing where the track-keeping is of vital importance in all circumstances. 3 2. System description 2.1. Ship dynamics • The block diagram of the proposed adaptive fuzzy control system for the ship track-keeping is shown in Fig.1. 4 • The position and orientation of the ship are described relative to the inertial reference frame OE-xEyEzE (Earthfixed reference frame). 5 • The general ship equations of motion can be expressed in compact form as • M is the inertia matrix, C (v) is a matrix of Coriolis and centripetal terms , v u, v, w, p, q, r is the body-fixed (ship) linear and angular velocities vector and X , Y , Z , K , M , N is a generalized vector of external forces and moments. T T 6 • Due to that 6DOF model is simplified and reduced to 3DOF model (Fig. 3). 7 • For this ship the nonlinear mathematical model which relates the yaw (Ψ) with the rudder angle (δ) is described by the following equations: 8 2.2. The steering gear servo system • The steering gear servo system consists of two electrohydraulic steering subsystems: telemotor position servo and rudder servo actuator (Fig. 4). • The input of the steering gear servosystem originates from the autopilot and is called the commanded rudder angle(δc). The output is the actual rudder angle (δ). 9 • The desired way point is ( xd , yd ) ( xi , yi ) Hence, the desired heading angle can be obtained from the expression: • The distance d between the current ship position and the desired way point can be calculated from 10 3. Adaptive fuzzy track-keeping autopilot • Fig. 7 shows a simple block diagram of this autopilot. The range of values for a given autopilot inputs and output are normalized to the interval [-3 3] by scaling factors in “conditioning” blocks. • The course-keeping fuzzy autopilot (FLC) contains two control inputs: heading error e=Ψd-Ψ and yaw rate r=dΨ/dt: The control action generated by the autopilot is the command rudder angle δc. The output variable y of type autopilot obtained constant 11 values (NB→-3,NM → -2, . . . ,PM → 2, PB → 3). • Shapes of membership functions of input variables are shown in Fig. 8. Labels for the membership functions are given in Table 1. 12 • These rules contain the input/output relationships that define the control strategy. The fuzzy autopilot uses 49 rules, corresponding to 7*7 different combinations of the two input fuzzy sets. (Table 2). 13 • This controller consists of if-then rules of the form • Inference with rules defined in (14) and given in Table2 is done as follows. 14 • Fig. 9 shows the basic configuration of the FGC structure. • The main part of this mechanism is a Mamdani type fuzzy controller (FGC) with two inputs: distance d and yaw angle Ψ and one output: gain k: In this section, a fuzzy tuning method for the gain of FLC variables is presented. 15 • Shapes of membership functions of input variables and output variable are shown in Figs. 10–12. 16 17 The overall control rule set for the FGC, is defined as the following: IF d is NE and Ψ is PS then ki is PS IF d is NE and Ψ is PM then ki is PM IF d is NE and Ψ is PB then ki is PB IF d is ZE and Ψ is PS then ki is PB IF d is ZE and Ψ is PM then ki is PM IF d is ZE and Ψ is PB then ki is PS IF d is PE and Ψ is PS then ki is PS IF d is PE and Ψ is PM then ki is PB IF d is PE and Ψ is PB then ki is PM This set of rules is the same for the ke ; kr and ky: 18 4. Simulation results • In the first case the desired path is given with six way points P1,P2, . . . ,P6 . From the simulation results obtained(Fig.13). 19 • Fig. 14 shows the time responses of heading , commanded rudder angle (δc) and rudder angle (δ) during a coursechanging maneuver . The heading time response is without overshoot and oscillation during transient response. The response of the rudder is rather smooth. 20 • In Fig. 17, the comparison between adaptive fuzzy and standard fuzzy autopilots is presented. The results of the comparative performance test showed that adaptive fuzzy autopilot has shown much better performance in comparison with the standard fuzzy type autopilot. 21 5. Conclusion • A standard fuzzy control system and an adaptive fuzzy control system for the ship track-keeping are developed and compared. Simulations suggest that, in the case without influence of the sea currents, the standard fuzzy type (Sugeno) autopilot is robust and has good performance. • Simulation results has shown that this adaptive fuzzy autopilot have better performance in comparison with standard fuzzy type autopilot especially in the presence of environmental disturbances (sea currents and waves). 22 THE END Thanks for your attendance !! 23