Control of Electromechanical Systems

Transcription

1 Control of Electromechanical Systems November 3, 27 Exercise Consider the feedback control scheme of the motor speed ω in Fig., where the torque actuation includes a time constant τ A =. s and a disturbance torque T L is present. The plant data are J = kg m 2 and B =. Nm/(rad/s).! d" + -! " C(s) - + " A s + Js + B T ref T em T L Figure : Speed control scheme. Design a control law C(s) in order to satisfy the following specifications. The closed-loop system is asymptotically stable. Constant torque disturbances are rejected at steady state. A reference acceleration profile ω d = 2 rad/s 2 is reproduced with a maximum error e = ω d ω smaller than. rad/s at steady state. In response to a constant reference ω d, the transient behavior of the error is sufficiently damped. Once a controller has been designed according to the previous specifications, determine the steadystate response of the closed-loop system to a ramp disturbance T L (t) =.5 t Nm. Exercise 2 Consider a system made of two inertias J > and M > connected through a transmission with torsional stiffness K > and in the presence of viscous friction acting on the two sides of the transmission, respectively with coefficients B > and D >. A control torque τ is applied to the first inertia, whose angular position and speed are θ and ω. The angular position and speed of the second inertia are θ m and ω m. The system is thus described by the following differential equations: θ = ω θ m = ω m J ω = τ Bω + K(θ m θ) M ω m = Dω m + K(θ θ m ). Determine the simplest feedback control law that is able to regulate the speed ω m of the inertia M to a desired constant reference value ω d. If the gain of the chosen controller is increased, will the closed-loop system become unstable? If so, which is the upper feasible limit for the control gain? If the chosen output ω m needs to track accurately a desired time-varying, sufficiently smooth profile ω d = ω d (t), what is the expression of the feedforward torque τ = τ ffw (t) that will guarantee zero tracking error in nominal conditions? What should be the initial state of the system (at time t = ) in order to obtain perfect tracking for all t? Draw a complete block diagram of the combined feedback/feedforward control scheme.

2 Exercise 3 (in alternative to Exercise 4) For the same plant of Exercise (with actuation dynamics), consider a PI controller with proportional action relocated in the feedback path. Draw the block diagram of the control scheme and study the asymptotic stability of the closed-loop system when varying separately the K P and K I gains. Whenever appropriate, use also a suitable root locus analysis. Exercise 4 (in alternative to Exercise 3, with an extra bonus if you do both) Consider the block diagram of the discrete-time control system in Fig. 4.3 of the textbook (drawn again in Fig. 2), in which W P (z) = T c J z and W SE (z) = z + 2z (averaging measurements of speed). Assume further that no disturbing torque T L acts on the system. With inertia J =. kg m 2, sampling time T c =.5 s, and integral gain K I =, study the stability of the closed-loop system by using a root locus analysis for varying K P >. Figure 2: Fig. 4.3, taken from the textbook. [8 minutes, open books] 2

3 Solution October 27, 27 Exercise The considered plant G(s) = = (Js + B)( + τ A s) = /B ( + (J/B)s)( + τ A s) /(Jτ A ) (s + (B/J))(s + (/τ A )) = (s +.)(s + ) () has gain K G = /B =, two asymptotically stable poles, a slow one in s = B/J =. and a fast one in s = /τ A =, and no zeros different equivalent representations are used in (). The open-loop response to a unitary step reaches the steady-state value very slowly (see Fig. 3). step response of the open loop plant omega [rad/s] time (seconds) Figure 3: Step response of the open-loop plant (). To satisfy the steady-state requirement on the input-output behavior (control system of type, with limited steady-state error in response to a ramp reference input) and on the disturbanceoutput behavior (astatism, i.e., rejection of constant disturbances), the controller should introduce a pole in s = (integral action). In order to have additional parameters left for control synthesis, a PI controller will be considered in the first place, P I(s) = K P + K I s = K P s + K I s = K I + τ z s s s + (/τ z ) = K P, (2) s with control gain K I >, integral action, and a negative zero with time constant τ z = K P /K I >. In (2), different equivalent forms are presented for the PI controller. With the loop transfer function F (s) = P I(s)G(s), the closed-loop system becomes W (s) = ω(s) ω d (s) = F (s) + F (s) = K I ( + τ z s) s(js + B)( + τ A s) + K I ( + τ z s). (3) On the other hand, the error transfer function in the closed loop is W e (s) = e(s) ω d (s) = ω d(s) ω(s) s(js + B)( + τ A s) = W (s) = ω d (s) s(js + B)( + τ A s) + K I ( + τ z s). (4) 3

4 The asymptotic stability of W (s) in (3) can be checked by using the Routh criterion on the thirddegree polynomial at the denominator. The Routh table is: 3 Jτ A B + K I τ z 2 J + Bτ A K I (J + Bτ A )(B + K I τ z ) K I Jτ A K I Being always J >, B >, and τ A >, the necessary and sufficient conditions for asymptotic stability are K I >, K I (Jτ A τ z (J + Bτ A )) < B(J + Bτ A ). (5) Assuming that both inequalities (5) are satisfied, the steady-state error of our type control system to a ramp velocity reference (with rate 2 rad/s 2 ) will be constant but different from zero. It can be computed using (4) and the final value theorem as Therefore, e = lim t e(t) = lim s s W e (s) 2 s 2 = 2 lim s (Js + B)( + τ A s) s(js + B)( + τ A s) + K I ( + τ z s) = 2B. (6) K I e. K I 2B. =.2 = 2. (7). We verify next if and how a sufficiently damped transient behavior can be obtained with the PI controller (2), under the constraint (7). A convenient choice is to proceed by (stable) pole-zero cancelation, removing the slow dynamics of the plant with the zero of the PI law. Setting in (2) τ z = J B = F (s) = K P /(Jτ A ) s(s + (/τ A )) W (s) = K P /(Jτ A ) s(s + (/τ A )) + K P /(Jτ A ), (8) the closed-loop system is reduced to a second-order, asymptotically stable dynamics with gain W () =, without zeros, and with two poles in s and s 2 : ( s 2 + s + K P = s,2 = ± ) 2 4K P = 5 ± 4KP. (9) τ A Jτ A 2τ A 2 Jτ A 2 The choice τ z = in (8) implies K P = K I and, from (7), also K P 2. Therefore, the two poles in (9) will be complex conjugate. Moreover, their natural frequency will increase and their damping uniformly decrease when taking larger values of K P. Thus, we should choose the minimum value that satisfies also the steady-state condition, i.e., K P = 2. The final PI law is yielding τ A P I(s) = K P + K I s = s s +. = 2, () s s,2 = 5 ± j3.22 ω n = 4.4, ζ =.35. () Note that we could get to the same result by looking at the simple root locus of the denominator of W (s) in (8) when varying K = K P /(Jτ A ) >, i.e., by changing the gain K P in the PI controller. In practice, the obtained damping coefficient ζ =.35 is the best that can be obtained when using only a PI control design. Such damping may be considered adequate when looking at the step response in Fig. 4: the overshoot is about 3%, with only few oscillations, whereas the rise time is t r.5 s. The associated control effort T ref (t) reported in Fig. 4 has a peak value of 2 at t =, 4

5 .4 step response with PI control.2 omega [rad/s] time (seconds) Figure 4: Step response for the closed-loop system obtained with the PI control law (). 2 control effort with PI control 5 input command time (seconds) Figure 5: Control effort during the step response of Fig ramp response with PI control 2 omega [rad/s] t (seconds) Figure 6: Response to a ramp input ω d (t) = 2t for the same controlled system as in Fig. 4. 5

6 still moderate. The response to a ramp input ω d (t) = 2t is shown in Fig. 6: the steady-state error is e =., as predicted. Finally, with the chosen PI controller (), we obtain the following disturbance-output transfer function for the closed-loop system: W dist (s) = ω(s) T L (s) = s( + τ A s) s(js + B)( + τ A s) + K I ( + τ z s). (2) Therefore, the steady-state response to a ramp disturbance T L (t) =.5 t [Nm] is computed as e L = lim s s W dist (s).5 s 2 =.5 lim s ( + τ A s) s(js + B)( + τ A s) + K I ( + τ z s) =.5 K I =.25. (3) Wishing to increase the damping characteristics of the closed-response, we should add a further action in the form of a lead compensator (made by a zero preceding a pole in the frequency domain, with unitary gain). A simple design choice is to cancel also the other pole of the plant with the zero of this additional compensator, replacing it with a pole that has a smaller time constant, say reduced by a factor of 5: ( C(s) = K P + K ) ( I + τa s s +.2τ A s = ) +.s s +.2s. (4) This would lead to F (s) = C(s)P (s) = 5K P /(Jτ A ) s(s + (5/τ A )) W (s) = 5K P /(Jτ A ) s(s + (5/τ A )) + 5K P /(Jτ A ), (5) with the closed-loop poles moved to ( s,2 = 5 ± 5 2τ A 2 τ A ) 2 2K P. = 25 ± 25 2KP, (6) Jτ A 2 For the same K P = 2, two complex poles are obtained with an associated response that is now (slightly more than) critically damped: s,2 = 25 ± 2 5 = 25 ± j9.36 ωn = 3.62, ζ =.79. (7) Figure 7 shows the output of the closed-loop system in response to a unitary step. The rise time has been reduced to t r =.25 s, whereas overshoot and oscillations are now practically absent. The largely improved transient behavior of the controlled output is indeed counterbalanced by a larger control effort during the first few instants of the response, with a peak of at t = see Fig. 8). In Fig. 9, the response to a ramp input ω d (t) = 2t shows the same previous steady-state error e =., but a faster transient behavior. 6

7 .4 step response with PI + lead control.2 omega [rad/s] time (seconds) Figure 7: Step response for the closed-loop system obtained with the control law (4). control effort with PI + lead control 8 6 input command time (seconds) Figure 8: Control effort during the step response of Fig ramp response with PI + lead control 2 omega [rad/s] time (seconds) Figure 9: Response to a ramp input ω d (t) = 2t for the modified closed-loop system. 7

8 Exercise 2 We start by deriving the input-output transfer function between the torque τ and the angular speed ω m of the body with inertia M. Applying Laplace transform to the system equations gives ( Js 2 + Bs + K ) θ(s) = Kθ m (s) + τ(s) (8) ( Ms 2 + Ds + K ) θ m (s) = Kθ(s). (9) Solving (9) for θ(s) and replacing in (8) yields ( Js 2 + Bs + K ) ( Ms 2 + Ds + K ) and thus K θ m (s) = Kθ m (s) + τ(s), P (s) = θ m(s) τ(s) = K (JM)s 4 + (BM + DJ)s 3 + (K(J + M) + BD)s 2 + K(B + D)s [+K 2 K 2 ]. (2) Equation (2) considers the angular position as output. Noting the presence of a pole in s =, the transfer function of our interest is obtained as P (s) = ω m(s) τ(s) = sp (s) = K (JM)s 3 + (BM + DJ)s 2 + (K(J + M) + BD)s + K(B + D), (2) i.e., a system with third-order dynamics (but no integral action) and without zeros. Using Routh criterion, it is easy to verify that the open-loop system (2) is asymptotically stable for all physically valid parameters J >, M >, K >, and with B, D, but not both simultaneously zero (or anyway too small). In fact, the stated assumption is that B and D are both strictly positive. The request of output regulation (i.e., zero error at steady state) for any desired constant reference velocity ω d asks for the inclusion of an integrator in the controller (type control system). As a feedback law of minimum complexity, we will show next that a PI controller P I(s) = K P + K I s = K P s + (/T I ), with T I = K I /K P, (22) s where K P > and K I > (and thus, with a positive integration time T I > ) is able to achieve also asymptotic stability of the closed-loop system. Our analysis will be mainly qualitative, based on a simple root locus. If desired, the actual conditions for asymptotic stability in terms of the original parametric data of the plant can be derived from the Routh criterion. To proceed, consider only the loop transfer function F (s) = P I(s)P (s) = KK P (s + (/T I )) JMs 4 + (BM + DJ)s 3 + (K(J + M) + BD)s 2 + K(B + D)s = KK P JM ( s s 3 + BM + DJ JM s2 + = K s + (/T I ) s(s + a)(s 2 + bs + c). s + (/T I ) K(J + M) + BD s + JM ) K(B + D) JM (23) In the last expression, we have a >, b >, and c >, since the plant has been assumed asymptotically stable. Moreover, apart from the pole in s = introduced by the PI controller, 8

9 at least one pole should be real and negative, i.e., in a. On the other hand, the two roots of s 2 + bs + c = can be either complex conjugate or both real, possibly also coincident (in any case, always with negative real part). As a consequence, we can design the zero of the PI controller so as to cancel one real pole of the plant, or a T I = a K I K P = F (s) = K s(s 2 + bs + c) W (s) = F (s) + F (s) = K s(s 2 + bs + c) + K. (24) The root locus for K > takes one of the two possible forms shown in Fig., depending on the presence or not of a pair of complex conjugate poles in F (s). The overall behavior is anyway similar, with an upper bound K max for K that preserves asymptotic stability of the closes-loop system. s = s!" K max K max s = 2 Re(s )/3 Re(s ) s!!" s = s = s!"!"!" s = s s = 2 s!!" s = s * K max s =(s +s 2 )/3 K max Figure : The two possible root loci of interest for K >, depending on whether F (s) in (24) has one real and two complex poles [left] or three real poles [right]. The actual upper limit K P,max for K P can be found (still in symbolic form) from the Routh table associated to the denominator of W (s) in (24): 3 c 2 b K bc K b K Being b > and c >, the necessary and sufficient conditions for asymptotic stability are < K < K max = b c K P,max = JM b c K. (25) This implies also an upper limit on the actual gain K I = K P T I of P I(s). Indeed, when increasing the proportional gain K P up to its limit, also the integral gain K I should be increased similarly, so that their ratio (i.e., T I ) remains constant and equal to /a (to preserve the cancelation of a pole of the plant by the zero of the PI controller). For the generation of a feedforward torque τ ffw (t) associated to a desired (smooth) trajectory ω d (t) 9

10 for the chosen system output, consider again the differential equations We first isolate θ from eq. (27), and then differentiate (28) twice We isolate next τ from eq. (26), J ω = τ Bω + K(θ m θ) (26) M ω m = Dω m + K(θ θ m ). (27) θ = θ m + K (M ω m + Dω m ), (28) ω = ω m + K (M ω m + D ω m ), (29) ω = ω m + K (M... ω m + D ω m ). (3) τ = J ω + Bω + K(θ θ m ), (3) and substitute then in (3) both (29) and (3), as well as K(θ θ m ) from (27). This yields τ = J ω m + JK (M... ω m + D ω m ) + Bω m + BK (M ω m + D ω m ) + (M ω m + Dω m ). (32) Substituting in (32) ω m = ω d (t), together with its three time derivatives ω m = ω d (t), ω m = ω d (t), and... ω m =... ω d (t), and reorganizing terms leads to the nominal command τ ffw (t) = (B + D) ω d (t) + ( J + M + K BD ) ω d (t) + K (JD + MB) ω d (t) + K JM... ω d (t), (33) where we have assumed that all estimated parameters are the true ones (Ĵ = J, ˆM = M, ˆB = B, ˆD = D, and ˆK = K). From (33), the required smoothness of the desired trajectory is ω d (t) C 3. " d, " d, " d reference generator " ffw " d + - PI(s) + " " fb + P(s) " Figure : Combined feedback/feedforward control scheme for the given two-mass/spring system. Indeed, the same result could have been obtained in a simpler fashion by just inverting the plant (2) in the Laplace domain, τ ffw (s) = P (s)ω d (s). However, the time domain analysis helps in finding also the correct initial conditions which guarantee that the feedforward command τ ffw (t) achieves perfect tracking of ω d (t) right from the initial instant t =, For this, the initial state of the system has to be matched with the initial value of the trajectory and its first few derivatives. In particular, the following conditions should hold: θ() θ m () = K (M ω d () + Dω d ()), ω() = ω d () + K (M ω d () + D ω d ()), ω m () = ω d (). Note that only the relative angular position of the two bodies with inertia J and M is constrained at t =. Being the desired trajectory specified at the velocity level, the absolute angular position of one of the two bodies is completely free. The block diagram of the combined feedback/feedforward control scheme is drawn in Fig.. (34)

11 Exercise 3 Figure 2 shows the requested control scheme. Splitting the single feedback path in two successive loops, and resolving the internal one first, leads to a final closed-loop transfer function W (s) = ω(s) ω d (s) = K I s ( (Js + B)( + τ A s) + K P ) + KI = which is characterized by the absence of zeros. K I Jτ A s 3 + (J + Bτ A )s 2 + (B + K P )s + K I,! d" + K I +! " - s - + " A s Js + B (35) K P Figure 2: PI control scheme for the plant in Exercise, with proportional action relocated in the feedback path. To study the asymptotic stability of W (s), we construct the Routh table 3 Jτ A B + K P 2 J + Bτ A K I (J + Bτ A )(B + K P ) K I Jτ A K I Being J >, B >, and τ A >, and assuming K P > (although this is not strictly necessary), we have asymptotic stability when K P >, < K I < (J + Bτ A)(B + K P ) Jτ A = K I,max. (36) This means in particular that by arbitrarily increasing K P >, we can also arbitrarily increase the value of K I > without losing asymptotic stability. Replacing now the original data from Exercise, we obtain K P >, < K I <. + K P.. (37) On the other hand, if we fix one gain and let the other vary, a graphical analysis can be performed with the help of a suitable root locus. The simpler case is to fix K P > in the denominator of W (s) and have K I > vary. Rewriting ( den W (s) = d (s)+k n (s), with d (s) = s s 2 + J + Bτ A s + K P + B Jτ A Jτ A ), K = K I Jτ A, n (s) =, (38) a root locus can drawn as a function of K > by considering as zeros of F (s) the roots of n (s) (i.e., no zeros) and as poles of F (s) the three roots of d (s). It is easy to see that this is exactly the situation already encountered in Exercise 2, with the W (s) defined in (24). Therefore, one can use the same qualitative root loci of Fig. to conclude that there will be asymptotic stability

12 for increasing K I until reaching an upper bound. This upper bound is indeed exactly the K I,max defined in (36). When we fix instead K I > in the denominator of W (s) and let K P > vary, we can rewrite den W (s) = d 2 (s) + K 2n 2 (s), with d 2 (s) = s 3 + J + Bτ A s 2 + B s + K I, K 2 = K P, n 2 (s) = s. Jτ A Jτ A Jτ A Jτ A (39) The associated root locus (taking in those cases the more general name of root contour) can be generated with the same rules of the first case. Figure 3 shows two situations in which two out of the three poles of d 2 (s) are complex conjugate (other situations may occur as well, and can be treated similarly). When analyzing the first column of the Routh table of d 2 (s), two subcases are possible: < K I < B(J + Bτ A) Jτ A all three roots have negative real parts; (4) K I B(J + Bτ A) Jτ A two (complex) roots have positive real parts, (4) the remaining one is real and negative. In the first subcase (4), shown on the left of Fig. 3, K 2 and thus K P can be arbitrarily increased without a loss of asymptotic stability. In the second subcase (4), shown on the right of Fig. 3, there is a lower bound K 2,min on K 2 (i.e., on K P ) that should be overcome before obtaining asymptotic stability. This analysis especially the guarantee that the center s of the asymptotic directions of the positive locus (which are vertical for a pole-zero excess = 2) is always negative is indeed in accordance with the conditions for asymptotic stability stated in (36). K 2,min s = s!"!" s = s s = s 2!" s <! " s z = s = s 2!" s <! " s z = s = s *!"!" s = s * K 2,min Figure 3: The two possible root contours for K 2 >, depending on whether the complex poles of d 2 (s) in (39) have their real part negative [left] or positive [right]. 2

13 Exercise 4 We manipulate the block diagram in Fig. 2 in order to obtain the discrete-time transfer function of the closed-loop system. With reference to Fig. 4, we split the feedback path in two and resolve the inner loop gives first W (z) = T c J z + K P z + 2z Tc J z! d" + K I z + T c! " - z " - J z " K P z + 2z = 2T c z 2J z(z ) + K P T c (z + ). (42) W (z) z + 2z Figure 4: Unwrapping the two loops of Fig. 2. Next, we resolve also the outer loop and obtain finally W (z) = W (z) KIz z + W (z) KIz z z + 2z = + 2T c z 2J z(z ) + K P T c (z + ) KIz z 2T c z 2J z(z ) + K P T c (z + ) KIz z z + 2z (43) = 2K I T c z 2 2J z(z ) 2 + K P T c (z + )(z ) + K I T c (z + ). In view of the request of a parametric study of the asymptotic stability by means of a root locus, we divide numerator and denominator by 2J (to make unitary the coefficient of the highest power at the denominator) and insert the numerical data of the problem (J =. kg m 2, T c =.5 s, and K I = ). This leads to W (z) =. z 2 z(z 2.95z +.5) +.5K P (z + )(z ) =. z 2 d(z) + K n(z). (44) The three roots of d(z) = are in {,.975 ± j.352} and the complex roots are outside the unit circle (on a circle of radius r =.247). Figure 5 shows the root locus traced with MATLAB for K =.5K P >. The system is asymptotically stable when all three roots belong to the unit circle. This happens in the gain interval K [.264,.9486] K P [.5272, ] = [K P,min, K P,max ]. (45) 3

14 Root Locus Real Axis (seconds ) Figure 5: The root locus associated to K >, n(z), and d(z), as defined in (44). The unit circle in the z-plane is also shown (in orange). The location of the poles of W (z) in (44) corresponding to the stability boundaries are K P,min =.5272 z = {.264,.9486 ± j.363} with distance to the origin of the complex pair =.264; K P,max = z = {.9486,.264 ± j.9996} with distance to the origin of the complex pair = (46) Figure 6 shows the discrete-time step response of W (z) in (44) obtained for K P =, i.e., of W (z) =. z 2 z 3.45z 2 +.5z.5. (47) step response of the discrete time system for KP = omega [rad/s] time (seconds) Figure 6: Discrete-time step response of W (z) in (47) (T c =.5 s). 4