The present invention relates to a feedback control method and apparatus in which a delay element is present in a controller or a control object or a dead time is present in the input and output of the control object.
A dead time or a delay element of a filter is present in a controller or a control object in most control systems such as a servo and a process control.
In
In order to compensate for the phase delay, conventionally, a phase leading compensation element 12 is often added in series as shown in
In the conventional phase compensation control method, however, there has been a problem in that a gain in the high-frequency region of the phase leading compensation element is increased and a high-frequency oscillation is apt to be caused.
Moreover, a dead time is present in the inputs or outputs of most control systems such as a servo and a process control.
Conventionally, a Smith compensator shown in
The disturbance removing characteristic of the conventional Smith method will be taken into consideration. Assuming that a disturbance d is present on a control input end as shown in
When the steady value of the control output y for a step disturbance d(s)=1/s is represented by ysd, the following equation can be obtained.
If C(s) has an integrator, the following equation can be set up.
If P(s) has a pole of s=0, ysd≠0 is obtained. More specifically, in the Smith method, there is a problem in that a steady-state deviation is made for a control object having the pole of s=0. Moreover, if P(s) is unstable in the equation (1), there is a problem in that an output diverges even if any small disturbance is made.
It is an object of the invention to provide a control apparatus which can increase a control gain and has an excellent responsiveness.
It is another object of the invention to provide a feedback control apparatus capable of compensating for the phase delay of a delay element so as not to make a high-frequency oscillation and causing a control output to follow a target input with high precision in a control system in which a delay element is present in a controller or a control object.
It is a further object of the invention to provide a dead time compensation feedback control apparatus capable of constituting a stable control system for an unstable control object without making a steady-state deviation for a control object having a pole of s=0.
In order to attain the object, the invention provides a feedback control apparatus comprising a controller, a control object to be controlled by the controller, and an observer for inputting a control output from the control object and an output of the controller and setting an output of a control object model to be a feedback signal, wherein the observer includes an observer compensator for inputting a difference between the control output and an output of an element model and inputs, to the control object model, a sum of an output of the observer compensator and the output of the controller, and a control apparatus for carrying out a feedback control to cause a control output to follow a target input for a control system in which a delay element is present in a controller or a control object, wherein an observer is constituted in such a manner that a difference between the control output and an output of the observer is input to an observer compensator, an output of the observer compensator and an output of a main controller are added and input to an element model having no delay of the control object, and a signal obtained by sending an output of the element model having no delay of the control object through a delay element model of the controller and a delay element model of the control object is set to be the output of the observer, and the output of the element model having no delay of the control object is subtracted from the target input and is input to the main controller, and a signal obtained by sending an output of the main controller through a delay element of the controller is set to be a control input, thereby controlling the control object. Moreover, the invention provides a feedback control apparatus for causing a control output to follow a target input for a control object in which a dead time is present in an input or an output, wherein an observer is constituted in such a manner that a difference between the control output and an output of a dead time element of the control object is input to an observer compensator, an output of the observer compensator and a control input are added and input to a prediction model of the control object, and an output of the prediction model of the control object is input to the dead time element of the control object, and furthermore, is set to be a prediction value of the control output, and the prediction value of the control output is subtracted from the target input and a value thus obtained is input to a controller and an output of the controller is set to be the control input.
An embodiment of the invention will be described with reference to the drawings.
In general, it is necessary to provide a filter in order to remove a noise when constituting the controller. In the control object, moreover, a dead time element or a primary delay element is present in a control input or a control output. If these delay elements are not separated, it is hard to constitute the main controller in order to simultaneously satisfy a stability and a control performance. Therefore, the controller is divided into the main controller 2 and the delay element 3 of the controller and an observer including the delay element of the controller is constituted based on an output u1 of the main controller and a control output y, and an output having no delay of the observer is set to be a feedback signal yf.
More specifically, the output u1 of the main controller 2 and the output of the observer compensator 11 are added in 6 and input to the element model 7 having no delay of the control object. The output of the element model 7 having no delay of the control object is set to be the feedback signal yf of the control system and a signal obtained by subtracting the feedback signal yf from a target input r through a subtracter 1 is input to the main controller 2 and the output u1 of the main controller 2 is input to the control object through the delay element 3 of the controller, thereby controlling the control object, while it is input to a subtracter 10 through the delay element model 8 of the controller and the delay element model 9 of the control object and a signal obtained by a subtraction is input from the control output y to the observer compensator 11.
Referring to
yf(s)/u1(s)=P(s) (4)
Therefore, the control system in
y(s)/r(s)=C1(s)P(s)/1+C1(s)P(s)Fc(s)Fp(s) (5)
Therefore, it is possible to cause the output y to follow the target input r with high precision by increasing the gain of the main controller 2.
Although an observer loop has a delay element, an input/output characteristic is not related to the observer compensator 11 based on the equation (5). For this reason, the gain of the observer compensator 11 may be set to be low. Accordingly, a stable observer can easily be constituted.
Another embodiment of the invention will be described with reference to the drawings.
Referring to
yf(s)/u(s)=P(s) (6)
Therefore, the control system in
y(s)/r(s)=C(s)P(s)e−Ls/1+C(s)P(s) (7)
Therefore, it is possible to cause the output y to follow the target input r with high precision by increasing the gain of the controller C(s).
In order to consider a disturbance removing characteristic, a disturbance d is given to a control input end as shown in FIG. 7. Referring to
When the steady value of an output for a step disturbance d(s)=1/s is represented by ysd, the following equation is obtained.
Both the controller C(s) and an observer compensator Co(s) have integrators, the following equation is obtained.
ysd=0 (10)
More specifically, a steady-state deviation is not made for a control object having a pole of s=0. Referring to the equation (6), moreover, even if P(s) is unstable, an output does not diverge when C(s) stabilizes P(s) and Co(s) stabilizes P(s)e−Ls. Referring to the equation (7), the input/output characteristic is not related to Co(s). Therefore, the gain of Co(s) can be set to be low in such a manner that the P(s)e−Ls is stabilized.
Items 21, 24, 27 and 29 in
As described above, in the invention, the observer including the delay element of the controller is constituted and the output having no delay of the observer is set to be the feedback signal so that the control system is divided into a feedback control section and an observer section. The stability of a feedback loop is the same as that of a system having no delay and a control gain is increased. Consequently, the response performance of the control system can be enhanced. On the other hand, an observer loop has a delay element and an observer compensator does not influence an input/output characteristic. Consequently, the gain of the observer compensator may be set to be low. Thus, a stable observer can easily be constituted.
In the invention, moreover, the observer of the dead time system is constituted and the prediction value of the control output is set to be the feedback signal. Consequently, the control system is divided into the feedback control section and the observer section and the stability of the feedback loop is the same as that of a system having no dead time and a control gain is increased. Consequently, the response performance of the control system can be increased. In addition, since the observer is constituted, it is possible to obtain a high resistance to a disturbance as well as a stable object.
Industrial Applicability
According to the invention, a control system having an excellent response performance can be constituted and a stable observer can easily be constituted.
| Number | Date | Country | Kind |
|---|---|---|---|
| 2000-379600 | Dec 2000 | JP | national |
| 2001-026766 | Feb 2001 | JP | national |
| Filing Document | Filing Date | Country | Kind | 371c Date |
|---|---|---|---|---|
| PCT/JP01/10951 | 12/13/2001 | WO | 00 | 6/13/2003 |
| Publishing Document | Publishing Date | Country | Kind |
|---|---|---|---|
| WO02/48806 | 6/20/2002 | WO | A |
| Number | Name | Date | Kind |
|---|---|---|---|
| 4195337 | Bertrand et al. | Mar 1980 | A |
| 5371449 | Tajima et al. | Dec 1994 | A |
| 5479897 | Kawai et al. | Jan 1996 | A |
| 5544039 | Hiroi | Aug 1996 | A |
| 5568378 | Wojsznis | Oct 1996 | A |
| 5651341 | Harada et al. | Jul 1997 | A |
| 5828014 | Goto et al. | Oct 1998 | A |
| 5936858 | Arai | Aug 1999 | A |
| 5992383 | Scholten et al. | Nov 1999 | A |
| 6185467 | Romano et al. | Feb 2001 | B1 |
| 6289971 | Kagawa | Sep 2001 | B1 |
| 6453229 | Ohkuma et al. | Sep 2002 | B1 |
| 6584367 | Makino et al. | Jun 2003 | B1 |
| 20020111758 | Wang et al. | Aug 2002 | A1 |
| Number | Date | Country |
|---|---|---|
| 63-67605 | Mar 1988 | JP |
| 03093486 | Apr 1991 | JP |
| 03110605 | May 1991 | JP |
| 05313754 | Nov 1993 | JP |
| 7-121205 | May 1995 | JP |
| 09311701 | Dec 1997 | JP |
| 64-48104 | Feb 1998 | JP |
| 11-85204 | Mar 1999 | JP |
| 11-344983 | Dec 1999 | JP |
| Number | Date | Country | |
|---|---|---|---|
| 20040054440 A1 | Mar 2004 | US |