Nonlinear Adaptive Robust Control – Theory and Applications Bin Yao School of Mechanical Engineering Purdue University West Lafayette, IN47907 OUTLINE Motivation General ARC Design Philosophy and Structure Specific Design Issues Application Examples Motion and Pressure Control of Electro-Hydraulic Systems Precision Motion Control of Linear Motors Dynamic Friction Compensation Conclusions Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 2 Obstacles for Control Algorithms Design Inherent Nonlinearities Friction forces; Nonlinear process dynamics; … Modeling Uncertainties Unknown but reproducible or slowly changing terms (e.g., unknown parameters, repeatable run out, …) Non-reproducible terms (e.g., random external shock disturbances, non-repeatable run out) Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 3 Strategies For Performance Improvement Nonlinear Physical Model Based Analysis and Synthesis Deal with the inherent physical nonlinearities directly Fast Robust Feedback for Maximum Attenuation of Various Uncertainty Effect Effective to both repeatable and non-repeatable uncertainties Controlled Learning for Uncertainty Reduction Effective handling of repeatable uncertainties Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 4 Different Types of Race Car Drivers Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 5 Mr. Robust Control (DRC) A Boxer Fast Instantaneous Reaction ! Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 6 Mr. Adaptive Control (AC) A Thinker Good Learning Ability but Not so Fast Instantaneous Reaction ! Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 7 Mr. Adaptive Robust Control A Thinker with a good body Good Learning Ability and Fast Instantaneous Reaction ! Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 8 What is the order of arrivals of three drivers ? Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 9 Random Road Profile Order of arrivals of three drivers: or Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 10 What is the winning order of three drivers in individual practices ? Repeatable Road Profile Winning order of drivers: Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 12 What is the winning order of three drivers in actual competition ? Semi-Repeatable Driving Condition Winning order of drivers: or Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 14 DETERMINISTIC ROBUST CONTROL (DRC) Sliding Mode Control (SMC) (Utkin’77, Young, Slotine, Sastry, Hedrick, Zinober, Zak, …) Matching Condition Control Chattering Due to Discontinuous Control Law Smoothing Techniques (Slotine’85) ) Asymptotic Tracking is lost and a trade off exists between the actuator requirements and the achievable tracking accuracy. Lyapunov Function Based Min-Max Methods (Leitmann, Corless and Leitmann’81, Barmish, Chen, ...) Unmatched Uncertainties (Qu’93, Freeman and Kokotovic’93,…) Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 15 ADAPTIVE CONTROL OF LINEAR SYSTEMS Stable Adaptive Control (late 1950-1980) (Astrom, Narendra,...) Robust Adaptive Control (1980s) To achieve robustness to small disturbances, time-varying parameters and unmodeled dynamics (Rohrs, et al, 1985, Egardt, 1979) Use Appropriate Reference Input Persistent Excitation (PE) Conditions (Boyd and Sastry, Annaswamy,…) Robustify Adaptation Law (i) Dead zone; (ii)σ -modification (Ioannou and Kokotovic, 83); (iii) ε -modification; (iv) Discontinuous Projection (Sastry, Goodwin,…) Recent Trends Improve Transient Performance (Zhang and Bitmead, 90) Using VSC (Fu,92, Narendra and Boskovic,87), (Datta,93) Relax Assumptions Minimum Phase; Relative Degree; Sign of high-frequency gain; Order. ADAPTIVE CONTROL OF NONLINEAR SYSTEMS Adaptive Control of Robot Manipulators (1985-present) (Slotine and Li’88, Sadegh and Horowitz’90, Spong’89…) Adaptive Control of Feedback Linearizable Systems --Certainty-Equivalence Based (1987-early 90s) Nonlinearity-Constrained Schemes (Sastry and Isidori’89, …) Uncertainty-Constrained Schemes --extended matching condition Systematic Design Method--Backstepping (1990-present) Parametric-strict Feedback Form (Kanellakopoulos, Kokotovic, and Morse’91) Without Overparametrization (Krstic, et al’92) Improved Transient Performance (Kanellakopoulos, et al’93) Robust Adaptive Control of Nonlinear Systems Robot (Reed and Ioannou’89, …); Backstepping (Polycarpou and Ioannou’93, Pan and Basar’96, Freeman, et al’96, Marino and Tomei’98, …) Robust stability; Achievable performances in terms of L∞ norm are not so transparent NONLINEAR ADAPTIVE CONTROL (AC) • Reduce/Eliminate uncertainties through parameter adaptation to achieve asymptotic tracking. Limitations: • Need certain invariant properties (e.g., parameters being unknown but constant). • Possible instability in the presence of even small measurement noises and disturbances DETERMINISTIC ROBUST CONTROL (DRC) • Attenuate the effect of model uncertainties through robust feedback. Limitations: • limited final tracking accuracy (tracking errors can only be reduced by increasing feedback gains) OUTLINE Motivation General ARC Design Philosophy and Structure Specific Design Issues Application Examples Motion and Pressure Control of Electro-Hydraulic Systems Precision Motion Control of Linear Motors Dynamic friction compensation Conclusions Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 19 ADAPTIVE ROBUST CONTROL (ARC) Problem Formulation Practical situation that the system is subjected to both repeatable and non-repeatable uncertainties Means Used To Achieve High Performance Fast Robust Filter Structures to attenuate the effect of model uncertainties as much as possible Learning Mechanisms (e.g., parameter adaptation) to reduce repeatable model uncertainties General Design Philosophy Robust performance provided by robust feedback should not be lost when introducing learning mechanisms; Learning mechanisms are introduced only when their destabilizing effects can be controlled Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 20 θ Learning Mechanisms (Parameter Adaptation) Coordination Mechanisms us r (t ) uf Adjustable Model Compensation Robust Feedback u Plant x y General Structure of ARC Controllers Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 21 FIRST-ORDER UNCERTAIN SYSTEM x = f ( x, t ) + u, θ: ∆: f = ϕ T ( x , t )θ + ∆ ( x , t ) unknown parameters uncertain nonlinearities Assumptions θ ∈ Ω θ = (θ min , θ max ) | ∆ | ≤ δ ( x, t ) where Ω θ and δ ( x, t ) are known Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 22 OBJECTIVE For any desired output trajectory x d (t ), design a bounded control input u (t ) such that the tracking error, e=x−xd, is as small as possible e (t ) x d (t ) x t Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 23 θ θ = Γϕe Parameter Adaptation Law −k Linear Stabilizing Feedback xd xd − ϕ T θ uf Model Compensation + u ∆=0 x = ϕ Tθ + u x Plant + e - xd Adaptive Control of a First- order Uncertain System Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 24 ADAPTIVE CONTROL METHOD Assume that there is no uncertain nonlinearity ∆ = 0 On - line parameter adaptation Error dynamics e + k e = -ϕ θ Lyapunov function V V ~ T 1 e 2 a = a = e − ϕ [ 2 + T 1 ~ θ 2γ ~ 2 ] θ − ke + RESULTS 1 ~ γ ~ θ θ = − ke 2 e → 0 and ϕ θ → 0 as t → ∞ i.e., Zero final tracking error for any feedback gain since the parametric uncertainty is eliminated. T LIMITATIONS OF ADAPTIVE CONTROL • Transient performance is unknown e t • Uncertain nonlinearities are not considered When ∆ • ≠ 0, what is the performance ? May be unstable when ∆ ≠ 0 Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 26 us2 u s 2 (e, t ) Nonlinear Robust Feedback us + u s1 −k Linear Stabilizing Feedback xd − ϕ θ0 T xd Fixed Model Compensation uf + u ∆ x = ϕ T θ + ∆ + u x -+ Plant e xd Deterministic Robust Control of a First- order System Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 27 DETERMINISTIC ROBUST CONTROL • Error dynamics ~ e + ke = −ϕ T θ 0 + ∆ + u s2 • Choose the robust control us2 such that ( ) ~ e us2 − ϕ Tθ0 + ∆ ≤ ε • where ε is a design parameter. Example u s2 = − • eu s2 ≤ 0 and 1 4ε [ θ m a x − θ m in 2 ϕ 2 +δ 2 ]e 1 2 Stability analysis by a Lyapunov function Vs = e 2 V s ≤ − 2 kV s + ε V s ≤ exp ( − 2 kt )V s (0 ) + ε 1 − exp ( − 2 kt )] [ 2k Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 28 DETERMINISTIC ROBUST CONTROL • • e(0) Guaranteed transient: exponential convergence Guaranteed final tracking accuracy: 2 Upper Bound of Tracking Error [ exp( − 2kt ) e(0) − e(∞ ) 2 2 ] + e( ∞ ) 2 e( ∞ ) ≤ 2 e(t ) ε k 2 t Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 29 ARC DESIGN via SMOOTH PROJECTION θπ [ () ] θ π (⋅) θ = Γ − lθ θ + ϕ e Smooth Projection Modified Adaptation Law us2 u s 2 (e, t ) Nonlinear Robust Feedback us + u s1 −k Linear Stabilizing Feedback x d − ϕ θπ T xd uf Adjustable Model Compensation + u ∆ x = ϕ T θ + ∆ + u x -+ Plant Copyright by Bin Yao, School of Mechanical Engineering, Purdue University e xd 30 SMOOTH PROJECTION () πθ θ max εθ θ max θ min θ θ min PROPERTY ~ Vθ (θ ) is a positive definite function where (Teel’93) 1 θ ~ V θ (θ ) = π (ν + θ ) − θ )d ν , γ ≥ 0 ( ∫ γ ~ 0 Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 31 MODIFICATION OF ADAPTATION LAW lθ acts as a nonlinear damping and satisfies ( ) ( ) lθ θ = 0 ~ i i . θ πT lθ θ ≥ 0 i. if if θ ∈Ωθ θ ∉Ωθ lθ θ min θmax θ Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 32 ARC DESIGN via SMOOTH PROJECTION • Error dynamics ~ e + ke = −ϕ θ π + ∆ + u s 2 T • Choose the robust control u s 2 such that ( ~ ) e us 2 − ϕ θπ + ∆ ≤ ε i. T ii. eus 2 ≤ 0 • Example [ ] 1 2 2 us2 = − θmax −θmin + εθ ϕ + δ 2 e 4ε Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 33 PERFORMANCE OF ARC • In general, achieves the same performance as DRC Guaranteed transient: exponential convergence Guaranteed final tracking accuracy e (0 ) 2 U pper B ound of T racking E rror [ exp ( − 2 kt ) e ( 0 ) 2 − e (∞ ) 2 ] + e (∞ ) 2 e (∞ ) e (t ) 2 ≤ ε k 2 t • In addition, achieves asymptotic tracking in the presence of parametric uncertainties as AC Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 34 PROOF of ARC PERFORMANCE • In general, use the same Lyapunov function V s DRC to recover the results of DRC ( ~ V s = − ke + e − ϕ θ π + ∆ + u s 2 2 T ≤ − 2 kV s + ε • as in ) When ∆ = 0, use a new p.d. function Vt = Vs +Vθ to obtain asymptotic tracking ~ V t = − ke + eu s 2 − e ϕ θ π + 2 T () 1 ~ γ θπθ ~ = − ke 2 + eu s 2 − θ π lθ θ ≤ − ke 2 Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 35 ARC DESIGN via DISCONTINUOUS PROJECTION θ θ = Pr ojθ (Γ ϕ e ) Modified Adaptation Law us2 u s 2 (e, t ) Nonlinear Robust Feedback us + u s1 −k Linear Stabilizing Feedback x d − ϕ θπ T xd uf Adjustable Model Compensation + u ∆ x =ϕ θ +∆+u T Plant Copyright by Bin Yao, School of Mechanical Engineering, Purdue University x + e - xd 36 ARC DESIGN via DISCONTINUOUS PROJECTION • Parameter adaptation with projection qˆ = Pr ojqˆ (Gj e ) Ï 0 if Ô Pr ojqˆ (∑i ) = Ì 0 if i Ô Ó∑i • Properties { qˆi = qˆimax and ∑i >0 qˆi = qˆimin and ∑i <0 otherwise P1. θ ∈ Ωθ = θ : P2. θ ( Γ -1 Pr ojθ (Γ •) − •) ≤ 0, ~ θmin ≤ θ ≤ θmax } ∀• Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 37 DESIRED COMPENSATION ARC DESIGN θ θˆ = Pr ojθˆ (Γ ϕ ( x d ) z ) Modified Adaptation Law us2 us 2 ( z , t ) Nonlinear Robust Feedback us + u s1 − k s1 Linear Stabilizing Feedback x d − ϕ ( x d ) θˆ T xd uf Adjustable Model Compensation + u ∆ x = ϕ ( x )T θ + ∆ + u x - + Plant xd z SIMULATION OF A FIRST-ORDER SYSTEM • The Plant • The Controller Parameters δ =1 θ0 = 2 k = 10 ε 0 = 0 .3 γ = 2000 • x = θ sin (π x ) + ∆ + u round ( t ) ∆ = ( - 1) ϕ = sin (π x ) Ω θ = ( 0 , 20 ) θ = 18 D t = 1m s ε 1 = 0 .001 The Desired Trajectory x d = 0 .5 (1 − c o s ( 1 . 4 π t ) ) Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 39 Adaptive Control (no disturbances) -- Solid 1 Adaptive Control (with disturbances) -- Dashed Feedback Linearization (no disturbances) Tracking Error 0.8 0.6 0.4 0.2 0 -0.2 0 0.5 1 1.5 2 2.5 3 3.5 4 Time (s) Adaptive Control of a First-order Uncertain System 35 Estimated Parameter Adaptive Control (no disturbances) -- Solid 30 Adaptive Control (with disturbances) -- Dashed 25 Feedback Linearization 20 15 10 5 0 0 0.5 1 1.5 2 2.5 3 3.5 4 Time (s) Adaptive Control of a First-order Uncertain System 0.04 Tracking Error 0.03 0.02 0.01 0 ε 0 =1 -0.01 -0.02 0 0.5 1 and ε1 =0.001 (with disturbances) -- Solid =0.3 and =0.3 and =0.001 (with disturbances) -- Dashed =0.001 (no disturbances) -- Dotted =0.08 and =0.001 (with disturbances) -- Dashdot 1.5 2 2.5 Time (s) 3 3.5 4 Deterministic Robust Control of a First-Order System 0.25 Solid: ARC(d) Dashed: ARC(s) 0.2 Dotted: AC Tracking Error 0.15 Dashdot: DRC 0.1 0.05 0 −0.05 −0.1 −0.15 0 0.5 1 1.5 2 2.5 3 3.5 4 Time (sec) Tracking Errors In the Presence of Parametric Uncertainty Only 30 Solid: ARC(d) Dashed: ARC(s) Estimated Paramter 25 Dotted: AC Dashdot: DRC 20 15 10 5 0 0 0.5 1 1.5 2 2.5 3 3.5 4 Time (sec) Estimates In the Presence of Parametric Uncertainty Only 0.25 Solid: ARC(d) Dashed: ARC(s) 0.2 Tracking Error 0.15 Dotted: AC Dashdot: DRC 0.1 0.05 0 −0.05 −0.1 −0.15 0 0.5 1 1.5 2 2.5 3 3.5 4 Time (sec) In the Presence of Parametric Uncertainty and Small Disturbances 35 Solid: ARC(d) Estimated Paramter 30 Dotted: AC 25 Dashed: ARC(s) Dashdot: DRC 20 15 10 5 0 0 0.5 1 1.5 2 2.5 3 3.5 4 Time (sec) In the Presence of Parametric Uncertainty and Small Disturbances 0.04 0.035 Tracking Error 0.03 Solid: ARC(d) Dashed: ARC(s) Dashdot: DRC 0.025 0.02 0.015 0.01 0.005 0 −0.005 0 0.5 1 1.5 2 2.5 3 3.5 4 Time (sec) In the Presence of Parametric Uncertainty and Large Disturbances 45 40 Paramter Estimate 35 30 25 20 15 10 5 0 0 Solid: ARC(d) Dashed: ARC(s) Dashdot: DRC 0.5 1 1.5 2 2.5 3 3.5 4 Time (sec) In the Presence of Parametric Uncertainty and Large Disturbances ADAPTIVE ROBUST CONTROL (ARC) Departs From Robust Adaptive Control (RAC) Departs From Deterministic Robust Control (DRC) In terms of fundamental view point, puts more emphasis on the underline robust control law design for a guaranteed robust output tracking performance in general. In terms of achievable performance, guarantees a prescribed transient performance and tracking accuracy. In terms of design approaches and proof, uses two Lyapunov functions; one the same as DRC and the other as RAC. Achieves asymptotic tracking in the presence of parametric uncertainties without using discontinuous control law or infinite gain feedback—overcome the design conservativeness. Departs From Other Existing Combined Schemes (Narendra and Boskovic’92, Slotine and Li’88, Chen’92, …) Achieves a guaranteed transient performance and tracking accuracy Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 49 OUTLINE Motivation General ARC Design Philosophy and Structure Specific Design Issues Application Examples Motion and Pressure Control of Electro-Hydraulic Systems Precision Motion Control of Linear Motors Dynamic friction compensation Conclusions Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 50 Specific Design Issues Means to achieve fast robust feedback Learning techniques (e.g., parameter adaptation) to reduce model uncertainties for an improved performance Desired compensation to alleviate the effect of measurement noises Direct/Indirect and Integrated ARC designs Extensions Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 51 Maximizing Disturbances Attenuation General Means : High - gain feedback to raise the closed - loop bandwidth Problems: May run into Control Saturation Problem during large transients caused by sudden changes of large command inputs Solutions: Separating the achievable closed- loop bandwidths to command inputs and disturbances Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 52 Respect System Dynamics Design Principle Only ask system to track feasible reference trajectories Solutions On-line reference trajectory generation and Physical model based nonlinear compensation ! ωd eω = ω − ω d ω ω in p u t , Command Input ω d , Generated reference Input eω , Tracking error t Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 53 Nonlinear Feedback Gains for Improved Transient Performance and Better Trade-off in Meeting Various Needs Robust feedback us High gain feedback for a better disturbance rejection to improve transient performance tracking error e Moderate feedback gain for a better trade-off between noise attenuation and disturbance rejection Small feedback gain to avoid control saturation and instability Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 54 Specific Design Issues Means to Achieve Fast Robust Feedback Learning techniques (e.g., parameter adaptation) to reduce model uncertainties for an improved performance Desired compensation to alleviate the effect of measurement noises Direct/Indirect and Integrated ARC designs Extensions Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 55 Controlled Learning Process Use prior knowledge such as physical bounds of parameter variations to achieve a controlled learning process; this helps get rid off the destabilizing effect of on - line learning and enable a fast adaptation loop to be used for a better performance ! Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 56 Specific Design Issues Means to Achieve a Fast Robust Feedback Learning techniques (e.g., parameter adaptation) to reduce model uncertainties for an improved performance Desired compensation to alleviate the effect of measurement noises Direct/Indirect and Integrated ARC designs Extensions Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 57 DISCONTINUOUS PROJECTION BASED ARC DESIGN θ θˆ = Pr ojθˆ (Γ ϕ ( x ) z ) Modified Adaptation Law us2 us 2 ( z , t ) Nonlinear Robust Feedback us + u s1 −k Linear Stabilizing Feedback x d − ϕ ( x ) θˆ T xd uf Adjustable Model Compensation + u ∆ x = ϕ ( x )T θ + ∆ + u x -+ Plant Copyright by Bin Yao, School of Mechanical Engineering, Purdue University z xd 58 DESIRED COMPENSATION ARC DESIGN θ θˆ = Pr ojθˆ (Γ ϕ ( x d ) z ) Modified Adaptation Law us2 us 2 ( z , t ) Nonlinear Robust Feedback us + u s1 − k s1 Linear Stabilizing Feedback x d − ϕ ( x d ) θˆ T xd uf Adjustable Model Compensation + u ∆ x = ϕ ( x )T θ + ∆ + u x -+ Plant Copyright by Bin Yao, School of Mechanical Engineering, Purdue University z xd 59 Desired Compensation ARC Structure Reducing the effect of measurement noise ) Regressor does not depend on measurements Fast adaptation rate in implementation An almost total separation of robust control law design and parameter adaptation design; this facilitates controller gain tuning process considerably Off- line calculation of regressors Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 60 Specific Design Issues Means to Achieve a Fast Robust Feedback Learning techniques (e.g., parameter adaptation) to reduce model uncertainties for an improved performance Desired compensation to alleviate the effect of measurement noises Direct/Indirect and Integrated ARC designs Extensions Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 61 Specific Design Issues Means to Achieve a Fast Robust Feedback Learning techniques (e.g., parameter adaptation) to reduce model uncertainties for an improved performance Desired compensation to alleviate the effect of measurement noises Direct/Indirect and Integrated ARC designs Extensions Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 62 MIMO Semi-Strict FEEDBACK FORM I i- th Subsystem xi = fi 0 ( χi , t ) + Fi ( χi , t )θ + Bi ( χi ,θ , t ) xi+1,mi + Di ( χi , t ) ∆i ηi = Φi0 ( χi , t ) + Φ1i ( χi , t )θ 1 ≤ i ≤ r -1 r- th Subsystem xr = M−1 ( χi , β, t ) fr0 ( χr , t ) + Fr ( χr , t )θ + Fβ β + Bi ( χr ,θ, β, t ) u + Dr ∆r ηr =Φr ( χr ,θ,t ) Output y = yr = [ ] T T T y1b , … , y rb Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 63 Inputs χ1 χ2 Outputs ∆1 1-th SUBSYSTEM ∆2 . . u ... ∆r r-th SUBSYSTEM xr . . . x1 y1b U2 2-th SUBSYSTEM x2 T N2 y2b Ur T Nr yrb MIMO Semi-Strict FEEDBACK FORM I Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 64 ASSUMPTIONS • Bi is nonsingular and can be linearly parametrized • M is an s.p.d. matrix and can be linearly parametrized • The η i − su b system is BIBS stable w.r.t. input • There exist known functions δ i ( χ i , t ) ∆ i ( χ ,θ , u , t ) ≤ δ i ( χ i , t ) , ( χi −1 , xi ) such that i = 1, … , r Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 65 DIFFICULTIES • High Relative Degrees • Mismatched Uncertainties Uncertainties do not enter the system in the same channel as control inputs • Coupling and Appearance of Parametric Uncertainties in the Input Channels of Each Layer • Last Layer’s State Equations Cannot be Linearly Parametrized Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 66 Inputs χ1 χ2 ∆1 u1b ∆2 u2b ... ∆r urb Outputs . . r-th SUBSYSTEM xr 2-th SUBSYSTEM x2 1-th SUBSYSTEM x1 y . ... MIMO Semi-Strict FEEDBACK FORM II Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 67 Extensions Output Feedback ARC of Uncertain Linear Systems with Disturbances - Need observers for state estimates Observer Based ARC of a Class of Nonlinear Systems with Dynamic Uncertainties - Partial state feedback Adaptive Robust Control without Knowing Bounds of Parameter Variations - Use fictitious bounds for a controlled learning process Neural Network Adaptive Robust Control - Integrate the universal approximation capability of neural networks into ARC design for general nonlinearities Adaptive Robust Repetitive Control For periodic unknown disturbances and repetitive tasks APPLICATIONS Precision Motion Control of High Speed Machine Tools and Linear Motors Combined the design technique with digital control Control of Electro-Hydraulic Systems Hydraulic Servo-systems; Hydraulic Excavators Trajectory Tracking Control of Robot Manipulators Motion and Force Control of Robot Manipulators (a) in contact with a stiff surface with unknown stiffness (b) in contact with a rigid surface Coordinated Control of Multiple Robot Manipulators Ultra-Precision Control of Piezo-electrical Actuators; Harddisk Drives; … Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 69 Electro-Hydraulic Experimental Setup Electro-Hydraulic Experimental Setup Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 71 Non-Circular Track Profile Eccentricity External Vibrations Flow-induced Aero-elastic Forces Pivot Friction Hard-Disk Drive Experimental Setup OUTLINE Motivation General Design Philosophy and Structure Specific Design Issues Application Examples Motion and Pressure Control of Electro-Hydraulic Systems Precision Motion Control of Linear Motors Dynamic Friction Compensation Conclusions Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 73 Linear Motion Table Gear Leadscrew Rotary Servo Motor FLUX DENSITY (B) COILCOIL ASSEMBLY ASSEMBLY CURRENT (I)(I) CURRENT FORCE (F=IxBf) FORCE (F) MAGNET ASSEMBLY MAGNETIC ATTRACTION (Fa) Linear Motor vs. Rotary Motor Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 74 Advantages of Linear Motor Drive Systems Mechanical simplicity (no mechanical transmission mechanisms), higher reliability, and longer lifetime No backlash and less friction, resulting in the potential of having high load positioning accuracy No mechanical limitations on achievable acceleration and velocity Bandwidth is only limited by encoder resolution, measurement noise, calculation time, and frame stiffness Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 75 Difficulties in Control of Linear Motors Model Uncertainties Parametric uncertainties (e.g., load inertia) Discontinuous disturbances (e.g., Coulomb friction); external disturbances (e.g., cutting force) Drawback of without mechanical transmissions Gear reduction reduces the effect of model uncertainties and external disturbance Significant uncertain nonlinearities due to position dependent electro - magnetic force ripples (e.g. iron core linear motors) Implementation issues (e.g., measurement noise) Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 76 Mathematical Model x1 = x 2 M x 2 = u − B x 2 − F fn ( q ) − F r ( q ) + F d y = x1 where x 1 : position x 2 : velocity y : output Ffn : nonlinear friction Fd : lumped disturbance M : mass of load u : input voltage B : viscous friction const F r : force ripple Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 77 Model of Friction Force F fn is discontinuous at zero velocity Ffn Af V(m/s) Ffn A continuous friction model F fn is used to approximate F fn F fn ( x 2 ) = A f S f ( x 2 ) Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 78 Force ripple Cogging force is a magnetic force developed due to the attraction between the permanent magnets and the cores of the coil assembly. It depends only on the relative position of the motor coils with respect to the magnets, and is independent of the motor current Reluctance force is developed due to the variation of self inductance of the windings, which causes a position dependent force in the direction of motion when current flows through the coils Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 79 P 0.06 Fo rce ripple (v) 0.04 0.02 0 -0.02 -0.04 -0.06 0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 P o sitio n (m ) Measurement of Force Ripple (X-axis) Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 80 Model of Ripple Forces The permanent magnets of the linear motor are identical and are equally spaced at a pitch of P : F r ( x1 + P ) = F r ( x1 ) It can be approximated quite accurately by the first several harmonics, which is denoted as Fr ( x1 ) and represented by F r ( x 1 ) = A rT S r ( x 1 ) where A r = [ A r1s , A r1c , S r ( x1 ) = [sin( , A rqs , A rqc ] T 2π 2π x1 ), cos( x1 ), P P , sin( 2π q 2π q x1 )] T x1 ), sin( P P and q is the numbers of harmonics used to approximate Fr ( x1 ) Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 81 ARC Controller Design Model M x 2 = u − Bx 2 − A f S ⇒ where f − A rT S r + d d = ( F fn − F fn ) + ( F r − F r ) + ∆ x1 = x 2 ⇒ θ 1x2 = u − θ 2 x2 − θ 3S f − θ T 4b ~ S r ( x1 ) + θ 5 + d y = x1 where θ1 = M , θ 2 = B, θ3 = Af , θ5 = dn, ~ d = d − dn θ 4b = Ar Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 82 Assumption and Control Objective Assumption: θ d • ∈ Ω θ = {θ : ∈ Ω d = {d : θ min < θ < θ max } | d | ≤ δ d ( x,t ) } Objective: Synthesize a control input u such that the output y track the reference motion trajectory yr as closely as possible yr(t) e(t) y t Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 83 ARC Controller Design Define a switching - function - like quantity as p = e + k1e = x 2 − x 2 eq , x 2 eq = y d − k1e where e = y − y d (t ) Error dynamics Mp = u + ϕ T θ + d where ϕ T = [ − x 2 eq , − x 2 , − S f ( x 2 ), − S r ( x1 ),1] x 2 eq = y d − k1e Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 84 ARC Controller Design (cont’d) ARC control law ua = −ϕ Tθˆ u = ua + u s , u s = u s1 + u s 2 , u s1 = − k 2 p Error dynamics Mp + k2 p = us 2 − ϕ Tθ + d Choose robust control us 2 such that where ε ( ) i ~ p us 2 − ϕ θ + d ≤ ε ii pu s 2 ≤ 0 T ~ is a design parameter Example us 2 = − 1 ( θ max − θ min ⋅ ϕ + δ d ) 2 p 4ε Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 85 Performance of ARC If the adaptation function τ is chosen as τ = ϕp , then the ARC control law guarantees that In general, all signal are bounded. Furthermore, the positive definite function Vs defined by Vs = is bounded by where 2 Vs ≤ exp( −λt )Vs (0) + λ = 2 k 2 θ 1 max p2(t) 1 Mp 2 ε [1 − exp( −λt )] λ upper bound of p2(t) p 2 (∞ ) ≤ p2(t) t Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 2ε λM 86 Performance of ARC (cont’d) • In addition, zero final tracking error is achieved in the presence of parametric uncertainties only ~ ) (i.e., d = 0 , ∀ t ≥ t 0 p2(t) upper bound of p2(t) p 2 (∞ ) = 0 t p2(t) Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 87 Implementation Issues Regressor ϕ has to be calculated on-line based on the actual measurement of the velocity x2 The effect of velocity measurement noise may be severe Slow adaptation rate has to be used Model compensation ua depends on the actual feedback of the state Creates certain interactions between the model compensation ua and the robust control u s Complicates the controller gain tuning process Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 88 Desired Compensation ARC (DCARC) DCARC control law u = ua + u s , ua = −ϕ d Tθˆ τ = ϕd p where ϕ d T = [ − y d , − y d , − S f ( y d ), − S r ( y d ),1] Error dynamics M p = u s − ϕ d T θ + (θ 1 k1 − θ 2 ) e + θ 3 [ S f ( y d ) − S f ( x 2 )] + θ 4Tb [ S r ( y d ) − S r ( x1 )] + d addition terms Notice that (applying Mean Value Theorem) S f ( y d ) − S f ( x2 ) = g f ( x2 , t )e, where g f ( x2 , t ) S r ( x1 ) − S r ( y d ) = g r ( x 2 , t ) e and g r ( x 2 , t ) are certain nonlinear functions Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 89 DCARC Controller Design (cont’d) Robust control function u s = u s1 + u s 2 , u s1 = − k s1 p where k s 1 is a nonlinear gain such that the matrix A defined below is p.d. k s1 − k 2 − θ 1 k 1 + θ 2 + θ 3 g f A = − 1 (k θ + k θ g − θ T g ) f r 1 2 1 3 4b 2 − 1 ( k 1θ 2 + k 1θ 3 g f − θ 4Tb g r 2 1 M k 13 2 ) For example k s1 ≥ k 2 + θ 1 k1 − θ 2 − θ 3 g f + Choose u s 2 such that i ii ( 1 T 2 ( θ k + θ k g + θ g ) 2 1 3 1 f 4b r 2θ 1 k13 ) ~ T ~ p us2 − ϕ d θ + d ≤ ε pu s 2 ≤ 0 Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 90 Performance of DCARC If the DCARC law is applied, then In general, all signal are bounded. Furthermore, the positive definite function Vs defined by Vs = is bounded by 1 1 2 Mp 2 + Mk 1 e 2 2 2 Vs ≤ exp( −λt )Vs (0) + where λ = min{ 2k 2 θ 1max , k1} ε [1 − exp( −λt )] λ In addition, zero final tracking error (i.e., asymptotic tracking) is achieved in the presence of parametric uncertainties only Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 91 Implementation of DCARC Adaptation Law Digital implementation of the adaptation law θ i min θˆi [( j + 1) ∆ T ] = θ i max Θ i if if θˆi = θˆimax θˆi = θˆimin and •>0 and •<0 otherwise where ( j +1 ) ∆ T ˆ Θ i = θ i ( j∆ T ) + γ i ∫ ϕ d ,i ( e + k1e ) dt j∆ T Velocity - free implementation of adaptation law ( j+1)∆T ( j+1)∆T ( j+1)∆T ˆ Θi =θi ( j∆T) +γ i k1∫ ϕd,iedt+ϕd,ie j∆T − ∫ ϕd,i (t)edt j∆T j∆T Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 92 X-Y Linear Motor Driven Positioning Stage Pentium II 400 MATLAB/Simulink Real-Time Workshlp Y-axis A/D,I/O MTRACE Real-Time Interface Complier A/D, D/A, Digital I/O PWM Amplifiers MLIB Main Processor Encoder Signals X-axis Encoder Interface Encoder Singals 5X multiplication DS1103 ControlDesk Hall Sensors Host PC Servo Controller X-Y Stage (Driven by two linear motors) Experimental Setup Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 94 Performance Indexes e M = max Transient Performance: Final Tracking Accuracy: e F = max {e (t ) } t [ t∈ T f − 2 , T f Average Tracking Performance: L 2 [ e ] = Average Control Input: Degree of Control Chattering: cu = ∑ L 2 [∆ u ] L 2 [u ] , L 2 [u ] = L 2 [∆ u ] = 1 N 1 Tf ∫ T 0 f ]{e ( t ) } 1 Tf ∫ T 0 f e 2 dt u (t ) dt 2 N ∑ u ( j ∆ T ) − u ( ( j − 1) ∆ T ) 2 j =1 Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 95 Comparative Experimental Results (Y-axis) PID with model compensation: u = θˆ1 (0) yd (t ) + θˆ2 (0) yd (t ) + θˆ3 (0) S f ( y ) − K p e − K i ∫ edt − K d e S f ( y) = 2 π arctan(900 y ), K p = 5.4 × 10 3 , K i = 5.4 × 10 5 , K d = 18 ARC: DRC: k1 = 400, k 2 = 32, θˆ (0) = [0.05,0.25,0.1,0]T Γ = diag [5,0,2,1000 ] • Same controller law with ARC but without parameter adaptation DCARC: k1 = 400, k2 = 32, θˆ(0) = [0.05,0.25,0.1,0]T Γ = diag[25,0,5,1000] Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 96 Tracking Sinusoidal Trajectory Set 1: To test the nominal tracking performance, the motors are run without payload Set 2: To test the performance robustness of the algorithms to parameter variations, a 20lb payload is mounted on the motor Set 3: A large step disturbance (a simulated 0.5V electrical signal) is added at about t=2.5s and removed at t=7.5s to test the performance robustness of each controller to disturbance Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 97 60 PID 40 20 0 -20 0 1 2 3 4 5 6 7 8 9 10 6 7 8 9 10 6 7 8 9 10 6 7 8 9 10 60 DRC (µ m) 40 20 0 -20 Tracking Erro r 0 1 2 3 4 5 60 ARC 40 20 0 -20 0 1 2 3 4 5 60 40 DCARC 20 0 -20 0 1 2 3 4 5 Time (sec) Tracking errors for yr=0.05sin(4t) without load (Y-axis) Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 98 50 0 PID -50 0 1 2 3 4 5 6 7 8 9 10 6 7 8 9 10 6 7 8 9 10 6 7 8 9 10 (µ m) 50 0 DRC -50 T racking Erro r 0 1 2 3 4 5 50 0 ARC -50 0 1 2 3 4 5 50 0 DCARC -50 0 1 2 3 4 5 Time (sec) Tracking errors for yr=0.05sin(4t) with 20lb load (Y-axis) Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 99 50 0 PID -50 0 1 2 3 4 5 6 7 8 9 10 6 7 8 9 10 6 7 8 9 10 6 7 8 9 10 (µ m) 50 0 DRC -50 T racking Erro r 0 1 2 3 4 5 50 0 ARC -50 0 1 2 3 4 5 50 0 DCARC -50 0 1 2 3 4 5 Time (sec) Tracking errors for yr=0.05sin(4t) with disturbance (Y-axis) Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 100 180 160 140 120 Set1 Set2 Set3 100 80 60 40 20 0 PID DRC ARC DCARC Transient Performance eM (Y-axis) Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 101 25 20 Set1 Set2 Set3 15 10 5 0 PID DRC ARC DCARC Final Tracking Accuracy eF (Y-axis) Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 102 0.45 0.4 0.35 0.3 Set1 Set2 Set3 0.25 0.2 0.15 0.1 0.05 0 PID DRC ARC DCARC Control Effort L2[u] (Y-axis) Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 103 0.9 0.8 0.7 0.6 Set1 Set2 Set3 0.5 0.4 0.3 0.2 0.1 0 PID DRC ARC DCARC Degree of Control Chattering Cu (Y-axis) Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 104 Positsion (m) 0.4 0.3 0.2 0.1 0 0 1 2 3 4 5 6 7 8 9 10 6 7 8 9 10 6 7 8 9 10 T ime (sec) Velocity (m/s) 1 0.5 0 -0.5 -1 0 1 2 3 4 5 Acceleration (m/s 2) T ime (sec) 10 5 0 -5 -10 0 1 2 3 4 5 T ime (sec) Point-to-Point Motion Trajectory Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 105 50 0 PID T racking E rro r (µ m) -50 0 1 2 3 4 5 6 7 8 9 10 6 7 8 9 10 6 7 8 9 10 50 0 DRC -50 0 1 2 3 4 5 50 0 DCARC -50 0 1 2 3 4 5 T ime (sec) Tracking errors for point-to-point trajectory (Y-axis) Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 106 Conclusion Unique Features of Nonlinear Adaptive Robust Control Strategy: • Nonlinear physical model based; easy to incorporate physical intuition into the controller design stage. • Address nonlinearities associated with linear motor dynamics directly. • Address parameter variations due to change of load, nominal value of disturbances, … • Effectively handle the effect of hard-to-model terms (e.g., uncompensated friction) • Achieve high performance through the use of learning techniques such as on-line parameter estimation. Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 107 Conclusion (cont’d) Comparative Experimental Results • Illustrate the above claims • The proposed schemes outperform a PID controller with model compensation significantly in terms of output tracking accuracy • Tracking errors for high-speed/high-acceleration movements are very small, even during transient period. Final tracking errors are mostly within measurement resolution level of 1µ m Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 108 Acknowledgements The project is supported in part by National Science Foundation -- CAREER grant CMS - 9734345 - - Program Manager: Dr. Alison Flatau Purdue Research Foundation Caterpillar Inc. Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 109 More Information can be downloaded from: http://widget.ecn.purdue.edu/~byao Copyright by Bin Yao, School of Mechanical Engineering, Purdue University 110