Nonlinear Controller Design Of A Ship Autopilot 指導老師:曾慶耀 教授 學 生:呂政倫 學 號:10267041 1 Out line 1. 2. 3. 4. 5. Introduction Mathematical model of ship dynamics Control system for ship course tracking Simulation test Conclusion 2 Introduction A conventional autopilot system used for controlling the ship motion is a PD controller with constant parameters values. These controllers can work properly in precisely defined operating conditions, but the quality of their work is worse when these conditions change. Ship dynamic characteristics can change as a consequence of changes of the ship speed, load, and external disturbances such as waves, wind, and/or sea currents. 3 Therefore a lot of research activities have been oriented to improving the quality of operation of these controllers using adaptive mechanisms which automatically change ship model parameters, depending on operating conditions. Controllers were tested in calm water and in the presence of sea waves . Compare the obtained results . 4 Mathematical model of ship dynamics Assuming a ship sailing on water surfaces which is stable in surge and sway directions and 0 . we can neglect the dynamics of roll 、 pitch and heave. 5 The state variables describing the ship motion are [ u , , r ] [ x , y , ] collected in two vectors, and . R(ψ) is the rotation matrix, calculated from the formula 6 2.1. Mathematical model of CyberShip II: Cybership II is a scale replica of a supply ship ,made at a scale of 1:70. Its mass is 23.8 kg, the overall length is 1.255 m, and the breadth is 0.29 m. The mathematical model of this ship: The system inertia matrix M M RB M A includes the rigid-body system inertia matrix M RB ,and the hydrodynamic matrix included added mass coefficients MA . 7 The Coriolis-centripetal matrix C(ν) includes Coriolis and centripetal terms CRB (v) acting on the ship , as well as hydrodynamic Coriolis and centripetal terms CA (v) connected with the fluid in which the ship moves . 8 The damping matrix D(v) which consists of the linear part DL , determined for a selected small and constant surge velocity , and nonlinear part DNL (v) , determine hydrodynamic damping forces at high velocities. 9 The vector of forces acting on the ship’s hull refers to the forces th generated by the propellers and rudders and to the forces generated by acting disturbances: 2.2. Mathematical models of propellers and rudder blades For small speeds, the propeller/blade model can be divided into two parts, of which the first one describes the nominal thrust i {1, 2,3} : 10 The second part refers to additional lift and drag forces the following surge and sway forces are obtained: 11 the vector of forces applied to the hull depending on the distribution of the propellers and rudder blades: where the matrix T is the actuator configuration matrix 2.3. Environmental disturbances (i) waves generated by the wind, (ii) ocean currents, (iii) the wind. [ X , Y , N ] which is directly added to the vector τ. 12 The wave slope si can be related to the wave S (i ) spectral density function . 13 Control system for ship course tracking The input signal in the examined control system was the desired course d . To evaluate the quality of operation of the examined controllers, the cost function was defined as 14 3.1. PD controller PD controller controls the rudder blade deflection depending on the values of the heading error and the yaw rate. 3.2. Sliding mode controller The output signal of the sliding mode controller, being the input signal for the controlled object, is composed of two terms (equivalent part and switching part.) 3.2.1. Equivalent part The manoeuvring model is obtained which consists of the surge dynamics 15 16 The parameters of the transfer function are related to the hydrodynamic coefficients 17 The Nomoto model can be reduced by determining the substitute time constant using the relation T = T1 + T2 − T3: 18 The sliding surface h was defined as the equivalent part of the sliding mode controller following formula: where N is the gain to scale the commanded heading Z ,which is calculated from 19 3.2.2. Switching part The switching part of sliding mode control takes the form 3.2.3. Complete form The control law of the sliding mode controller 20 Comparing Eq: (20) and (43) PD controller: The commanded rudder blade deflection only calculated from the heading error and the yaw rate . Sliding mode controller: The commanded rudder blade deflection is calculated from the course error, the yaw rate, the commanded yaw rate, and the commanded yaw acceleration. 21 Simulation tests 22 23 24 Conclusion The simulations made conclude that both controllers properly led the ship in calm water, and similar cost function values were obtained. The sliding mode controller better tracks the heading at the presence of waves than the PD controller. The advantage of the use of switching in the sliding algorithm that is helps to keep the current course by disturbances generated by an external environment . 25 THE END 26 順滑模式:「t = 0,系統狀態X(t)在有限時間內, 被外力所迫,推向順滑平面上(s(x) = 0),且於後 續時間內,系統不再脫離此順滑平面,並沿著順 滑平面向平衡點移動,最終到達系統狀態的目標 值」。 順滑模式的產生,可以歸納出兩個程序: 1.當系統在順滑面之外時,選定順滑函數,使所 有軌跡在有限時間內接觸到順滑面,這個過程稱 為迫近模式。 2.當系統進入後,應保證使系統不再離開並朝平 衡點 x=0 逼近,這個過程稱為等效模式。 27 Switching :將狀態分成3個子空間s(x)>0 、 s(x)<0 和 s(x)=0 ,設計就是要在s(x)=0 空間產生順滑模式。 科氏力:是因地球自轉,而對地表附近的運動(如風、 飛彈、海流等等)所造成的一種偏向力。 向心力:物體做等速率圓周運動,加速度為向心加速度, 方向指向圓心,依F=ma,物體受力(F)方向必和加 速度(a)方向相同,因此合力也指向圓心,稱為向心 力(Fc)。 28