29.03.2013 Views

Introduction Overview of GKYP Lemma-Based Integrated Servo ...

Introduction Overview of GKYP Lemma-Based Integrated Servo ...

Introduction Overview of GKYP Lemma-Based Integrated Servo ...

SHOW MORE
SHOW LESS

You also want an ePaper? Increase the reach of your titles

YUMPU automatically turns print PDFs into web optimized ePapers that Google loves.

*Corresponding author: Chee Khiang Pang<br />

2012 ASME-ISPS /JSME-IIP Joint International Conference on<br />

Micromechatronics for Information and Precision Equipment<br />

MIPE2012<br />

June 18-20, 2012, Santa Clara, California, USA<br />

INTEGRATED SERVO-MECHANICAL DESIGN OF HIGH PERFORMANCE<br />

MECHANICAL SYSTEMS USING GENERALIZED KYP LEMMA<br />

Yan Zhi Tan 1 , Chee Khiang Pang 2 *, Fan Hong 3 , Tong Heng Lee 1,2<br />

1 NUS Graduate School for Integrative Sciences and Engineering, Singapore 117456<br />

E-mail: yanzhi@nus.edu.sg, eleleeth@nus.edu.sg<br />

2 Department <strong>of</strong> Electrical and Computer Engineering, National University <strong>of</strong> Singapore, Singapore 117576<br />

E-mail: justinpang@nus.edu.sg<br />

3 Data Storage Institute, A*STAR, 5 Engineering Drive 1 (Off Kent Ridge Crescent, NUS), Singapore 117608<br />

E-mail: HONG_Fan@dsi.a-star.edu.sg<br />

<strong>Introduction</strong><br />

Traditional R&D process for servo-mechanical design is a<br />

cyclical process that begins with the mechanical structure<br />

design, followed by the manufacturing and evaluation <strong>of</strong><br />

the prototype before the prototype is passed to control<br />

engineers for servo system design and analysis [3]. The<br />

two main problems associated with the traditional servomechanical<br />

design approach are first, the overall servomechanical<br />

system is not necessarily optimal as a result<br />

<strong>of</strong> designing the plant and the controller independently.<br />

Second, the performance specifications might not be met<br />

by the same controller for different batches <strong>of</strong> the same<br />

mechanical system. As such, it is generally difficult to<br />

satisfy the demanding performance specifications <strong>of</strong> a<br />

high-performance mechatronic control system solely<br />

through the design <strong>of</strong> an inexpensive and simple low<br />

order controller [4].<br />

In [1], an integrated system design by separation<br />

approach is proposed. Rather than optimizing the plant<br />

and the controller according to some objectives, this<br />

approach focuses primarily on designing a “good” plant<br />

with a finite frequency positive real (FFPR) inputdifferentiated<br />

output transfer characteristic by using the<br />

Generalized Kalman-Yakubovic-Popov (<strong>GKYP</strong>) <strong>Lemma</strong>.<br />

In this paper, a novel <strong>GKYP</strong> <strong>Lemma</strong>-based integrated<br />

servo-mechanical design algorithm is proposed for<br />

frequency domain design <strong>of</strong> a “good” plant according to a<br />

pre-designed low order controller and the performance<br />

specifications required <strong>of</strong> the overall servo-mechanical<br />

system. The proposed algorithm does not impose the<br />

FFPR condition and is carried out in discrete-time to<br />

prevent deterioration in performance with discretization<br />

<strong>of</strong> a continuous-time system.<br />

The following notations are used. I denotes an identity<br />

matrix <strong>of</strong> appropriate dimensions. For a matrix M, its<br />

376<br />

transpose and complex conjugate transpose are denoted<br />

by M T and M * , respectively, where M T and M * are<br />

matrices <strong>of</strong> appropriate dimensions.<br />

<strong>Overview</strong> <strong>of</strong> <strong>GKYP</strong> <strong>Lemma</strong>-<strong>Based</strong> <strong>Integrated</strong><br />

<strong>Servo</strong>-Mechanical Design<br />

A typical closed-loop configuration to regulate the output<br />

y <strong>of</strong> plant P(z) subjected to output disturbance w is shown<br />

in Fig. 1. C(z) represents the controller and u represents<br />

the plant’s input. The transfer function from w to z<br />

corresponds to the output sensitivity function.<br />

The <strong>GKYP</strong> <strong>Lemma</strong>-based algorithm for plant design with<br />

a pre-designed controller makes use <strong>of</strong> the sensitivity<br />

function because disturbance attenuation capabilities can<br />

be considered and well-known time domain determinants<br />

<strong>of</strong> the quality <strong>of</strong> a step response can be easily transformed<br />

into frequency domain specifications <strong>of</strong> the output<br />

w<br />

z Nominal plant P0 *<br />

Plant P(z)<br />

+<br />

y u<br />

+<br />

C*(z)<br />

C(z)<br />

y<br />

+ -<br />

0<br />

v<br />

C*(z) Estimator<br />

K<br />

Q(z)<br />

Fig.1: Output regulation configuration with Youla<br />

parameterization for plant design.<br />

e<br />

ˆx<br />

C c<br />

D c<br />

+ +<br />

û<br />

+<br />

-


sensitivity function [5]. The following lemma shows the<br />

application <strong>of</strong> the <strong>GKYP</strong> <strong>Lemma</strong> to the loop shaping <strong>of</strong><br />

the discrete-time sensitivity function [2].<br />

<strong>Lemma</strong> 1: Given sensitivity function S(z) = CS(zI-AS) -1 BS<br />

+DS with AS being stable. |S(e j )| r over a finite<br />

frequency range for a given scalar r > 0 if<br />

and only if there exist Hermitian matrices P and V 0<br />

such that<br />

* *<br />

A B 0 0<br />

S S A B S S C S<br />

*<br />

I 0<br />

<br />

I 0<br />

<br />

0 I<br />

<br />

D 0,<br />

S <br />

C D S S<br />

I <br />

<br />

where = -r 2 , = -1, and<br />

<br />

(1)<br />

P V<br />

<br />

*<br />

V P2cosRV .<br />

(2)<br />

<br />

Applying Schur’s complement to (1), = -r and = -r,<br />

and r becomes a variable to be optimized. In (2), the<br />

values <strong>of</strong> scalars R and depend on the frequency range<br />

considered and are shown in Table 1.<br />

Table 1: R and for Different Frequency Range<br />

l<br />

h<br />

l h<br />

R l ( )/ 2<br />

h l<br />

h <br />

1 j ( l h)/2<br />

<br />

e<br />

However, the plant design parameters are to be restricted<br />

to CS and DS <strong>of</strong> (1). To overcome this, Youla<br />

parameterization is required. The Youla parameterization<br />

for plant design is shown in Fig. 1. Its details will be<br />

explained along with the presentation <strong>of</strong> the steps for the<br />

proposed integrated servo-mechanical design algorithm in<br />

the next section.<br />

Design Algorithm<br />

Step 1: Design a low order controller C(z) with state<br />

space matrices denoted as (Ac, Bc, Cc, Dc) to compensate<br />

for the desired low frequency characteristics <strong>of</strong> the plant.<br />

Step 2: Compute the gain matrix L <strong>of</strong> C*(z) Estimator<br />

and feedback gain matrix K using MATLAB commands<br />

given by L = Acdlqe(Ac, Bc, Cc, I, I) and K = dlqr(Ac, Bc,<br />

Cc T Cc, I), respectively. C*(z) Estimator is an estimate <strong>of</strong><br />

C*(z) with w set to zero.<br />

Step 3: Formulate the equations given by<br />

-1<br />

377<br />

x A B<br />

Kx B B w <br />

<br />

k1c c k c c k<br />

,<br />

xˆ <br />

LC A<br />

<br />

xˆ <br />

LD B<br />

<br />

v<br />

<br />

k1 c E k c c k (3)<br />

z 0 1 1<br />

k Kxk<br />

wk ,<br />

e<br />

<br />

C C<br />

<br />

xˆ <br />

D 0<br />

<br />

v<br />

<br />

k c c k c k (4)<br />

where AE = Ac – BcK - LCc, and xk refers to the value <strong>of</strong> x<br />

at discrete time k. (3-4) denote the state space<br />

representation for the combination <strong>of</strong> C*(z) with the<br />

nominal plant P0*(z), and the inclusion <strong>of</strong> e and v.<br />

Step 4: Design Q(z) as an m th order Finite Impulse<br />

Response (FIR) filter given by<br />

0 A q <br />

0 I 0<br />

m1<br />

<br />

, B ,<br />

q<br />

0<br />

<br />

1<br />

<br />

(5)<br />

C q q ... q , D q , (6)<br />

<br />

q m m1 1 q 0<br />

where q is a vector <strong>of</strong> design parameters. Set q0 to zero so<br />

that the designed plant will not have direct feedthrough.<br />

Step 5: Let Twz represent the transfer function from w to z<br />

and obtain the state space matrices <strong>of</strong> the sensitivity<br />

function S = Twz + TvzQTwe given by<br />

Awz <br />

A 0 S <br />

<br />

0<br />

0<br />

At BC q t<br />

0 Bwz<br />

<br />

0<br />

<br />

, B B ,<br />

S t <br />

(7)<br />

A BD q q t<br />

CS Cwz D C q t C , q <br />

DS D D<br />

D , (8)<br />

wz q t<br />

where (Awz, Bwz, Cwz, Dwz) and (At, Bt, Ct, Dt) denote the<br />

state space matrices <strong>of</strong> Twz and TvzTwe , respectively.<br />

Step 6: Specify i constraints on the sensitivity function<br />

using i LMIs in the form <strong>of</strong> (1) to obtain values for the<br />

vector q.<br />

Step 7: Obtain state space matrices <strong>of</strong> the plant given by<br />

A<br />

p<br />

A LD K B C LDC<br />

E c c q c q<br />

<br />

BDKBCABDC ,<br />

(9)<br />

q c q c q q c q <br />

T<br />

B , , .<br />

p L B C K<br />

q C D D<br />

p q (10)<br />

p q<br />

Simulation Example<br />

In this section, the proposed integrated servo-mechanical<br />

design algorithm is applied to the design <strong>of</strong> a highperformance<br />

mechatronic system.<br />

Lead (Pb) Zirconate (Zr) Titanate (Ti) is a piezoelectric<br />

material commonly known as PZT. The frequency<br />

response <strong>of</strong> a PZT microactuator from a commercial 3.5”


Magnitude (dB)<br />

Phase (deg)<br />

Magnitude (dB)<br />

80<br />

60<br />

40<br />

20<br />

0<br />

-20<br />

180<br />

90<br />

0<br />

-90<br />

10 1<br />

-180<br />

10<br />

0<br />

-10<br />

-20<br />

-30<br />

-40<br />

10 1<br />

-50<br />

10 2<br />

10 2<br />

Frequency (Hz)<br />

10 3<br />

10 3<br />

Frequency (Hz)<br />

Original Plant<br />

Nominal Plant<br />

Designed Plant<br />

Lag Compensator<br />

Open Loop<br />

Fig.2: Bode plots <strong>of</strong> original plant, nominal plant,<br />

designed plant, lag compensator and open loop.<br />

Closed-loop w ith Nominal Plant<br />

Closed-loop w ith Designed Plant<br />

Fig.3: Comparison <strong>of</strong> sensitivity functions.<br />

dual-stage Hard Disk Drive (HDD) is measured and<br />

modeled as having two main high frequency resonant<br />

modes at 4.70 kHz and 13.5 kHz. A discrete-time first<br />

order lag compensator with a sampling frequency Fs <strong>of</strong> 40<br />

kHz is designed to produce an open loop bandwidth <strong>of</strong> 2<br />

kHz with the original plant. The Bode plots <strong>of</strong> the original<br />

plant model and the lag compensator are shown in Fig. 2.<br />

As the closed-loop system is unstable due to the 4.7 kHz<br />

resonant mode, the proposed algorithm is used to redesign<br />

the frequency response characteristics <strong>of</strong> the PZT<br />

microactuator. m is chosen to be 6, and the constraints are<br />

a) |S(f1)| -22 dB, 4.68 kHz f1 4.72 kHz,<br />

b) |S(f2)| -3 dB, 12.8 kHz f2 14.2 kHz,<br />

c) |S(f3)| r3, f3 2.6 kHz,<br />

d) |S(f4)| r4, 9.00 kHz f4 9.20 kHz, and<br />

e) |S(f5)| r5, 17.0 kHz f5 20.0 kHz,<br />

10 4<br />

10 4<br />

378<br />

where fi = iFs/2, and r3,4,5 are variables to be minimized.<br />

Constraints (a-b) shape the plant’s resonant modes so that<br />

noise and disturbances in those regions are attenuated by<br />

the closed-loop system, constraint (c) changes the closedloop<br />

bandwidth, and constraints (d-e) limit the sensitivity<br />

function’s gain beyond its 0 dB cross-over frequency.<br />

The sensitivity function <strong>of</strong> the closed-loop system with<br />

the designed plant is shown in Fig. 3. It is shaped from<br />

the sensitivity function <strong>of</strong> the closed-loop system with the<br />

nominal plant according to the constraints specified.<br />

The Bode plots <strong>of</strong> the first-order nominal plant and<br />

seventh-order designed plant are shown in Fig. 2. A high<br />

order plant is not an issue unlike a high order controller.<br />

The first resonant mode <strong>of</strong> the designed plant at 4.70 kHz<br />

has a phase <strong>of</strong> 3.46º while the second resonant mode at<br />

13.5 kHz has a phase <strong>of</strong> -363.67º. The Bode plot <strong>of</strong> the<br />

resulting open loop is also shown in Fig. 2. The open loop<br />

bandwidth is 1.5 kHz and its phase margin is 94º. The<br />

drop in bandwidth is due to zeros in that region. Finally,<br />

the resonant modes are phase stabilized [4] by the lag<br />

compensator despite being out-<strong>of</strong>-phase.<br />

Conclusion<br />

In this paper, a <strong>GKYP</strong> <strong>Lemma</strong>-based integrated servomechanical<br />

design algorithm has been proposed. The<br />

algorithm yields a plant design that can meet the<br />

performance specifications <strong>of</strong> the overall servomechanical<br />

system with a low order controller through<br />

loop shaping <strong>of</strong> the sensitivity function. Our future work<br />

includes the consideration <strong>of</strong> plant parameter pertubations<br />

in the design algorithm. With such a modification, a set <strong>of</strong><br />

plant designs that can meet the required closed-loop<br />

performance specifications with a low order controller<br />

will be obtained.<br />

References<br />

[1] T. Iwasaki, 1999, “<strong>Integrated</strong> System Design by<br />

Separation,” in Proceedings <strong>of</strong> the IEEE International<br />

Conference on Control Applications, 97-102.<br />

[2] T. Iwasaki and S. Hara, 2005, “Generalized KYP<br />

<strong>Lemma</strong>: Unified Frequency Domain Inequalities with<br />

Design Applications,” IEEE Trans. on Automatic<br />

Control, 50:41-59.<br />

[3] C. K. Pang, F. L. Lewis, T. H. Lee, and Z. Y. Dong,<br />

2011, Intelligent Diagnosis and Prognosis <strong>of</strong> Industrial<br />

Networked Systems, CRC Press, Taylor and Francis<br />

Group, Boca Raton, FL, USA.<br />

[4] T. Yamaguchi, M. Hirata, and C. K. Pang (eds.),<br />

2011, High-Speed Precision Motion Control. CRC press,<br />

Taylor and Francis Group, Boca Raton, FL, USA.<br />

[5] K. Zhou, J. C. Doyle, 1996, Essentials <strong>of</strong> Robust<br />

Control. Prentice Hall, New Jersey, USA.

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!