1 / 64

Controller Design for Dynamically Positioning of Marine Vessels

Controller Design for Dynamically Positioning of Marine Vessels. Professor Asgeir J. Sørensen, Department of Marine Technology, Norwegian University of Science and Technology, Otto Nielsens Vei 10, NO-7491 Trondheim, Norway E-mail: Asgeir.Sorensen@ntnu.no. Outline. Control plant model

Download Presentation

Controller Design for Dynamically Positioning of Marine Vessels

An Image/Link below is provided (as is) to download presentation Download Policy: Content on the Website is provided to you AS IS for your information and personal use and may not be sold / licensed / shared on other websites without getting consent from its author. Content is provided to you AS IS for your information and personal use only. Download presentation by click this link. While downloading, if for some reason you are not able to download a presentation, the publisher may have deleted the file from their server. During download, if you can't get a presentation, the file might be deleted by the publisher.

E N D

Presentation Transcript


  1. Controller Design for Dynamically Positioning of Marine Vessels Professor Asgeir J. Sørensen, Department of Marine Technology, Norwegian University of Science and Technology, Otto Nielsens Vei 10, NO-7491 Trondheim, Norway E-mail: Asgeir.Sorensen@ntnu.no

  2. Outline • Control plant model • Linear low-frequency vessel model • Linear wave-frequency model • DP Observer • Reference model • Horizontal-plane controller • PD control law based on LQG synthesis • Integral action • Wind feedforward • Model reference feedforward • Pitch and roll motion damping controller • Controller analysis • Thrust allocation

  3. DP Control System Overview THRUSTER SETPOINTS MEASUREMENTS SIGNAL PROCESSING THRUST ALLOCATION REAL WORLD POWER MANAGEMENT SYSTEM POWER LIMITS VESSEL OBSERVER CONTROLLER COMMANDED THRUSTER FORCES VESSEL MOTIONS OPERATOR

  4. Vessel model Superposition, LF + WF

  5. Low-frequency Control Plant Model M D G w X % + X + R = b + thr Hydrodynamic Couplings:

  6. Model reduction matrices Define: Model reduction: T M H MH = i i 6 i 6 × × T Ý Þ D H D D H = + m L i i 6 i 6 × × T Ý Þ G H G G H = + m B i i 6 i 6 × ×

  7. Low-frequency Control Plant Model Linearized low-frequency state-space formulation: • i = 3: surge, sway, and yaw • i = 5:surge, sway, roll, pitch and yaw x A x B E w % = + b + i i i i ic i i y C x v = + i i i i where: T T ß à ß à x u , v , r , x , y , x u , v , q , p , r , x , y , , , = f = d S f 3 5

  8. - (Wind) • Waves • Current • Thruster Losses • Other unopened • slowly-varying effects Bias model (Markov model) Low-frequency Control Plant Model 3 DOF Vessel model (Low Speed) Tb may be set equal to 0 (Wiener model).

  9. Wave-frequency Control Plant Model Synthetic white-noise-driven wave-frequency state-space formulation for i = 3 DOF horizontal model: % A E w Y = Y + 3 w 3 w 3 w 3 w 3 w C R = Y 3 w 3 w 3 w where: T ß à x , y , 6 3 R R = f R 5 w 5 Y w w w 3 w 3w 3 w á â diag , , I = g g g á â K diag K , K , K á â = diag , , C = Q Q Q 1 2 3 w w 1 w 2 w 3 1 2 3 This corresponds to three decoupled WF models on the form: K s R Ý Þ w s w = i i w 2 2 w s 2 s i + Q g + g i i i

  10. Wave-frequency Control Plant Model Synthetic white-noise-driven wave-frequency state-space formulation for i = 3 DOF horizontal model and i = 5 DOF model: % A E w Y = Y + iw iw iw iw iw C R = Y iw iw iw where:

  11. Wave-frequency Control Plant Model WF model Example: 2nd order WF model (notch-filter)

  12. Resulting Control Plant Model Wave-frequency model: Low-frequency ship dynamics: Bias model accounting for un-modeled dynamics and slowly varying disturbance: Kinematics: Measurements:

  13. Model Uncertainties • Vessel Speed • Wave response • Coupling effects and parameters in M and D • Degree / linearization of model • Thruster losses (direction / thrust) • Wave period (peak frequency) Note ! Error in measurement can often be a significant contributor to reduced system performance !

  14. Discretization of model: Extended Kalman Filter

  15. Ý Þ R f Extended Kalman Filter Predictor: Corrector: • Time-varying Kalman filter gain only because of • Tuning of Kalman filter gain via Q and R matrices • intuitive / related to physics ? • ”noise” focused design

  16. Nonlinear Observer Observer Detailed ship model Weighted, quality checked position and heading measurements Model adaptation • Purpose: • Noise filtering • Wave filtering • Estimates of vessel positions and velocities • Dead reckoning Filtered estimates used by the feedback controller

  17. x A x A x % = + Ý Þ x A x H J A x % = + 1 1 1 1 1 2 2 1 1 1 1 1 2 2 Separate kinematics from the other parts of the model x % A x A x = + ? 1 Ý Þ x % A H J x A x = + 2 2 1 1 2 2 2 2 2 1 1 2 2 2 A nonlinear approach Is it possible to design a linear observer and afterwards extend local results to a global setting by inserting rotations? Under what conditions may the rotations be removed from the stability analysis?

  18. WF LF Body-Fixed Earth-fixed x A x E w % = + w w w w w Ý Þ R R % = f X y % ? 1 ? b T b E w = + b b b T T ? Ý Þ ? Ý Þ M GR D R b X % = f R X + b + f y y x T T Ý Þ AT Ý Þ x B Ew % = f f + b + y y T T Ý Þ Ý Þ T diag R Ý Þ , . . , R Ý Þ , I f = f f y y y Nonlinear Observer Compact Formulation:

  19. Ý Þ p Ý Þ cos cos f + f f w Ý Þ p Ý Þ sin sin f + f f w Model Properties / Assumptions Assumptions for stability analysis of Observer: 1. Used in passivity-based design of nonlinear observer 2. Bounded WF part of heading motion (e.g. less than 5 degrees)

  20. Nonlinear Observer (Basic version) Observer

  21. Observer Error Dynamics Control Plant Model Observer equations Error dynamics

  22. Compact Formulation

  23. T T V x P x M 0 * * * * = + X X > o o % T T Ý Þ V x PA A P x * * = + o o o o T T ? Ý Þ D D * * X + X + T T Ý Þ 2 R B P x * * + X f y o o T T Ý Þ 2 R C x * * + X f y o o T 2 x PE w * + o o % T T T T ? ? Ý Þ V x Q x D D 2 x PE w * * * * * = X + X + o o o o % ? 1 V 0 , x 2 Q E w * q q q q < > o o Lyapunov Analysis KYP Lemma ISS / GES

  24. K , K , K , K 1 2 3 4 Stability Requirements Stability Requirement: Choose Such that

  25. Loop Shaping of Error Dynamics Fase > -90 deg = passive

  26. 0 0 -20 -10 [dB] [dB] y -20 -40 ! Ì R -30 -60 -40 -80 -3 -3 -2 -2 -1 -1 0 0 1 1 2 2 10 10 10 10 10 10 10 10 10 10 10 10 Frequency [rad/s] Frequency [rad/s] y ! Ì X 2 / T g = ^ o p Loop Shaping 1st order wave loads

  27. Adaptive Control Systems • Some kind of ’adaptiveness’ present in most hi-tech • Marine systems today (observer / controller): • Gain Scheduling (robust) wrt. • Operation • External measurements • Operations • Model-predictive control (MPC) • Online adaptive observers / controllers Examples: Autopilots, DP systems

  28. Adaptive Observer WF model WF model parametrization: Assumed constant parameters in stability analysis (of course not entirely true …)

  29. Adaptive Observer Purpose: Compute online the WF model parameters that Matches the WF motion of the vessel. Adaptive version of WF update law: High-pass filtered

  30. Error Dynamics –Adaptive Observer WF model error dynamics ”After some algebra….” Total error dynamics: KYP / SPR requirements:

  31. Experimental Tests – GNC Lab 1999 Cybership I

  32. Experimental Tests – Adaptive Observer

  33. Experimental Tests – Adaptive Observer

  34. Reference Model Reference model of third order: e e e a v x x + I + @ = @ ref d d d x ? A x A % = + R ref f ref f r Where the final Earth-fixed position and heading are given by: In reference parallel frame the desired position and heading are given by:

  35. Reference Model Reference model of third order: Where the final Earth-fixed position and heading are given by: Optimal Earth-fixed position and heading are given by: is the optimal vessel increment subject to some criteria

  36. Controller Design - LQG Feedback Performance index defined to compute Linear-Quadratic-Gaussian feedback controller in surge, sway and yaw accounting for i = 3 DOF horizontal model and i = 5 DOF model: T X 1 T T J E lim e Qe P dt = + b b T K pd ¸ pd T 0 Deviation vector is defined to be: Ricatti equation: Let: LQG Feedback Control law is: ? G e ? G e b = p 2 1 pd d

  37. Controller Design - Resulting Control Law LQG feedback control law is: ? G e ? G e b = p 2 1 pd d Integral action: A G e b % = b + wi i i 2 i Wind feedforward control action: ? G b = ! b w wind w Reference model feedforward control action: Ý Þ Ý Þ M a D v d v C v v b = + + + 3 3 3 d d d d d t Resulting feedback and feedforward control law is: b = b + b + b + b w t 3 c i pd

  38. Positioning with Roll, Pitch Damping • Hydrodynamic coupling between: • Surge and pitch • Sway, roll and yaw • Geometrical coupling by thruster configuration: • Thruster induced pitch moment due to surge positioning • Thruster induced roll moment due to sway and yaw positioning • Resonance periods in roll and pitch in the range of 35-65 s: • within bandwidth of positioning controller

  39. Controller Design - Resulting Control Law Roll-pitch damping controller: where Resulting positioning controller with roll-pitch damping: b = b + b 5 c 3 c rpd

  40. Thrust allocation M D G w X % + X + R = b + ic Relation between 3 DOF control vector - surge, sway and yaw and r number of thruster/propellers is: Ý Þ T Ku b = J 3 r c ic × Thrust produced by each propeller: 1 Ý Þ ? + u K T + = J b Ý Þ Ku T = J b c ic 3 r c × 3 r ic × Real thrust acting on the vessel in 6 DOF: Ý Þ T Ku b = J 6 r c × thr

  41. Thrust allocation Aziumuthing thrusters 1. Bow azimuthing thruster lba 2. Bow tunnel thruster Surge lbt Yaw Sway lst 3. Stern tunnel thruster lp bp bs 4. Starboard pod 5. Port pod

  42. Positioning Controller Structure

  43. Wave Frequency • Current loads • Wind loads • 2nd order wave loads Low Frequency 1st order wave response Thrustersetpoints ThrusterAllocation Controller Vessel Observer Actual positions,velocities Sensors Measurements Reference Model Operator High Level Plant Control

  44. Transfer Function from Disturbance in Surge to Pitch Angle Magnitude [dB] 0 -20 -40 -60 Open Loop Closed Loop 3 DOF Closed Loop 5 DOF -80 0 0.005 0.01 0.015 0.02 0.025 0.03 Frequency [Hz]

  45. Transfer Function from Disturbance in Pitch to Pitch Angle Magnitude [dB] 0 -10 -20 -30 Open Loop Closed Loop 3 DOF -40 Closed Loop 5 DOF 0 0.005 0.01 0.015 0.025 0.02 0.03 Frequency [Hz]

  46. Transfer Function from Disturbance in Roll to Roll Angle Magnitude [dB] 0 -10 -20 -30 -40 Open Loop Closed Loop 3 DOF Closed Loop 5 DOF -50 0 0.005 0.01 0.015 0.02 0.025 0.03 Frequency [Hz]

  47. Coupled Dynamics Surge-Pitch Dynamics: Surge Control Law: Pitch damping Closed-Loop pitch dynamics: X, U -> 0 by control

  48. DP with Roll and Pitch Damping - Time Series Surge [m] 0.2 • Wave: • Hs = 6 m • Tp = 10 s • wave = 225 deg • Current: • Vcur = 0,5 m/s • cur = 225 deg • Wind: • Vwind = 10 m/s • wind = 225 deg 0 -0.2 -0.4 0 200 400 600 800 1000 Pitch [deg] 0.4 With roll-pitch damping No roll-pitch damping 0 -0.4 -0.8 0 200 400 600 800 1000 time [sec]

  49. DP with Roll and Pitch Damping - Time Series Thrust in surge [kN] 600 400 • Wave: • Hs = 6 m • Tp = 10 s • wave = 225 deg • Current: • Vcur = 0,5 m/s • cur = 225 deg • Wind: • Vwind = 10 m/s • wind = 225 deg 200 0 0 200 400 600 800 1000 Thruster induced moment in pitch [kNm] 4 x 10 2.5 With roll-pitch damping No roll-pitch damping 2 1.5 1 0.5 0 0 200 400 600 800 1000 time [sec]

  50. DP with Roll and Pitch Damping - Time Series Sway [m] 0.5 0 • Wave: • Hs = 6 m • Tp = 10 s • wave = 225 deg • Current: • Vcur = 0,5 m/s • cur = 225 deg • Wind: • Vwind = 10 m/s • wind = 225 deg -0.5 -1 Roll [deg] 1 0.5 0 -0.5 Heading [deg] With roll-pitch damping 0.1 No roll-pitch damping 0 -0.1 0 200 400 600 800 1000 time [sec]

More Related