Adaptive control device and adaptive control method, and control device and control method for injection molding machine
09738023 · 2017-08-22
Assignee
Inventors
- Hideaki Ohta (Kobe, JP)
- Hiroaki Fujimoto (Kobe, JP)
- Koichi Masaoka (Akashi, JP)
- Takehisa Katoh (Kobe, JP)
- Shuhei Ohtsuka (Kakogawa, JP)
Cpc classification
B29C45/77
PERFORMING OPERATIONS; TRANSPORTING
G05B13/041
PHYSICS
International classification
G05D9/00
PHYSICS
Abstract
An adaptive control device and adaptive control method, and a control device of an injection molding machine, which allow optimal adaptive control to be performed automatically and easily, while preventing a degradation of responsiveness. The adaptive control device is configured to perform feedback control in such a manner that an operation value is output based on a command value and a feedback value which is a sum of a controlled value output from a controlled target and a compensation value output from a parallel feed-forward compensator; wherein the parallel feed-forward compensator includes: an identification section which sequentially estimates a frequency response characteristic of the controlled target and an adjustment section which adjusts the compensation value based on the estimated frequency response characteristic.
Claims
1. An adaptive control device comprising: a controller which outputs an operation value to a controlled target in response to a command value input to the controller; and a parallel feed-forward compensator which outputs based on the operation value, a compensation value used for compensating a feedback value of a controlled value output from the controlled target; the controller being configured to perform feedback control in such a manner that the controller outputs the operation value based on the command value and the feedback value which is a sum of the controlled value output from the controlled target and the compensation value output from the parallel feed-forward compensator; wherein the parallel feed-forward compensator includes: an identification section which sequentially estimates a frequency response characteristic of the controlled target; and an adjustment section which adjusts the compensation value based on the estimated frequency response characteristic, wherein the adjustment section is configured to adjust the compensation value by multiplying by predetermined coefficients, a frequency and a gain in which a phase lag of the controlled target is equal to or greater than a predetermined value based on the frequency response characteristic.
2. The adaptive control device according to claim 1, wherein the identification section sequentially identifies a model of the controlled target, and estimates a transfer function of the controlled target; and wherein the identification section sequentially estimates the frequency response characteristic of the controlled target based on the estimated transfer function.
3. The adaptive control device according to claim 2, wherein the identification section uses a linear black box model.
4. The adaptive control device according to claim 3, wherein the identification section estimates coefficients in polynomial representation of the linear black box model, using a Kalman filter.
5. The adaptive control device according to claim 2, wherein the identification section uses a physical model of the controlled target.
6. The adaptive control device according to claim 5, wherein the identification section is configured to estimate unknown constants of the physical model of the controlled target, using a Kalman filter.
7. The adaptive control device according to claim 1, wherein the parallel feed-forward compensator has a transfer function in a first order lag system.
8. The adaptive control device according to claim 1, wherein the controller includes: a simple adaptive control unit which adjusts a plurality of adaptive gains such that the controlled value output from the controlled target tracks a reference model designed to provide a predetermined response; and wherein the plurality of adaptive gains include a first feed-forward gain corresponding to the command value, a second feed-forward gain corresponding to a state amount of the reference model, and a feedback gain corresponding to a deviation between an output of the reference model and the feedback value.
9. A control device of an injection molding machine which includes a pressure controller which outputs a pressure operation value to a motor for adjusting a pressure in a hydraulic cylinder of the injection molding machine, in response to a command value input to the pressure controller; and a parallel feed-forward compensator which outputs, based on the pressure operation value, a pressure compensation value used for compensating a feedback value based on the pressure in the hydraulic cylinder, the pressure controller being configured to perform feedback control in such a manner that the pressure controller outputs the pressure operation value based on the command value and the feedback value which is a sum of the pressure in the hydraulic cylinder and the pressure compensation value output from the parallel feed-forward compensator; wherein the parallel feed-forward compensator includes: an identification section which sequentially estimates a frequency response characteristic of the injection molding machine; and an adjustment section which adjusts the pressure compensation value based on the estimated frequency response characteristic, wherein the adjustment section is configured to adjust the pressure compensation value by multiplying by predetermined coefficients, a frequency and a gain in which a phase lag of the controlled target is equal to or greater than a predetermined value based on the frequency response characteristic.
10. The control device of the injection molding machine according to claim 9, wherein the adjustment section is configured to select either one of the frequency response characteristic of the injection molding machine which is sequentially estimated by the identification section, and a predetermined frequency response characteristic of the injection molding machine or the frequency response characteristic of the injection molding machine which is estimated at past time by the identification section, and adjust the pressure compensation value based on the selected frequency response characteristic.
11. The control device of the injection molding machine according to claim 9, comprising: a flow controller for controlling a flow of hydraulic oil inflowing to the hydraulic cylinder; wherein the control device is configured to detect, after starting flow control using the flow controller, at least one of the pressure in the hydraulic cylinder, a stroke of a piston sliding within the hydraulic cylinder, and time that passes from when the flow control using the flow controller has started, and to start pressure control using the pressure controller, in place of the flow controller, when the detected value exceeds a corresponding preset predetermined threshold.
12. An adaptive control method performed for a control system which controls a controlled target by adding an output of a parallel feed-forward compensator to an output of the controlled target, comprising the steps of: outputting an operation value to the controlled target in response to an input command value; outputting from the parallel feed-forward compensator based on the operation value a compensation value used for compensating a feedback value of a controlled value output from the controlled target; and performing feedback control in such a manner that the operation value is output to the controlled target based on the input command value and the feedback value which is a sum of the controlled value output from the controlled target and the compensation value: wherein the step of outputting the compensation value includes the steps of: sequentially estimating a frequency response characteristic of the controlled target; and adjusting the compensation value based on the estimated frequency response characteristic, wherein in the step of adjusting the compensation value, the compensation value is adjusted by multiplying by predetermined coefficients, a frequency and a gain in which a phase lag of the controlled target is equal to or greater than a predetermined value, based on the frequency response characteristic.
13. The adaptive control method according to claim 12, wherein in the step of sequentially estimating the frequency response characteristic, a model of the controlled target is sequentially identified, and a transfer function of the controlled target is estimated; and wherein the frequency response characteristic of the controlled target is sequentially estimated based on the estimated transfer function.
14. The adaptive control method according to claim 13, wherein in the step of sequentially estimating the frequency response characteristic, a linear black box model is used.
15. The adaptive control method according to claim 14, wherein in the step of sequentially estimating the frequency response characteristic, coefficients in polynomial representation of the linear black box model are estimated, using a Kalman filter.
16. The adaptive control method according to claim 13, wherein in the step of sequentially estimating the frequency response characteristic, a physical model of the controlled target is used.
17. The adaptive control method according to claim 16, wherein in the step of sequentially estimating the frequency response characteristic, unknown constants of the physical model of the controlled target are estimated using a Kalman filter.
18. The adaptive control method according to claim 12, wherein the parallel feed-forward compensator has a transfer function in a first order lag system.
19. The adaptive control method according to claim 12, wherein the step of outputting the operation value includes the step of adjusting a plurality of adaptive gains such that the controlled value output from the controlled target tracks a reference model designed to provide a predetermined response; and the plurality of adaptive gains include a first feed-forward gain corresponding to the command value, a second feed-forward gain corresponding to a state amount of the reference model, and a feedback gain corresponding to a deviation between an output of the reference model and the feedback value.
20. A method of controlling an injection molding machine, which controls the injection molding machine by adding a pressure compensation value output from a parallel feed-forward compensator to a pressure in a hydraulic cylinder of the injection molding machine, the method comprising the steps of: outputting a pressure operation value based on an input command value to a motor for adjusting the pressure in the hydraulic cylinder of the injection molding machine; outputting from the parallel feed-forward compensator based on the pressure operation value, the pressure compensation value used for compensating a feedback value based on the pressure in the hydraulic cylinder; and performing feedback control in such a manner that the pressure operation value is output to the motor based on the input command value and the feedback value which is a sum of the pressure in the hydraulic cylinder and the pressure compensation value; wherein the step of outputting the compensation value includes the steps of: sequentially estimating a frequency response characteristic of the injection molding machine; and adjusting the pressure compensation value based on the estimated frequency response characteristic, wherein in the step of adjusting the pressure compensation value, the pressure compensation value is adjusted by multiplying by predetermined coefficients, a frequency and a gain in which a phase lag of the controlled target is equal to or greater than a predetermined value, based on the frequency response characteristic.
21. The control method of controlling the injection molding machine according to claim 20, wherein in the step of adjusting the pressure compensation value, either one of the frequency response characteristic of the injection molding machine which is sequentially estimated in the step of sequentially estimating the frequency response characteristic, and a predetermined frequency response characteristic of the injection molding machine or the frequency response characteristic of the injection molding machine which is estimated at past time in the step of sequentially estimating the frequency response characteristic, is selected, and the pressure compensation value is adjusted based on the selected frequency response characteristic.
22. The method of controlling the injection molding machine according to claim 20, comprising the step of: controlling a flow of hydraulic oil inflowing to the hydraulic cylinder; wherein a pressure control step including the step of outputting the operation value, the step of outputting the compensation value, and the step of performing the feedback control, is started in place of the step of controlling the flow of the hydraulic oil, when at least one of the pressure in the hydraulic cylinder, a stroke of a piston sliding within the hydraulic cylinder, and time that passes from when the step of controlling the flow of the hydraulic oil has started, exceeds a corresponding preset predetermined threshold, after the step of controlling the flow of the hydraulic oil has started.
Description
BRIEF DESCRIPTION OF DRAWINGS
(1)
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
(11)
(12)
(13)
(14)
(15)
(16)
(17)
(18)
DESCRIPTION OF EMBODIMENTS
(19) Hereinafter, an embodiment of the present invention will be described with reference to the drawings. Throughout the drawings, the same or corresponding components are designated by the same reference symbols and will not be described in repetition.
(20) [Overall Configuration]
(21)
(22) The PFC 4 includes a PFC processor section 5 which computes the compensation value y.sub.f based on the operation value u output from the controller 3, an identification section 6 which sequentially identifies a model of the controlled target 2 and estimates a transfer function of the controlled target 2, and an adjustment section 7 which estimates a frequency response characteristic of the controlled target 2 based on the transfer function identified by the identification section 6 and adjusts the compensation value y.sub.f output from the PFC processor section 5 based on the estimated frequency response characteristic of the controlled target 2.
(23)
(24)
(25) To eliminate an offset resulting from addition of the compensation value y.sub.f of the PFC to the control valve y, the PFC 40 is sometimes caused to have a low-frequency cutoff characteristic as follows:
(26)
(27) When the compensation value y.sub.f output from the PFC 40 is greater, the control system tends to be stabilized more easily. However, if the compensation value y.sub.f is set greater in excess, then the output of the extended control system is deviated from the controlled value y output from the controlled target 2. As a result, responsiveness degrades.
(28) In contrast, in accordance with the above described configuration, the compensation value y.sub.f output from the PFC 4 is automatically adjusted according to the frequency response characteristic of the controlled target 2 which is identified sequentially. Therefore, an unnecessary increase in the compensation value y.sub.f does not occur, and a degradation of the responsiveness can be prevented. Furthermore, differently from the conventional automatic adjustment method of the PFC, it is not necessary to manually re-adjust the compensation value y.sub.f in response to a change in the controlled target 2. In addition, the control parameters are adjusted based on the frequency response characteristic. Therefore, a tolerance associated with modeling error is greater in the present configuration than in the conventional configuration which directly uses the identified parameters as the control parameters. In other words, the control parameters can be adjusted appropriately merely by detecting a trend of the frequency response characteristic even when the modeling error is greater. Therefore, in accordance with the above configuration, optimal adaptive control can be performed automatically and easily while preventing a degradation of responsiveness.
(29) <Adjustment Method of PFC>
(30) Hereinafter, the adjustment method of the compensation value in the PFC 4 will be described.
(31) Then, the identification section 6 sequentially performs identification using the resampled values (step S3: identification step). In the present embodiment, the identification section 6 estimates the frequency response characteristic of the controlled target 2 by sequentially identifying the model of the controlled target 2 and finding the transfer function of the controlled target 2. At this time, the identification section 6 performs identification by using a linear black box model (especially, model called ARX model). This makes it possible to estimate the frequency response characteristic by utilizing a known sequential identification method. In addition, the controlled target 2 which can be identified is not limited to a particular model, and the adaptive control device is applicable to various controlled targets 2. Therefore, a versatile adaptive control device can be implemented. Specifically, the model of the controlled target 2 is described as follows:
A(z.sup.−1)y.sub.r(k)=z.sup.−km B(z.sup.−1)u.sub.r(k)+v(k) (3)
(32) u.sub.r(k) indicates an operation value (input data) at time k after the re-sampling, y.sub.r(k) indicates a controlled value (output data) at time k after the re-sampling, v(k) indicates disturbance term, km indicates dead time, and z indicates a time shift operator corresponding to one sample, and z[x (k)]=x(k+1) is satisfied.
(33) A(z.sup.−1) and B(z.sup.−1) are expressed as follows.
A(z.sup.−1)=1+a.sub.1z.sup.−1+a.sub.2z.sup.−2+ . . . +a.sub.naz.sup.−na
B(z.sup.−1)=b.sub.1z.sup.−1+b.sub.2z.sup.−2+ . . . +b.sub.nbz.sup.−nb (4)
(34) a.sub.1, a.sub.2, . . . , a.sub.na indicate denominator parameters to be estimated, b.sub.1, b.sub.2, . . . , b.sub.nb indicate numerator parameters to be estimated, na indicates the number of parameters of the denometer of the identified model, and nb indicates the number of parameters of the numerator of the identified model.
(35) In this case, a predicted value y.sub.p(k) which is one stage after output data y.sub.r(k) at time k based on input/output data at time k−1 and its previous time can be expressed as follows:
y.sub.p(k)=φ.sup.T(k)θ
θ=[a.sub.1 . . . a.sub.na b.sub.1 . . . b.sub.nb].sup.T
φ(k)=[−y.sub.r(k−1) . . . −y.sub.r(k−na) u.sub.r(k−km−1) . . . u.sub.r(k−km−nb)].sup.T (5)
(36) θ indicates a parameter vector and φ(k) indicates a data vector at time k.
(37) In this case, when it is assumed that a probabilistic change in the parameter vector θ indicates a change in the controlled target 2, the following equation is provided:
(38)
(39) Q indicates a variance (changing magnitude) of the parameters, and R indicates a variance of observation noise. Note that the variance Q of the parameters is 0 in a steady state (state in which no change occurs in input/output). The variance Q of the parameters and the variance R of observation noise are design parameters of the PFC 4.
(40) In the present embodiment, the identification section 6 estimates the parameters (coefficients in polynomial representation) of the linear black box model, by using a Kalman filter. In other words, the identification section 6 estimates the parameter vector θ by using the Kalman filter based on the above equation (6).
(41) Hereinafter, an estimation procedure using the Kalman filter will be described specifically. Firstly, the identification section 6 calculates a predicted error ε.sub.i (k) and a Kalman gain W(k) as follows, using an initial value θ.sub.i(k) of the estimated parameter value and an initial value P.sub.i(k) of error covariance matrix:
(42)
(43) Based on the above equation (7) and the above equation (8), the identification section 6 modifies the estimated parameter value θ(k) and the error covariance matrix P(k) as follows:
θ(k)=θ.sub.i(k)+W(k)ε.sub.i(k) (9)
P(k)=P.sub.i(k)−W(k)φ.sup.T(k)P.sub.i(k) (10)
(44) Furthermore, time step is updated, and an initial value θ.sub.i(k +1) of the estimated parameter value and an initial value P.sub.i(k+1) of the error covariance matrix in next step are calculated:
θ.sub.i(k+1)=θ(k) (11)
P.sub.i(k+1)=P(k)+Q (12)
(45) Since the variance Q of the parameters=0 in the steady state, the initial value P.sub.i(k+1) of the error covariance matrix in next step is only P(k).
(46) In the above described manner, the parameter vector θ is sequentially estimated.
(47) A transfer function G(z) of the controlled target 2 is expressed as follows:
(48)
(49) The above equation (13) can be expressed by the parameter vector θ estimated by the identification section 6. As described above, by applying the Kalman filter to the linear black box model, the frequency response characteristic of the controlled target 2 can be estimated by utilizing the known configuration.
(50) Next, the adjustment section 7 designs the PFC based on the estimated transfer function G(z) of the controlled target 2. In the present embodiment, the PFC is a first order lag system expressed as the equation (1). The adjustment section 7 designs a break (corner) frequency ω.sub.f(hereinafter will also be simply referred to as PFC frequency ω.sub.f) and a gain K.sub.f (hereinafter will also be simply referred to as PFC gain K.sub.f) of the PFC in the first order lag system by multiplying by predetermined coefficients, a frequency and a gain in which a phase lag of the controlled target 2 is equal to or greater than a predetermined value. Specifically, firstly, the adjustment section 7 calculates by numerical search a frequency ω.sub.p in which the phase lag of the controlled target 2 is equal to or greater than φ.sub.p, using the identified transfer function G(z) of the controlled target 2 (step S4). In addition, the adjustment section 7 calculates a gain K.sub.p=|G(z=exp(jω.sub.pT.sub.s))| corresponding to the frequency ω.sub.p (step S5). T.sub.s indicates a control cycle.
(51) The adjustment section 7 applies a smoothing filter to the found frequency ω.sub.p and the found gain K.sub.p (step S6, step S7). The smoothing filter is not particularly limited, and may be, for example, a moving average filter. In the case of using the moving average filter, a filtered frequency ω.sub.pf and a filtered gain K.sub.pf are found as follows:
(52)
(53) ns indicates the number of data used for the moving average.
(54) By using the filtered frequency ω.sub.pf and the filtered gain K.sub.pf, which are found as described above, the adjustment section 7 multiplies the frequency ω.sub.p and the gain K.sub.p in which the phase lag of the controlled target 2 is equal to or greater than the predetermined value φ.sub.p, by predetermined coefficients (frequency coefficient α.sub.w and gain coefficient α.sub.k), respectively, using the identified transfer function G(z) of the controlled target 2, thereby designing the PFC frequency ω.sub.f and the PFC gain K.sub.f of the transfer function G.sub.f(z) of the PFC 4 as follows (step S8, step S9):
ω.sub.f(k)=α.sub.wω.sub.pf(k)
K.sub.f(k)=α.sub.kK.sub.pf(k) (15)
(55) The frequency coefficient α.sub.w and the gain coefficient α.sub.k are design parameters.
(56) By using the PFC frequency ω.sub.f and the PFC gain K.sub.f which are found as described above, the transfer function G.sub.f(s) of the PFC 4 (PFC processor section 5) is found (step S10: adjustment step). Based on the found transfer function G.sub.f(s) of the PFC 4, the compensation value y.sub.f is adjusted. In the present embodiment, the adjustment section 7 determines whether or not the value of the PFC frequency ω.sub.f and the value of the PFC gain K.sub.f which are found in step S8 and step S9, respectively, exceed predetermined upper limit values, respectively, and uses limiters so that the upper limit values are not exceeded, if the value of the PFC frequency ω.sub.f and the value of the PFC gain K.sub.f exceed the predetermined upper limit values, respectively (step S11, step S12). This makes it possible to effectively prevent a situation in which the transfer function G.sub.f(s) of the PFC 4 after the adjustment falls outside an adjustment range.
(57) In a case where the PFC processor section 5 computes the transfer function G.sub.f(s) of the PFC 4, used is a discrete time transfer function G.sub.f(z) obtained by bilinear transformation of the continuous time transfer function G.sub.f(s) as follows:
(58)
(59) d.sub.f indicates feedthrough term of the discrete time transfer function G.sub.f(z) of the PFC 4. That is, the discrete time transfer function G.sup.d.sub.f(z) means the transfer function of the PFC 4 obtained by excluding the feedthrough term. In this case, the compensation value y.sub.f is calculated as follows:
y.sub.f.sup.d(k+1)=α.sub.fy.sub.f.sup.d(k)+b.sub.fu(k)
y.sub.f(k)=y.sub.f.sup.d(k)+d.sub.fu(k) (18)
(60) y.sup.d.sub.f(k) means a compensation value obtained by excluding the feedthrough term. The equation (18) is in some cases expressed as follows:
y.sub.f(k)=G.sub.f(z)u(k)=G.sup.d.sub.f(z)u(k)+d.sub.fu(k)=y.sup.d.sub.f(k)+d.sub.fu(k) (19)
(61) By adjusting the compensation value y.sub.f as described above, the compensation value y.sub.f output from the PFC 4 can be adjusted appropriately for various controlled targets 2 with a simple configuration.
(62) <SAC Unit>
(63) Next, the controller 3 of the present embodiment will be described.
(64) The reference model is expressed as a discrete time state equation as follows to enable the computation performed by the computer:
x.sub.m(k+1)=A.sub.mx.sub.m(k)+b.sub.mr(k)
y.sub.m(k)=c.sub.mx.sub.m(k)+d.sub.mr(k) (20)
(65) A.sub.m, b.sub.m, c.sub.m, and d.sub.m indicate parameters of the reference model.
(66) In general, to enable the SAC unit to operate properly, it is required that the controlled target 2 satisfy almost strictly positive real (ASPR) condition. However, in general, a response lag such as dead time occurs in the controlled target 2, and therefore, in many cases, the controlled target 2 does not satisfy the ASPR condition. Therefore, in the present embodiment, as described above, the extended control system is constructed by adding the output of the PFC 4 to the output of the controlled target 2 so that the extended control system satisfies the ASPR condition. Under this state, the SAC unit is applied to the extended control system.
(67) In this case, the output which tracks the reference model is not the output of the controlled target 2 which should track the reference model as an intended purpose, but the output of the extended control system. In other words, a steady-state deviation remains in the output of the controlled target 2. To eliminate the steady-state deviation, dynamic compensation is performed in such a manner that the PFC 4 having the same configuration is added to the output y.sub.m of the reference model application section 31.
(68)
y.sub.f.sup.d(k+1)=a.sub.fy.sub.f.sup.d(k)+b.sub.fu.sub.e(k)
y.sub.f(k)=y.sub.f.sup.d(k)+d.sub.fu.sub.e(k) (21)
(69) Hereinafter, SAC operation will be described with reference to the equivalent block diagram of
(70) The input (operation value) u to the controlled target is expressed as follows:
u.sub.e(k)=K.sub.ee.sub.a(k)
u.sub.s(k)=K.sub.xx.sub.m(k)+K.sub.ur(k)
u(k)=u.sub.e(k)+u.sub.s(k) (22)
(71) Adaptive gains K.sub.u, K.sub.x, K.sub.e shown in the above equation (22) are found by proportional and integral adaptive tuning rule as follows;
(72)
(73) γ.sub.pe, γ.sub.le, γ.sub.px, γ.sub.lx, γ.sub.pu, γ.sub.lu indicate tuning rule gains, respectively. Superscript i in each of K.sub.x, γ.sub.px, γ.sub.lx, indicates a gain corresponding to an i-th state amount x.sup.i.sub.m of the reference model.
(74) N(k) in the above equation (23) is a normalized signal, and is given by the following equation:
N(k)=√{square root over (m.sup.2+m.sub.ur.sup.2(k)+m.sub.ymy.sub.m.sup.2(k))} (24)
(75) m, m.sub.u, m.sub.ym indicate normalized parameters, respectively.
(76) σ.sub.e, σ.sub.x, σ.sub.u in the above equation (23) are σ modification gains for preventing a variance of the adaptive gains, and are variable according to a control deviation, a command value, a reference output, and a reference model state amount as follows:
(77)
(78) βe.sub.1 to βie.sub.3, β.sub.x1 to β.sub.x3, β.sub.u1 to β.sub.u3, C.sub.x0, C.sub.u0, C.sub.em0 indicate design parameters. Each gain with superscript i indicates a gain corresponding to a i-th state amount x.sup.i.sub.m of the reference model.
(79) The output e.sub.a(k) of the fourth adder 41 which is used in calculation of the output u.sub.e (k) of the third multiplier 34 in the above equation (22) is, as shown in
u.sub.e(k)=K.sub.ee.sub.a(k)=K.sub.e(y(k)+y.sub.f(k)−y.sub.m(k))=K.sub.e(y(k)+y.sup.d.sub.f(k)−y.sub.m(k)+d.sub.fu.sub.e(k)) (28)
(80) As can be clearly seen from the above equation (28), u.sub.e(k) is required for the calculation of the output u.sub.e(k) of the third multiplier 34. Calculation cannot be performed unless the above equation (22) is modified. Accordingly, of the output e.sub.a(k) of the fourth adder 41 an observable portion except for feedthrough term is e.sup.d.sub.a(k), which results in an equation which is capable of calculation as follows:
(81)
(82) From the above, the control input (equation (22)) of the SAC unit is replaced as follows:
u.sub.e(k)=K.sup.d.sub.ee.sup.d.sub.a(k)
u.sub.s(k)=K.sub.xx.sub.m(k)+K.sub.ur(k)
u(k)=u.sub.e(k)+u.sub.s(k) (30)
(83) In correspondence with the replacement of the feedback gain K.sub.e in the above equation (29), the adaptive tuning rule in the equation (23) is changed into an equation which is capable of calculation as follows:
(84)
(85) As described above, in the computer computation performed by the SAC unit of the controller 3 and the adjustment section 6 of the PFC 4, the adaptive feedback gain K.sub.e is replaced by K.sup.d.sub.e in the equation (29).
(86)
(87) It should be noted that a case where K.sup.d.sub.e may fall outside the range according to a change in the transfer function G.sub.f(z) of the PFC 4 is limited to a case of d.sub.f(k)>d.sub.f (k−1). Therefore, as shown below, adjustment of K.sup.d.sub.e may not be performed in the case of d.sub.f(k)≦d.sub.f(k−1).
(88)
(89) Alternatively, K.sup.d.sub.e may be adjusted as follows. In this case, a response at a time point just after the feedthrough term d.sub.f has changed is sometimes better as compared to the case where re-calculation is performed using the equation (32) and the equation (33).
(90)
(91) <How to Consider in Adjustment Method of PFC>
(92) Now, how to consider in the above stated adjustment method of the PFC will be described.
(93) In light of this, it is designed that the output y.sub.f of the PFC 4 in which its phase lag is less than 90 degrees is greater than the output y of the controlled target 2 in the frequency range in which the phase lag of the controlled target 2 is 180 degrees or more. Thereby, in the frequency range in which the phase lag of the controlled target 2 is 180 degrees or more, the output y.sub.f of the PFC 4 in which its phase lag is less than 90 degrees mainly occupies the output of the extended control system. Therefore, it appears that there is no response lag in the extended control system. In the example of
(94)
(95) The gain K.sub.p and the frequency ω.sub.p of the controlled target 2, at the threshold φ.sub.p, are found using a numerical search method within the control cycle T.sub.s. The gain K.sub.p and the frequency ω.sub.p of the controlled target 2 are not required to have a high accuracy. Specifically, if the frequency coefficient α.sub.w and the gain coefficient α.sub.k which are the design parameters are set to relatively great values, then search can be ended assuming that a range of about ±5 to 10 degrees with respect to the threshold φ.sub.p which is a search phase is an allowable error range. If efficient one-dimensional search method such as divine proportion search method is employed, the gain K.sub.p and the frequency ω.sub.p of the controlled target 2 converge to fall into the allowable error ranges, by performing the search about five to ten times. Therefore, the numerical search method within the control cycle T.sub.s is allowed even when the control cycle T.sub.s is as short as about 0.002 to 0.005 second which is a general length.
(96) When the threshold φ.sub.p of the phase lag of the transfer function G(z) is, for example, 150 to 180 degrees, the frequency coefficient α.sub.w which is the design parameter in the equation (15) is set to about 1.0 to 5.0, while the gain coefficient α.sub.k which is the design parameter in the equation (15) is set to about 1.0 to 2.0.
(97) <Application Example of the Present Embodiment>
(98) Hereinafter, an example in which the adaptive control device 1 described in the above embodiment is applied to an injection molding machine will be described.
(99) As shown in
(100) A control device of the injection molding machine 10 configured as described above includes a pressure controller 20 which outputs a pressure operation value u to a motor driving device 21 of the servo motor 19 which adjusts a pressure in the hydraulic cylinder 17 of the injection molding machine 10, and a PFC 22 which outputs based on the pressure operation value u, a pressure compensation value y.sub.f used for compensating a feedback value y.sub.a based on the pressure in the hydraulic cylinder 17. The pressure controller 20 detects the pressure in the hydraulic cylinder 17, hydraulic oil discharge pressure of the hydraulic pump 18, or the like, by a sensor (not shown), and inputs the detected pressure to the PFC 22. Thus, the pressure controller 20 performs the feedback control in such a manner that it outputs the pressure operation value u based on a pressure command value r and the feedback value y.sub.a which is a sum of the pressure in the hydraulic cylinder 17 and the pressure compensation value y.sub.f output from the PFC 22. The configuration of the PFC 22 is similar to that of the above embodiment. Pressure control shown in
(101) In accordance with the above configuration, the pressure compensation value y.sub.f output from the PFC 22 is automatically adjusted according to the frequency response characteristic of the injection molding machine 10 which is sequentially identified. Therefore, it is not necessary to manually re-adjust the pressure compensation value y.sub.f in response to a change in a size of the hydraulic cylinder 17 used in the injection molding machine 10, the injection material, etc. In addition, it is not necessary to increase the pressure compensation value y.sub.f unnecessarily, which can prevent a degradation of responsiveness. Besides, since the control parameters are adjusted based on the frequency response characteristic, a tolerance associated with modeling error is greater in the present configuration than in the conventional configuration which directly uses the identified parameters as the control parameters. In other words, the control parameters can be adjusted appropriately merely by detecting a trend of the frequency response characteristic even when the modeling error is greater. Therefore, in accordance with the above configuration, optimal adaptive control can be performed automatically and easily while preventing a degradation of responsiveness in the injection molding machine.
(102) The control device of the injection molding machine 10 of the present application example may employ flow control in which a velocity of the hydraulic cylinder 17 is controlled to reach a constant value in the injection step, or the like. Specifically, the motor driving device 21 also serves as a flow controller for controlling a flow (rate) of the hydraulic oil inflowing to the interior of the hydraulic cylinder 17. The flow of the hydraulic oil inflowing to the hydraulic cylinder 17 is detected by detecting a rotational speed of the servo motor 19.
(103) In the present application example, the injection molding machine 10 is drivably controlled by switching between the above stated flow control and the above stated pressure control according to cases.
(104) More specifically, the control device of the injection molding machine 10 is configured to detect, after starting the flow control using the motor driving device 21 which is the flow controller, at least one of the pressure in the hydraulic cylinder 17, a stroke of the piston 16 sliding within the hydraulic cylinder 17, and time that passes from when the flow control using the flow controller has started, and to start the pressure control using the pressure controller, in place of the flow control, when the detected value exceeds a corresponding preset predetermined threshold. In the same manner, the control devicedetermines whether or not to switch from the pressure control to the flow control based on a threshold. The threshold used to determine whether or not to switch from the pressure control to the flow control may be equal to or different from the threshold used to determine whether or not to switch from the flow control to the pressure control. This makes it possible to switch between the flow control and the pressure control according to the state of the injection molding machine 10. Therefore, proper control can be implemented.
(105) In addition, between the flow control step and the pressure control step, a characteristic (control structure) of a controlled target (servo motor 19) changes significantly. For this reason, there is a possibility that at a time point just after the flow control step has switched to the pressure control step, the identification section of the PFC 22 cannot estimate the frequency response characteristic correctly. In view of such a case, the adjustment section of the PFC 22 may be configured to select either one of the frequency response characteristic of the injection molding machine which is sequentially estimated by the identification section of the PFC 22, and a predetermined frequency response characteristic of the injection molding machine or the frequency response characteristic of the injection molding machine which is estimated at past time by the identification section, and to adjust the pressure compensation value based on the selected frequency response characteristic.
(106) In accordance with this configuration, in a case where it is difficult to correctly estimate the frequency response characteristic by the sequential identification, for example, at a time point just after the pressure controller 20 has started the control of the injection molding machine 10, the pressure compensation value is adjusted using the predetermined frequency response characteristic or the frequency response characteristic estimated at past time by the identification section, thereby preventing a situation in which the adaptive control becomes unstable, while in other cases, the injection molding machine 10 is controlled using the frequency response characteristic identified sequentially. In this way, optimal adaptive control can be performed while preventing a degradation of responsiveness.
(107) For switching the frequency response characteristic to be selected between either one of the frequency response characteristic sequentially identified, and the predetermined frequency response characteristic or the frequency response characteristic estimated at past time by the identification section, at least one of the pressure in the hydraulic cylinder 17, the stroke of the piston 16 sliding within the hydraulic cylinder 17, and the time that passes from when the flow control using the flow controller has started, may be detected, and the frequency response characteristic to be selected may be switched when the detected value exceeds the corresponding preset predetermined threshold.
(108)
(109) (Modified Example)
(110) Thus far, the embodiment of the present invention has been described. The present invention is not limited to the above embodiment and can be improved, changed or modified in various ways without departing from a spirit of the invention.
(111) For example, although in the above described embodiment, the identification section 6 is configured to estimate the parameters of the linear black box model, using the Kalman filter, the present invention is not limited to this. For example, the parameters of the linear black box model may be estimated using recursive least squares (RLS). When a change in model parameters in RLS is considered, a forgetting coefficient (factor) for exponentially reducing a weight is set to past data, and the parameters are estimated as follows:
(112)
(113) θ(k) indicates a parameter vector of the model, φ(k) indicates a data vector at time k, and ε indicates a predicted error. γ indicates a positive constant and I indicates a unit matrix.
(114) In a case where a physical structure of the controlled target 2 is obvious, the identification section 6 uses a physical model of the controlled target 2. This makes it possible to construct a more accurate adaptive control device. In this case, the identification section 6 may be configured to estimate unknown constants of the model, using the Kalman filter. This makes it possible to implement the adaptive control by the physical model by utilizing the known configuration. For example, in a case where the pressure control for the hydraulic cylinder is performed, a pressure change model of the hydraulic cylinder is given as follows:
(115)
(116) p indicates the cylinder pressure [Pa], q indicates a flow [m.sup.3/s] of the hydraulic oil discharged to the cylinder, A indicates a cylinder cross-sectional area [m.sup.2], x indicates a cylinder displacement amount [m], y indicates a cylinder velocity [m/s], and κ indicates a volumetric elastic coefficient. The flow q of the hydraulic oil discharged to the cylinder is an operation amount and the cylinder pressure p is a controlled amount. The cylinder cross-sectional area A is known, and the cylinder displacement amount x and the cylinder velocity y are measureable (known), while the volumetric elastic coefficient κ is unknown.
(117) When the equation (36) is discretized, and expressed as a state equation considering a change in the volumetric elastic coefficient κ, the following is provided:
(118)
(119) Q.sub.0 indicates a variance (changing magnitude) of the volumetric elastic coefficient, and R indicates a variance of observation noise. T.sub.s indicates a control cycle [sec]. Note that the variance Q.sub.0 of the volumetric elastic coefficient is 0 in a steady state (state in which no change occurs in input/output).
(120) With reference to the above equation (37) and by using the Kalman filter, the volumetric elastic coefficient κ which is the unknown constant of the physical model is estimated. Prior to describing an estimation procedure, the following symbols are defined:
(121)
(122) Hereinafter, the estimation procedure using the Kalman filter will be specifically described. Initially, using an initial value θ.sub.i(k) of the estimated parameter value and an initial value P.sub.i(k) of the error covariance matrix, the identification section 6 calculates the predicted error ε.sub.i(k) and the Kalman gain W(k) as follows:
(123)
(124) According to the above equation (39) and the above equation (40), the estimated parameter value θ(k) and the error covariance matrix P(k) are modified as follows:
θ(k)=θ.sub.i(k)+W(k)ε.sub.i(k) (41)
P(k)=P.sub.i(k)−W(k)H(k)P.sub.i(k) (42)
(125) Furthermore, time step is updated, and then an initial value θ.sub.i(k+1) of the estimated parameter value and an initial value P.sub.i(k+1) of the error covariance matrix, in next step, are calculated:
θ.sub.i(k +1)=F(k)θ(k) (43)
P.sub.i(k+1)=F(k)P(k)F.sup.T(k)+Q (44)
(126) In the steady state, the variance Q of the parameters is 0, and therefore, the initial value P.sub.i(k+1) of the error covariance matrix in next step is only P(k).
(127) By sequentially estimating the parameter value θ as described above, the volumetric elastic coefficient κ is estimated.
(128) A transfer function G(z) from the flow q(k) of the hydraulic oil inflowing to the hydraulic cylinder to the pressure p(k) of the hydraulic cylinder is expressed as follows:
(129)
(130) The above equation (45) can be expressed by the measureable cylinder displacement amount x(k), the known cylinder cross-sectional area A, and the volumetric elastic coefficient κ estimated by the identification section 6. As described above, in a case where the physical structure of the controlled target 2 is obvious, the frequency response characteristic of the controlled target 2 can be estimated more accurately by utilizing the known configuration.
(131) Alternatively, the controlled target 2 can be identified without using the linear black box model. For example, IIR filter representing the controlled target 2 may be found using an adaptive digital filter such as a hyperstable adaptive recursive filter (HARF) or a simplified HARF (SHARP). It is sufficient that the frequency response characteristic of the controlled target 2 can be estimated finally in the present invention. Therefore, the model of the controlled target 2 is not necessarily identified. In other words, the identification section 6 may directly estimate the frequency response characteristic. As a method of directly estimating the frequency response characteristic, for example, there are Short-time Fourier Transform, Continuous Wavelet Transform, etc.
(132) Although in the above described embodiment, the controller 3 to which the PFC 4 is applied includes the SAC unit, the controller 3 is not limited to this. For example, the controller may be an adaptive PID control section.
(133) In a further alternative, the controller may be a sliding mode control section.
EXAMPLES
(134) Regarding each of an adaptive control device according to Example of the present invention and a SAC unit (Comparative example) in which a transfer function of a PFC is fixed, a tracking capability of the output y of the controlled target with respect to the output y.sub.m of the reference model was simulated using a model in which the transfer function of the controlled target changes. Among the parameters of the SAC in Example and Comparative example, parameters (control cycle T.sub.s, parameters a.sub.m, b.sub.m, c.sub.m, d.sub.m of reference model, tuning rule gains γ.sub.pe, γ.sub.px, γ.sub.pu, σ modification gains β.sub.e1 to β.sub.e3, β.sub.x1 to β.sub.x3, β.sub.u1 to β.sub.u3, etc.) of the SAC were equal values in Example and Comparative example except that a gain (0.005) of an output of the PFC and a frequency (30 Hz) in Comparative example were fixed values. In the present Example, the threshold φ.sub.p of the phase lag was 180 degrees, the frequency coefficient α.sub.k was 1.5, and the gain coefficient α.sub.k was 1.
(135) As the model of the controlled target, used was a model in which the transfer function G(s) changed with time as follows:
(136)
(137) In the above equation (46), the model is such that the gain changes 10 times every time the transfer function G(s) changes with time. For every gain, it is necessary to design a stable PFC. In view of this, in the present Comparative example, it is designed that the compensation value of the PFC is optimal in a range in which the gain of the controlled target is great (transfer function G(s) in a range of 0≦t<4, 12≦t<20 is 1.5 e.sup.−0.025s/(5s+1)).
(138)
(139) However, in a range in which the gain of the controlled target is small (transfer function G(s) in a range of 4≦t<12 is 0.15 e.sup.−0.025s/(5s+1)), the compensation value of the PFC in Comparative example (
(140) In contrast, it can be understood that in the present Example (
(141) Numerous modifications and alternative embodiments of the invention will be apparent to those skilled in the art in view of the foregoing description. Accordingly, the description is to be construed as illustrative only, and is provided for the purpose of teaching those skilled in the art the best mode of carrying out the invention. The details of the structure and/or function may be varied substantially without departing from the spirit of the invention and all modifications which come within the scope of the appended claims are reserved.
INDUSTRIAL APPLICABILITY
(142) An adaptive control device and adaptive control method, and a control device of an injection molding machine of the present invention are effectively employed to allow optimal adaptive control to be performed automatically and easily, while preventing a degradation of responsiveness.
REFERENCE SIGNS LIST
(143) 1, 1B, 1C adaptive control device
(144) 2 controlled target
(145) 3 controller
(146) 3B adaptive PID controller
(147) 3C sliding mode controller
(148) 4, 22 PFC
(149) 5 PFC processor section
(150) 6 identification section
(151) 7 adjustment section
(152) 10 injection molding machine
(153) 11 nozzle
(154) 12 injection cylinder
(155) 13 heater
(156) 14 hopper
(157) 15 screw
(158) 16 piston
(159) 17 hydraulic cylinder
(160) 18 hydraulic pump
(161) 19 servo motor (motor)
(162) 20 pressure controller
(163) 21 motor driving device
(164) 31 reference model application section
(165) 32 first multiplier
(166) 33 second multiplier
(167) 34 third multiplier
(168) 35 first subtracter
(169) 36 first adder
(170) 37 second adder
(171) 38 dynamic compensator
(172) 39 third adder
(173) 40 fourth adder