The present invention relates to an adaptive control device and adaptive control method which use a parallel feed-forward compensator. Particularly, the present invention relates to a control device and control method for an injection molding machine to which the adaptive control method is applied.
As a control method for estimating parameters while stabilizing a control system, for a controlled target whose parameters are unknown, adaptive control is generally known. As a general adaptive control method, model reference adaptive control, self-tuning regulator, etc., are known. These adaptive control methods have a problem that since control algorithms are complicated and control parameters to be designed are numerous, it is difficult to adjust them.
As an adaptive control method for solving such a problem, there is known simple adaptive control (SAC) which assumes a model which realizes an ideal state and changes control parameters such that an actual output of a controlled target matches the model (see, e.g., Patent Literature 1). To enable the controlled target to be controlled by the SAC, it is required that ASPR (almost strictly positive real) condition be satisfied. To satisfy the ASPR, an output of a compensator called a parallel feed-forward compensator (PFC) is added to the output of the controlled target, which is known control.
However, in the above stated simple adaptive control which is somewhat simplified, there are still many parameters in design of the parallel feed-forward compensator, and therefore an expertise is needed. When consideration is given to a change in the controlled target and robustness of the control system, it is necessary to increase a compensation value output from the PFC to provide a design which gives importance to stability. However, this would degrade responsiveness. As a method of solving this problem, there is known a configuration in which gains of controlled target process are pre-stored, and modification values of PFC gains which are used in parallel feed-forward compensation computation are automatically adjusted based on the gains (see, e.g., Patent Literature 2), and a configuration in which model parameters of the controlled target are sequentially identified, and the PFC is sequentially adjusted according to a result of the identification (see, e.g., Patent Literature 3).
Patent Literature 1: Patent No. 3098020
Patent Literature 2: Patent No. 3350923
Patent Literature 3: Japanese-Laid Open Patent Application Publication No. 2010-253490
However, in the configuration disclosed in Patent Literature 2, in a case where the controlled target changes and the gains of the controlled target process change, it is necessary to newly set the gains and therefore automatic adjustment (on-line adjustment) cannot be performed in response to a change in the controlled target. Also, in the configuration disclosed in Patent Literature 3, the parameters of a particular model are identified and the control parameters are adjusted. Therefore, parameters of an unidentified or unknown controlled target cannot be sequentially identified, and the configuration disclosed in Patent Literature 3 is not versatile. In addition, since the identified model parameters are directly used as the control parameters, the control parameters may take unexpected values if an error associated with modeling is great. As a result, it is more likely that proper control is not implemented, and responsiveness degrades.
The present invention is developed to solve the above described problems, and an object is to provide an adaptive control device and adaptive control method, and a control device and control method for an injection molding machine, which allow optimal adaptive control to be performed automatically and easily while preventing a degradation of responsiveness.
According to an aspect of the present invention, there is provided an adaptive control device comprising: a controller which outputs an operation value to a controlled target; 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 a 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.
In accordance with this configuration, the compensation value output from the parallel feed-forward compensator is automatically adjusted according to the frequency response characteristic of the controlled target which is sequentially identified. Therefore, it is not necessary to manually re-adjust the compensation value in response to a change in the controlled target. In addition, an unnecessary increase in the compensation value does not occur, which can prevent a degradation of responsiveness. Besides, since 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.
The identification section may sequentially identify a model of the controlled target, and estimate a transfer function of the controlled target, and the identification section may sequentially estimate the frequency response characteristic of the controlled target based on the estimated transfer function. This makes it possible to estimate the above frequency response characteristic by utilizing the known sequential identification method.
The identification section may use a linear black box model. In this configuration, the controlled target which can be identified is not limited to a particular model, and the adaptive control device is applicable to various controlled targets. Therefore, a versatile adaptive control device can be implemented.
The identification section may use a physical model of the controlled target. In this configuration, in a case where a physical structure of the controlled target is obvious, it becomes possible to construct an adaptive control device which provides a higher accuracy.
The identification section may estimate coefficients in polynomial representation of the linear black box model and unknown constants of the physical model, using a Kalman filter. In this configuration, the above adaptive control can be implemented by utilizing the known configuration.
The adjustment section may be 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. In this configuration, the compensation value output from the parallel feed-forward compensator can be adjusted appropriately for various controlled targets with a simple configuration.
The parallel feed-forward compensator may have a transfer function in a first order lag system.
The controller may include: 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 the plurality of adaptive gains may 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. In this configuration, in simple adaptive control, optimal adaptive control can be performed automatically and easily while preventing a degradation of responsiveness.
According to another aspect of the present invention, there is provided 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; 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 a 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.
In accordance with the above configuration, the pressure compensation value output from the parallel feed-forward compensator is automatically adjusted according to the frequency response characteristic of the injection molding machine which is sequentially identified. Therefore, it is not necessary to manually re-adjust the pressure compensation value in response to a change in a size of the hydraulic cylinder used in the injection molding machine, an injection material (material to be injected), etc. In addition, an unnecessary increase in the pressure compensation value does not occur, 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.
The adjustment section 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, 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. 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 has started the control of the injection molding machine, 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 is controlled using the frequency response characteristic sequentially identified. In this way, optimal adaptive control can be performed while preventing a degradation of responsiveness.
The control device may comprise a flow controller for controlling a flow of hydraulic oil inflowing to the hydraulic cylinder; wherein the control device may be 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. In this configuration, it becomes possible to switch between the flow control and the pressure control according to the state of the injection molding machine. Therefore, proper control can be implemented.
According to another aspect of the present invention, there is provided an adaptive control method using a control system constructed by adding a parallel feed-forward compensator to a controlled target, comprising the steps of: outputting an operation value to the controlled target; outputting 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 based on a 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.
In accordance with this method, the compensation value output from the parallel feed-forward compensator is automatically adjusted according to the frequency response characteristic of the controlled target which is sequentially identified. Therefore, it is not necessary to manually re-adjust the compensation value in response to a change in the controlled target. In addition, an unnecessary increase in the compensation value does not occur, which can prevent a degradation of responsiveness. Besides, since control parameters are adjusted based on the frequency response characteristic, a tolerance associated with modeling error is greater in the present method than in the conventional method 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 method, optimal adaptive control can be performed automatically and easily while preventing a degradation of responsiveness.
In the step of sequentially estimating the frequency response characteristic, a model of the controlled target may be sequentially identified, and a transfer function of the controlled target may be estimated, and the frequency response characteristic of the controlled target may be sequentially estimated based on the estimated transfer function. This makes it possible to estimate the frequency response characteristic by utilizing the known sequential identification method.
In the step of sequentially estimating the frequency response characteristic, a linear black box model may be used. In this method, the controlled target which can be identified is not limited to a particular model, and the adaptive control method is applicable to various controlled targets. Therefore, a versatile adaptive control method can be implemented.
In the step of sequentially estimating the frequency response characteristic, a physical model of the controlled target may be used. In this method, in a case where the physical structure of the controlled target is obvious, the adaptive control method can be made more accurate.
In the step of sequentially estimating the frequency response characteristic, coefficients in polynomial representation of the linear black box model and unknown constants of the physical model may be estimated, using a Kalman filter. In this method, the adaptive control can be implemented easily by utilizing the known method.
In the step of adjusting the compensation value, the compensation value may be 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. In this method, the compensation value output from the parallel feed-forward compensator can be adjusted appropriately for various controlled targets with a simple configuration.
The parallel feed-forward compensator may have a transfer function in a first order lag system.
The step of outputting the operation value may include 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. In this method, in the simple adaptive control, optimal adaptive control can be performed automatically and easily while preventing a degradation of responsiveness.
According to another aspect of the present invention, there is provided a method of controlling an injection molding machine which uses a control system constructed by adding 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 to a motor for adjusting the pressure in the hydraulic cylinder of the injection molding machine; outputting based on the pressure operation value, a 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 based on a 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.
In accordance with this method, the pressure compensation value output from the parallel feed-forward compensator is automatically adjusted according to the frequency response characteristic of the injection molding machine which is sequentially identified. Therefore, it is not necessary to manually re-adjust the pressure compensation value in response to a change in a size of the hydraulic cylinder used in the injection molding machine, an injection material (material to be injected), etc. In addition, an unnecessary increase in the pressure compensation value does not occur, which can prevent a degradation of responsiveness. Besides, since 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 method, optimal adaptive control can be performed automatically and easily while preventing a degradation of responsiveness.
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, may be selected, and the pressure compensation value may be adjusted based on the selected frequency response characteristic. In accordance with this method, 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 control has started, the pressure compensation value is adjusted using the predetermined frequency response characteristic or the frequency response characteristic estimated at past time in the step of sequentially estimating the frequency response characteristic, thereby preventing a situation in which the adaptive control becomes unstable, while in other cases, the injection molding machine is controlled using the frequency response characteristic identified sequentially. In this way, optimal adaptive control can be performed while preventing a degradation of responsiveness.
The method of controlling the injection molding machine may comprise 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, may be 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. In this method, it becomes possible to switch between the flow control and the pressure control according to the state of the injection molding machine. Therefore, proper control can be implemented.
The above and further objects, features and advantages of the invention will more fully be apparent from the following detailed description with accompanying drawings.
The present invention has been configured as described above, and has advantages that optimal adaptive control can be performed automatically and easily while preventing a degradation of responsiveness.
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.
[Overall Configuration]
The PFC 4 includes a PFC processor section 5 which computes the compensation value yf 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 yf output from the PFC processor section 5 based on the estimated frequency response characteristic of the controlled target 2.
To eliminate an offset resulting from addition of the compensation value yf of the PFC to the control valve y, the PFC 40 is sometimes caused to have a low-frequency cutoff characteristic as follows:
When the compensation value yf output from the PFC 40 is greater, the control system tends to be stabilized more easily. However, if the compensation value yf 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.
In contrast, in accordance with the above described configuration, the compensation value yf 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 yf 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 yf 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.
<Adjustment Method of PFC>
Hereinafter, the adjustment method of the compensation value in the PFC 4 will be described.
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−1)yr(k)=z−km B(z−1)ur(k)+v(k) (3)
ur(k) indicates an operation value (input data) at time k after the re-sampling, yr(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.
A(z−1) and B(z−1) are expressed as follows.
A(z−1)=1+a1z−1+a2z−2+ . . . +anoz−na
B(z−1)=b1z−1+b2z−2+ . . . +bnbz−nb (4)
a1, a2, . . . , ana indicate denominator parameters to be estimated, b1, b2, . . . , bnb 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.
In this case, a predicted value yp(k) which is one stage after output data yr(k) at time k based on input/output data at time k−1 and its previous time can be expressed as follows:
y
p(k)=φT(k)θ
θ=[a1 . . . ana b1 . . . bnb]T
φ(k)=[yr(k−1) . . . −yr(k−na) ur(k−km−1) . . . ur(k−km−nb)]T (5)
θ indicates a parameter vector and φ(k) indicates a data vector at time k.
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:
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.
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).
Hereinafter, an estimation procedure using the Kalman filter will be described specifically. Firstly, the identification section 6 calculates a predicted error εi (k) and a Kalman gain W(k) as follows, using an initial value θi(k) of the estimated parameter value and an initial value Pi(k) of error covariance matrix:
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)=θi(k)+W(k)εi(k) (9)
P(k)=Pi(k)−W(k)φT(k)Pi(k) (10)
Furthermore, time step is updated, and an initial value θi(k +1) of the estimated parameter value and an initial value Pi(k+1) of the error covariance matrix in next step are calculated:
θi(k+1)=θ(k) (11)
P
i(k+1)=P(k)+Q (1 2)
Since the variance Q of the parameters=0 in the steady state, the initial value Pi(k+1) of the error covariance matrix in next step is only P(k).
In the above described manner, the parameter vector θ is sequentially estimated.
A transfer function G(z) of the controlled target 2 is expressed as follows:
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.
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 ωf(hereinafter will also be simply referred to as PFC frequency ωf) and a gain Kf (hereinafter will also be simply referred to as PFC gain Kf) 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 ωp in which the phase lag of the controlled target 2 is equal to or greater than φp, using the identified transfer function G(z) of the controlled target 2 (step S4). In addition, the adjustment section 7 calculates a gain Kp=|G(z=exp(jωpTs))| corresponding to the frequency ωp (step S5). Ts indicates a control cycle.
The adjustment section 7 applies a smoothing filter to the found frequency ωp and the found gain Kp (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 ωpf and a filtered gain Kpf are found as follows:
ns indicates the number of data used for the moving average.
By using the filtered frequency ωpf and the filtered gain Kpf, which are found as described above, the adjustment section 7 multiplies the frequency ωp and the gain Kp in which the phase lag of the controlled target 2 is equal to or greater than the predetermined value φp, by predetermined coefficients (frequency coefficient αw and gain coefficient αk), respectively, using the identified transfer function G(z) of the controlled target 2, thereby designing the PFC frequency ωf and the PFC gain Kf of the transfer function Gf(z) of the PFC 4 as follows (step S8, step S9):
ωf(k)=αwωpf(k)
K
f(k)=αkKpf(k) (15)
The frequency coefficient αw and the gain coefficient αk are design parameters.
By using the PFC frequency ωf and the PFC gain Kf which are found as described above, the transfer function Gf(s) of the PFC 4 (PFC processor section 5) is found (step S10: adjustment step). Based on the found transfer function Gf(s) of the PFC 4, the compensation value yf is adjusted. In the present embodiment, the adjustment section 7 determines whether or not the value of the PFC frequency ωf and the value of the PFC gain Kf 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 ωf and the value of the PFC gain Kf 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 Gf(s) of the PFC 4 after the adjustment falls outside an adjustment range.
In a case where the PFC processor section 5 computes the transfer function Gf(s) of the PFC 4, used is a discrete time transfer function Gf(z) obtained by bilinear transformation of the continuous time transfer function Gf(s) as follows:
df indicates feedthrough term of the discrete time transfer function Gf(z) of the PFC 4. That is, the discrete time transfer function Gdf(z) means the transfer function of the PFC 4 obtained by excluding the feedthrough term. In this case, the compensation value yf is calculated as follows:
y
f
d(k+1)=afyfd(k)+bfu(k)
y
f(k)=yfd(k)+dfu(k) (18)
ydf(k) means a compensation value obtained by excluding the feedthrough term. The equation (18) is in some cases expressed as follows:
y
f(k)=Gf(z)u(k)=Gdf(z)u(k)+dfu(k)=ydf(k)+dfu(k) (19)
By adjusting the compensation value yf as described above, the compensation value yf output from the PFC 4 can be adjusted appropriately for various controlled targets 2 with a simple configuration.
<SAC Unit>
Next, the controller 3 of the present embodiment will be described.
The reference model is expressed as a discrete time state equation as follows to enable the computation performed by the computer:
x
m(k+1)=Amxm(k)+bmr(k)
y
m(k)=cmxm(k)+dmr(k) (20)
Am, bm, cm, and dm indicate parameters of the reference model.
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.
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 ym of the reference model application section 31.
y
f
d(k+1)=afyfd(k)+bfue(k)
y
f(k)=yfd(k)+dfue(k) (21)
Hereinafter, SAC operation will be described with reference to the equivalent block diagram of
The input (operation value) u to the controlled target is expressed as follows:
u
e(k)=Keea(k)
u
s(k)=Ksxm(k)+Kur(k)
u(k)=ue(k)+us(k) (22)
Adaptive gains Ku, Kx, Ke shown in the above equation (22) are found by proportional and integral adaptive tuning rule as follows;
γpe, γle, γpx, γlx, γpu, γln indicate tuning rule gains, respectively. Superscript i in each of Kx, γpx, γlx, indicates a gain corresponding to an i-th state amount xim of the reference model.
N(k) in the above equation (23) is a normalized signal, and is given by the following equation:
N(k)=√{square root over (m2+mir2(k)+mymym2(k))}{square root over (m2+mir2(k)+mymym2(k))} (24)
m, mu, mym indicate normalized parameters, respectively.
σe, σx, σu in the above equation (23) are a 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:
βe1 to βie3, βx1 to βx3, βu1 to βu3, Cx0, Cu0, Cem0 indicate design parameters. Each gain with superscript i indicates a gain corresponding to a i-th state amount xim of the reference model.
The output ea(k) of the first subtracter 35 which is used in calculation of the output ue (k) of the third multiplier 34 in the above equation (22) is, as shown in
u
e(k)=Keea(k)=Ke(y(k)+yf(k)−ym(k))=Ke(y(k)+ydf(k)−ym(k)+dfue(k)) (28)
As can be clearly seen from the above equation (28), ue(k) is required for the calculation of the output ue(k) of the third multiplier 34. Calculation cannot be performed unless the above equation (22) is modified. Accordingly, of the output ea(k) of the first subtracter 35, an observable portion except for feedthrough term is eda(k), which results in an equation which is capable of calculation as follows:
From the above, the control input (equation (22)) of the SAC unit is replaced as follows:
u
e(k)=Kdeeda(k)
u
s(k)=Kxxm(k)+Kur(k)
u(k)=ue(k)+us(k) (30)
In correspondence with the replacement of the feedback gain Ke 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:
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 Ke is replaced by Kde in the equation (29).
It should be noted that a case where Kde may fall outside the range according to a change in the transfer function Gf(z) of the PFC 4 is limited to a case of df(k)>df (k−1). Therefore, as shown below, adjustment of Kde may not be performed in the case of df(k)≦df(k−1).
Alternatively, Kde may be adjusted as follows. In this case, a response at a time point just after the feedthrough term df has changed is sometimes better as compared to the case where re-calculation is performed using the equation (32) and the equation (33).
<How to Consider in Adjustment Method of PFC>
Now, how to consider in the above stated adjustment method of the PFC will be described.
In light of this, it is designed that the output yf 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 yf 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
The gain Kp and the frequency ωp of the controlled target 2, at the threshold φp, are found using a numerical search method within the control cycle Ts. The gain Kp and the frequency ωp of the controlled target 2 are not required to have a high accuracy. Specifically, if the frequency coefficient αw and the gain coefficient α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 φ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 Kp and the frequency ω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 Ts is allowed even when the control cycle Ts is as short as about 0.002 to 0.005 second which is a general length.
When the threshold φp of the phase lag of the transfer function G(z) is, for example, 150 to 180 degrees, the frequency coefficient αw which is the design parameter in the equation (15) is set to about 1.0 to 5.0, while the gain coefficient αk which is the design parameter in the equation (15) is set to about 1.0 to 2.0.
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.
As shown in
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 yf used for compensating a feedback value ya 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 ya which is a sum of the pressure in the hydraulic cylinder 17 and the pressure compensation value yf output from the PFC 22. The configuration of the PFC 22 is similar to that of the above embodiment. Pressure control shown in
In accordance with the above configuration, the pressure compensation value yf 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 yf 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 yf 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.
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.
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.
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 device determines whether or not to switch from the flow control to the pressure 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.
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.
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.
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.
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.
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:
θ(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.
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:
p indicates the cylinder pressure [Pa], q indicates a flow [m3/s] of the hydraulic oil discharged to the cylinder, A indicates a cylinder cross-sectional area [m2], 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.
When the equation (36) is discretized, and expressed as a state equation considering a change in the volumetric elastic coefficient κ, the following is provided:
Q0 indicates a variance (changing magnitude) of the volumetric elastic coefficient, and R indicates a variance of observation noise. Ts indicates a control cycle [sec]. Note that the variance Q0 of the volumetric elastic coefficient is 0 in a steady state (state in which no change occurs in input/output).
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:
Hereinafter, the estimation procedure using the Kalman filter will be specifically described. Initially, using an initial value θi(k) of the estimated parameter value and an initial value Pi(k) of the error covariance matrix, the identification section 6 calculates the predicted error εi(k) and the Kalman gain W(k) as follows:
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)=θi(k)+W(k)εi(k) (41)
P(k)=Pi(k)−W(k)H(k)Pi(k) (42)
Furthermore, time step is updated, and then an initial value θi(k+1) of the estimated parameter value and an initial value Pi(k+1) of the error covariance matrix, in next step, are calculated:
θi(k +1)=F(k)θ(k) (43)
P
i(k+1)=F(k)P(k)FT(k)+Q (44)
In the steady state, the variance Q of the parameters is 0, and therefore, the initial value Pi(k+1) of the error covariance matrix in next step is only P(k).
By sequentially estimating the parameter value θ as described above, the volumetric elastic coefficient κ is estimated.
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:
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.
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.
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.
In a further alternative, the controller may be a sliding mode control section.
In an adaptive control device 1C of the example of
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 ym 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 Ts, parameters am, bm, cm, dm of reference model, tuning rule gains γpe, γpx, γpu, σ modification gains βe1 to βe3, βx1 to βx3, βu1 to β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 φp of the phase lag was 180 degrees, the frequency coefficient αk was 1.5, and the gain coefficient αk was 1.
As the model of the controlled target, used was a model in which the transfer function G(s) changed with time as follows:
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−0.025s/(5s+1)).
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−0.025s/(5s+1)), the compensation value of the PFC in Comparative example (
In contrast, it can be understood that in the present Example (
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.
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.
1, 1B, 1C adaptive control device
2 controlled target
3 controller
3B adaptive PID controller
3C sliding mode controller
4, 22 PFC
5 PFC processor section
6 identification section
7 adjustment section
10 injection molding machine
11 nozzle
12 injection cylinder
13 heater
14 hopper
15 screw
16 piston
17 hydraulic cylinder
18 hydraulic pump
19 servo motor (motor)
20 pressure controller
21 motor driving device
31 reference model application section
32 first multiplier
33 second multiplier
34 third multiplier
35 first subtracter
36 first adder
37 second adder
38 dynamic compensator
39 third adder
40 fourth adder
Number | Date | Country | Kind |
---|---|---|---|
2011-186989 | Aug 2011 | JP | national |
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/JP2012/004698 | 7/24/2012 | WO | 00 | 4/11/2014 |