DISCRETE TYPE REPETITION CONTROL METHOD AND APPARATUS THEREFOR

Abstract: A discrete type repetition control apparatus is capable of stably controlling the repetition even when the status variables of the object to be controlled are not observable, and is provided with time delay elements (Z⁻¹) of a number greater than a value that is obtained by dividing the period of a period target input by a sampling period of deviation between the period target input and the output of the object being controlled. To each time delay element is periodically applied the sum of a product of the deviation and a first gain (h1, ---, hn) related to each of the elements, a product of an input (u(k)) to the object being controlled and a second gain (m1, ---, ,mn) related to each of the time delay elements, and outputs (Wn(k + n), ---, W1(k + 1)) of elements of the preceding stage. The control apparatus periodically applies to the object being controlled the sum (u(k)) of a product of the deviation and a third gain (h0) and the output (W1(k)) of a time delay element of the side of the object being controlled, in order to stably operate the object being controlled maintaining flexibility for a change in the period of the target input without inviting follow-up delay for the target input that periodically changes in a single pattern of change.

Description: Technical Field The present invention relates to repetitive control for causing a controlled object to conduct a repetitive action in response to a cyclic target input, and more particularly, to a discrete-type repetitive control method and an apparatus therefor, having an excellent response to a cyclic target input and excellent flexibility to a variation in the cycle period of a target input. Background Art Conventionally, it has been known to control a controlled object in a manner causing the object to repeat a single patterned action, by the use of a discrete-type repetitive control system which is constituted in accordance with an internal model principle and adapted to receive a cyclic target input which changes in a single changing pattern periodically repeated. According to the internal model principle, it is possible to cause an output of the controlled object to follow a target input with no steady deviation, by incorporating a target input generation model in a closed loop of the control system. Conventionally, in view of the internal model principle, a discrete-type repetitive control system has been so designed as to stabilize an extended system which is configured by connecting a compensator, including the target input generation model, to the controlled object. In this case, a cyclic target input generation model represented by 1/(Z L -1) is employed, in view of equation (3) obtained by substituting equation (2) into a Z transform Yr(Z) of a cyclic target input y(t) represented by equation (1). In equations (1) - (3), symbols Z -i (i = 1, 2, ---, L, 2L, ---) each represent a time delay element, and symbol L represents the cycle of the cyclic target input. Yr(Z) = r0 + r1Z⁻¹ + --- + r L-1 Z L-1 + (r0 + r1Z⁻¹ + --- + r L-1 Z L-1 ) Z -L + (r0 +r1Z⁻¹ + --- + r L-1 Z L-1 ) Z -2L + --- Yr0(Z) = r0 + r1Z⁻¹ + --- + r L-1 Z L-1 Yr(Z) = Z L ·Yr0(Z)/(Z L - 1) Namely, as shown in Fig. 1, the conventional discrete-type repetitive control system accommodates therein an internal model 1/(Z L - 1) which is comprised of L′ time delay elements Z⁻¹. The number L′ of the time delay elements Z⁻¹ is equal to a value obtained by dividing the cycle period L of the cyclic target input by a sampling cycle period τ of the cyclic target input in the control system. In Fig. 1, symbol yr(i) represents the cyclic target input; u(i), an input to the controlled object; and y(i), an output of the controlled object. Symbol x(i) indicates a state variable of the controlled object; and e(i), a deviation between the output y(i) of the controlled object and the cyclic target input yr(i). Further, symbol h represents a feedback gain element having a properly selected gain, and K1 - KL indicate gain compensators having properly selected gains. According to the repetitive control system, a stable control system is provided. However, if the state variable x (i) cannot be observed directly, then the repetitive control system shown in Fig. 1 cannot be configured. Further, according to the control system, the number L′ of the time delay elements Z⁻¹ must be equal to the value obtained by dividing the cycle L of the target input by the sampling cycle τ. Therefore, the conventional repetitive control system lacks flexibility to a variation in the cycle period of a target input. Disclosure of the Invention An object of the present invention is to provide a discrete-type repetitive control method and an apparatus therefor, which enable stable repetitive control even if a state variable of a controlled object is not observable, and which have an excellent response to a cyclic target input and excellent flexibility to a variation in the cycle period of a target input. To achieve the aforementioned object, according to one aspect of the present invention, a discrete-type repetitive control method comprises the steps of: (a) periodically applying, to each of time delay elements which are equal to or greater in number than a value obtained by dividing a cycle period of a cyclic target input by a cycle period of sampling a deviation between an output of a controlled object and the cyclic target input, a sum of a product of the deviation periodically sampled and a first gain associated with the time delay element, a product of an input to the controlled object and a second gain associated with the time delay element, and an output of a preceding time delay element; and (b) periodically applying, to the controlled object, a sum of a product of the periodically sampled deviation and a third gain, and an output of a time delay element disposed on a side of the controlled object. According to another aspect of the present invention, a discrete-type repetitive control unit comprises: (a) time delay elements which are equal to or greater in number than a value obtained by dividing a cycle period of a cyclic target input by a cycle period of sampling a deviation between an output of a controlled object and the cyclic target input, the time delay elements being connected in series with each other; (b) first gain elements each disposed on an input side of a corresponding one of the time delay elements; (c) first adder elements each interposed between a corresponding one of the time delay elements and a corresponding one of the first gain elements; (d) second gain elements each interposed between an input side of the controlled object and a corresponding one of the first adder elements; (e) a second adder element interposed between the input side of the controlled object and a last time delay element connected thereto; and (f) a third gain element disposed on an input side of the second adder element. As described above, according to the present invention, there are provided time delay elements which are equal to or greater in number than the value obtained by dividing the cycle period of the cyclic target input by the sampling period of the deviation between the controlled object output and the cyclic target input. Each time delay element is periodically applied with the sum of the product of a periodically sampled deviation and the first gain associated with each time delay element, the product of an input to the controlled object and the second gain associated with each time delay element, and an output of the preceding time delay element. Further, the sum of the product of the periodically sampled deviation and the third gain, and an output of the time delay element disposed on the controlled object side is periodically applied to the controlled object. Unlike the conventional repetitive control wherein the input to the controlled object is changed in accordance with the state variable of the controlled object, according to the present invention, it is possible to perform repetitive control without the need of using the state variable of the controlled object. Thus, stable repetitive control of the controlled object can be achieved even if the state variable of the controlled object is not observable directly. Since the input to the controlled object is generated on the basis of the deviation periodically sampled, a response delay, generated in a repetitive control system and the controlled object, to the cyclic target input can be reduced. Furthermore, it is not inevitably necessary to provide the repetitive control system with the time delay elements Z⁻¹ whose number is just equal to the value obtained by dividing the cycle period of the cyclic target input by the sampling cycle of the deviation, as long as the number of the elements is equal to or greater than the aforementioned value. Thus, the repetitive control system is excellent in flexibility to a variation in the cycle period of the cyclic target input. Brief Description of the Drawings Fig. 1 is a block diagram exemplarily showing a conventional repetitive control system; Fig. 2 is a block diagram showing an extended system consisting of a controlled object and time delay elements, for illustration of a process of deriving a feedback control rule of the repetitive control method according to an embodiment of the present invention; Fig. 3 is a block diagram showing an apparatus, obtained during the course of deriving the feedback control rule, for embodying the feedback control rule; and Fig. 4 is a block diagram showing a series compensator for embodying the feedback control rule according to an embodiment of the present invention. Best Mode of Carrying Out of the Invention In the following, a process of deriving a feedback control rule for embodying a repetitive control method, according to an embodiment of the present invention, will be explained. At first, a feedback control rule in the extended system shown in Fig. 2 and consisting of a controlled object and n time delay elements Z⁻¹ connected thereto will be determined. Referring to Fig. 2, a cyclic target input u(iτ) is applied at intervals of a cycle period T to the input side of the extended system, and the target input u(iτ) is sampled at intervals of a sampling period τ. Symbol iτ (i = 0, 1, 2, ---, k+n, ---) each indicate a sampling point. The cyclic target input u(iτ) changes in a single changing pattern (not shown), and the changing pattern is repeated at intervals of a cycle period T. The total number n of the time delay elements Z⁻¹ is equal to or greater than a value obtained by dividing the period T of the target input u(iτ) by the sampling period τ. Preferably, the element number is equal to an integer obtained by counting fractions of decimals of the resultant value of division as a whole number. An output side of each of the n time delay elements Z⁻¹ is connected to the input side of the next time delay element Z⁻¹, and the output side of the n-th time delay element Z⁻¹ is connected to the input side of a controlled object 1. The controlled object 1, which is a robot, machining tool or the like, includes gain elements A, B, and C whose gains are A, B, and C, respectively, and a time delay element Z⁻¹. The output of the time delay element Z⁻¹, indicative of a state variable x of the controlled object 1, is applied to the input side of the time delay element Z⁻¹ through the gain element A. The state variable x(k+1) of the controlled object 1 at a given sampling point k+n+1 is represented by equation (4), i.e., by the state variable x(k) at the preceding sampling point k+n, the input u(k) to the controlled object 1, and the gains A and B. Further, an output y(k) of the controlled object 1 is represented by equation 15), i.e., by the state variable x(k) and the gain C. x(k+1) = Ax(k) + Bu(k) y(k) = Cx(k) From equation (4) and equalities of u(k+1) = u(k+1), ---, u(k+n) = u(k+n), we obtain equation (6) indicative of the feedback control rule in the extended system shown in Fig. 2. In equation (6), symbols A, B, and x indicate matrixes. From equations (4) and (5), we obtain the following n+1 equations. y(k) = C x(k) y(k+1) = C x(k+1) = C A x(k) + C B u(k) y(k+2) = C x(k+2) = CA² x(k) + C A B u(k) + C B u(k+1) : : y(k+n) = C x(k+n) = C A n x(k) + C A n-1 B u(k) + C n-2 B u(k+1) + --- + C B u(k+n-1) From the n+1 equations given above, we obtain equation (7). Assuming that there is a matrix H(hn --- h0) which satisfies equation (8) given below, the feedback control rule represented by equation (6) may be modified as shown in equation (9). The feedback control rule represented by the equation (9) does not include the state variable x of the controlled object 1. The feedback control rule can be executed by the control unit shown in Fig. 3. In Fig. 3, symbol u(k+n) indicates a cyclic target input sampled at a sampling point k+n. Symbol u(k) indicates an input to the controlled object 1 (Fig. 2) at a sampling point k+n, and symbol -y(k) indicates an output of the controlled object 1. Symbols h0 - hn and m1 - mn respectively indicate the gains of the gain elements shown by blocks, and Wi(k+n) each indicate an output of the i-th (i = 1, 2, ---, n) adder element illustrated. In view of Fig. 3, the following n equations are fulfilled. Wn(k+n) = mn u(k) - hn y(k) Wn-1(k+n) = mn-1 u(k+1) - hn-1 y(k+1) + Wn(k+n) : : W2(k+n) = m2 u(k+n-2) - h2 y(k+n-2) + W3(k+n) W1(k+n) = m1 u(k+n-1) - h1 y(k+n-1) + W2(k+n) By adding equation (10 - 1) to equation (10 - n), we obtain equation (11). W1(k+n) = mn u(k) + mn-1 u(k+1) + --- + m1 u(k+n-1) - hn y(k) - . . . - h1 y(k+n-1) = u(k+n) + h0 y(k+n) From equation (11), we obtain u(k+n) = W1(k+n) - h0 y(k+n). u(k) = W1(k) - h0 y(k) By substituting k+n-1, ---, k+3, k+2, and k+1 for the variable k+n indicative of a sampling point and contained in equation (10 - 2) to equation (10 - n), we obtain equation (14 - 2) to equation (14 - n). Meanwhile, equation (10 - 1) is shown again. Wn(k+n) = mn u(k) - hn y(k) Wn-1(k+n-1) = mn-1 u(k) - hn-1 y(k) + Wn(k+n-1) : : W2(k+2) = m2u(k) - h2y(k) + W3 (k+2) W1(k+1) = m1 u(k) - h1 y(k) + W2(k+1) The feedback control rule for embodying the discrete-type repetitive control method of this embodiment is represented by the foregoing equations (10-1), (12), (13), and (14-2) to (14-n). A series compensator corresponding to this feedback control rule is shown in Fig. 4. In the case of embodying the repetitive control of the embodiment by the use of the series compensator, the deviation yr(k) - y(k) between the cyclic target input yr(k) (Fig. 1) and the output y(k) of the controlled object (Fig. 2) is applied, in place of the input -y(k) shown in Fig. 4, to the series compensator. In other words, the discrete-type repetitive control unit for embodying the repetitive control method of the embodiment comprises the series compensator of Fig. 4. If necessary, the control unit also includes a sampling circuit (e.g., a sample-and-hold circuit), represented by the junction (Fig. 4) of a -y(k) signal input line and a gain element hj, for periodically sampling the deviation between the output of the controlled object and the cyclic target input. If the sampling circuit is provided outside the control unit, or if a quantized deviation is periodically applied to the control unit, then it is unnecessary to provide the sampling circuit inside the control unit. Meanwhile, the repetitive control unit may be configured by a digital unit, e.g., a digital controller, for achieving the functions of the series compensator of Fig. 4. Further explanations will be given with reference to Fig. 4. The repetitive control unit comprises time delay elements Z⁻¹ connected in series with each other. These time delay elements are provided by that number which is equal to or greater than a value obtained by dividing the cycle period of the cyclic target input by the deviation sampling period. Preferably, the elements are equal in number to an integer obtained by counting fractions of decimals of a resultant value of division as a whole number. Each of first gain elements h1 - hn is interposed between the sampling circuit and a corresponding one of the time delay elements Z⁻¹. Generally, each gain element is disposed on the input side of the time delay element Z⁻¹. Further, a corresponding one of first adder elements is interposed between each of the time delay elements and an associated one of the first gain elements h1, ---, or hn, and a corresponding one of second gain elements m1 - mn is interposed between the input side of the controlled object and each of the first adder elements. Further, a second adder element is interposed between the input side of the controlled object and the last time delay element Z⁻¹ connected thereto, and a third gain element h0 is provided between the sampling circuit and the second adder element (generally, on the input side of the second adder element). During the operation of the repetitive control unit, periodically applied to each of the time delay element Z⁻¹ is the sum of the product of the deviation yr(k) - y(k) and the first gain h1, ---, or hn associated with the time delay element, the product of the input u(k) to the controlled object and the second gain m1, ---, or mn associated with the time delay element, and the output Wp(k+p) (P = 1, ---, n) of the preceding time delay element. In the meantime, at least one of the first gains h1 - hn and the second gains m1 - mn may be zero. Further, the sum (series compensator output) u(k) of the product of the deviation and the third gain h0, and the output W1(k) of the time delay element disposed on the controlled object side is periodically applied to the controlled object 1 (Fig. 2). The controlled object 1 operates in a stable manner, with no substantial delay to the cyclic target input, in accordance with the repetitive control output u(k) responsive to the cyclic target input yr(k) which changes periodically in a single changing pattern, so that the controlled object repeats a single patterned action. According to the repetitive control unit which corresponds to the series compensator of Fig. 4, repetitive control with a minimized delay to the cyclic target input can be achieved. As is apparent from Fig. 4, the repetitive control unit can be configured even if the state variable x of the controlled object 1 is not observable directly. Further, the number of the time delay elements Z⁻¹ to be included in the repetitive control unit is not necessarily equal to the value obtained by dividing the cycle period of the cyclic target input by the deviation sampling period, as long as it is equal to or greater than such a value. In other words, the repetitive control unit provides excellent flexibility to a variation in the cycle period of the cyclic target input.

Claims: A discrete-type repetitive control method comprising the steps of: (a) periodically applying, to each of time delay elements (Z⁻¹) which are connected in-series with each other and are equal to or greater in number than a value obtained by dividing a cycle period (T) of a cyclic target input (y(k+n)) by a cycle period (τ) of sampling a deviation between an output (y(k)) of a controlled object and the cyclic target input, a sum of a product of the deviation periodically sampled and a first gain (h₁...h n ) associated with the time delay element, a product of an input (u(k)) to the controlled object and a second gain (m₁...m n ) associated with the time delay element, and an output of a preceding time delay element; and (b) periodically applying, to the controlled object, a sum of a product of the deviation periodically sampled and a third gain (h₀), and an output of a time delay element disposed on a side of the controlled object. The discrete-type repetitive control method according to claim 1, further including the step of periodically sampling the deviation. The discrete-type repetitive control method according to claim 1, wherein at least one of the first gains (h₁...h n ) and the second gains (m₁...m n ) is zero. A discrete-type repetitive control unit comprising: (a) time delay elements (Z⁻¹) which are equal to or greater in number than a value obtained by dividing a cycle period (T) of a cyclic target input (y(k+n)) by a cycle period (τ) of sampling a deviation between an output of a controlled object and the cyclic target input, said time delay elements being connected in series with each other; (b) first gain elements (h₁...h n ) each interposed on an input side of a corresponding one of said time delay elements; (c) first adder elements each interposed between a corresponding one of said time delay elements and a corresponding one of said first gain elements; (d) second gain elements (m₁...m n ) each interposed between an input side of the controlled object and a corresponding one of said first adder elements; (e) a second adder element interposed between an input side of the controlled object and a last time delay element connected thereto; and (f) a third gain element (h₀) disposed on an input side of said second adder element. The discrete-type repetitive control unit according to claim 4, further including: a sampling circuit for periodically sampling the deviation. The discrete-type repetitive control unit according to claim 4, wherein at least one of said first gain elements (h₁...h n ) and said second gain elements (m₁...m n ) is zero. The discrete-type repetitive control unit according to claim 4, wherein said time delay elements are provided by that number which is equal to an integer obtained by counting fractions of decimals of a value obtained by dividing the cycle period of the cyclic target input by the sampling cycle period of the deviation as a whole number.

Inventors: ARAKI MITSUHIKO - KAMIGAMOAZEK, IWASHITA YASUSUKE FANUC DAI- V, SAKAMOTO KEIJI ROOM FUYOHAITSU, ARAKI, MITSUHIKO 80-2, KAMIGAMOAZEKACHI-CHO, IWASHITA, YASUSUKE FANUC DAI-3 VIRA-KARAMATSU, SAKAMOTO, KEIJI ROOM 102, FUYOHAITSU
Applicants: FANUC LTD, FANUC LTD.
Application year: 1991
Main classification: G05B21
IPC codes: G05B21