This application claims the benefit of Japanese Patent Application No. 2009-085997 filed Mar. 31, 2009 in the Japan Patent Office, the disclosure of which is incorporated herein by reference.
This invention relates to a motor control device and an image forming system.
Conventionally, a control system is known in which disturbance is estimated by a disturbance observer and a control input is corrected based on the estimated disturbance.
The control system shown in
The control input u outputted from the controller 920 is corrected by adding thereto a correction amount d* generated in the disturbance observer 910. Disturbance is suppressed by inputting a corrected control input uc=u+d* into the controlled object, and the control output y is controlled to the target control output yr.
Specifically, the disturbance observer 910 generates a correction signal (uc−1/G(s)·y) for suppressing disturbance based on an inverse model 1/G(s) of the transfer function G(s) and the control input uc. The disturbance observer 910 filters the correction signal through a low-pass filter 930, and outputs a filtered correction signal as a correction signal representing the above correction amount d*.
A reason why the correction signal (uc−1/G(s)·y) is filtered through the low-pass filter 930 is that the transfer function G(s) of the controlled object exhibits such frequency characteristics that the higher a frequency of a high-frequency component in the correction signal is, the lower a gain becomes.
When the transfer function G(s) exhibits such frequency characteristics, it should be appreciated that the inverse model 1/G(s) exhibits such frequency characteristics that the higher a frequency of a high-frequency component in the correction signal is, the higher a gain becomes. On the other hand, a measurement signal of the control output y includes a lot of observation noise in a high-frequency component.
Accordingly, when the measurement signal of the control output y is inputted into the inverse model 1/G(s) to generate the correction signal (uc−1/G(s)·y), the observation noise is amplified in the correction signal. Therefore, the low-pass filter 930 is used to suppress influence of the observation noise and accurately achieve disturbance suppression.
In order to suppress the influence of the observation noise by using the low-pass filter 930, it is preferable to reduce a cutoff frequency ωc of the low-pass filter 930. In contrast, in order to fully obtain disturbance information to generate an appropriate correction signal, it is preferable to increase the cutoff frequency ωc.
However, since these situations are mutually contradictory, there are some limitations, in the prior art, in suppressing disturbance even if the control input u outputted from the controller 920 is corrected using the disturbance observer 910. In short, in the prior art, there are limitations in achieving a high accuracy control by suppressing influence of disturbance.
In a first aspect of the present invention, it is preferable to be able to suppress disturbance more accurately, in a control system, than was conventionally possible.
A motor control device according to the present invention includes a correction input unit, a measurement unit, a first signal processing unit, and a second signal processing unit.
The correction input unit corrects a control input signal outputted from a controller, and inputs a corrected control input signal into a motor.
The measurement unit measures a physical quantity resulting from rotation of the motor corresponding to a control output.
The first signal processing unit inputs a measurement signal representing the physical quantity inputted from the measurement unit into an inverse model 1/G of a transfer function G of a controlled object, and filters an output of the inverse model 1/G through a first low-pass filter.
The second signal processing unit obtains a corrected control input signal to be inputted into the motor by the correction input unit, and filters the control input signal through a second low-pass filter.
In this motor control device, the correction input unit corrects the control input signal outputted from the controller by adding a signal filtered by the second signal processing unit to the control input signal outputted from the controller and also by subtracting a signal filtered by the first signal processing unit from the control input signal outputted from the controller. A cutoff frequency of the second low-pass filter is set to be higher than that of the first low-pass filter.
The preferred embodiments of the present invention will be described hereinafter with reference to the accompanying drawings, in which:
First of all, a basic design methodology and a basic constitution of a control system according to the present invention will be described.
[Design Methodology and Constitution of Control System]
Prior to constructing the control system 100 shown in
Then, in order to suppress disturbance, a signal processor 120 is designed using an inverse model 1/G(s) of the transfer function G(s).
Specifically, the signal processor 120 is designed in which an input/output relationship is represented by a synthetic transfer function E(s)=F(s,ωy)/G(s), which is obtained by synthesizing the inverse model 1/G(s) and a transfer function F(s,ωc=ωy) functioning as a low-pass filter. The low-pass filter has a cutoff frequency ωc, which is equal to ωy (ωc=ωy).
The cutoff frequency ωy is determined in consideration of observation noise of the control output y. Hereinafter, the signal processor 120 is referred to as a first signal processor 120. Generally, the transfer function F(s,ωc=ωy) may be represented by the following mathematical formula (1), wherein a variable n is a relative degree n=n2−n1 between n1 and n2. n1 represents a degree of a numerator of the transfer function G(s), and n2 represents a degree of a denominator of the transfer function G(s).
The control system 100 is designed so that a measurement signal representing the control output y is inputted into the first signal processor 120.
If disturbance −d is added to a control input uc, which is inputted into the controlled object, an output of the inverse model obtained by inputting the control output y into the inverse model 1/G(s) becomes (1/G(s))·y=uc−d. Accordingly, an output (d1=E(s)·y) of the first signal processor 120 is a signal obtained by applying the low-pass filter to a signal obtained by adding the disturbance to the control input uc.
In addition, a second signal processor 130 is introduced to the control system 100. The second signal processor 130 is the same type as the low-pass filter adopted in the first signal processor 120, and is a low-pass filter (transfer function F(s,ωc=ωu)) having a higher cutoff frequency ωu than the cutoff frequency ωy of the first signal processor 120 (ωu>ωy). The cutoff frequency ωu is determined within a frequency band higher than the cutoff frequency ωy in consideration of disturbance.
The control system 100 is designed so that a control input signal is inputted into the second signal processor 130. The control input signal represents the control input uc to be inputted into the controlled object.
In addition, a correction signal generator 140 is introduced to the control system 100. The correction signal generator 140 subtracts the output (d1=(F(s,ωy)/G(s))·y) of the first signal processor 120 from an output (d2=(F(s,ωu)·uc) of the second signal processor 130 to generate a correction signal representing a correction amount d*=d2−d1.
A corrector 150 is additionally introduced to the control system 100. The corrector 150 corrects a control input signal (control input u0) outputted from the controller 110 by adding the correction signal (correction amount d*) outputted from the correction signal generator 140 to the control input signal representing the control input u0 outputted from the controller 110. Then, a corrected control input signal (control input uc=u0+d*) is inputted into the controlled object. In this way, the control system 100, which has adopted technical idea of the present invention, is designed.
According to the control system 100, the correction signal (correction amount d*) is generated using the two low-pass filters having different cutoff frequencies ωc. The control input signal outputted from the controller 110 is corrected using the correction signal. Consequently, the observation noise can be appropriately removed while keeping disturbance information unremoved. Disturbance can be, therefore, accurately suppressed and the control output y can be controlled to the target control output yr.
In the meantime, the control system 100 may be made to have a constitution shown in
The control system 160 shown in
In the control system 160, the signal processor 170 inputs a measurement signal representing the control output y into the transfer function E(s). On the other hand, the precorrector 180 corrects the control input signal (control input u0) by subtracting an output (d1=E(s)·y) of the signal processor 170 from the control input signal (control input u0) outputted from the controller 110.
And the postcorrector 190 inputs a control input signal (control input u1=u0−E(s)·y) corrected by the precorrector 180 into a transfer function H(s) represented by the following mathematical formula (2) to generate a final control input signal (control input uc=H(s)·u1) to be inputted into a controlled object. A transfer function F(s,ωu) shown in the mathematical formula (2) is a transfer function of the low-pass filter adopted in the second signal processor 130 in the control system 100.
Then, the postcorrector 190 inputs the control input signal (control input uc=H(s)·u1) into the controlled object. The control system 160 constituted as such can also perform a similar signal processing as in the control system 100. As a result, disturbance can be accurately suppressed and the control output y can be controlled to the target control output yr.
Accordingly, in constructing a control system according to the present invention, either constitution of the control system 100 or the control system 160 may be adopted.
[Examples of Application to Printer Apparatus]
Next, a constitution of a printer apparatus 1 to which the control system 100 or 160 is adopted will be described as an embodiment of the present invention.
As shown in
The printer apparatus 1 also includes a recording head 21, a head driving circuit 23, a CR (carriage) motor 51, a driving circuit 53, and an encoder 55 (so-called rotary encoder). The recording head 21 includes a plurality of nozzles arranged thereon that eject ink droplets. The driving circuit 23 drives the recording head 21 to eject the ink droplets. The CR motor 51 supplies drive power to a carriage conveyance mechanism 40 to move a carriage 41 carrying the recording head 21 in a main scanning direction. The CR motor 51 is composed of a direct current motor. The driving circuit 53 drives the CR motor 51. The encoder 55 is provided on a rotation shaft of the CR motor 51 to output pulse signals each time the CR motor 51 rotates a predetermined angle.
The printer apparatus 1 further includes a sheet conveyance mechanism 60, an LF (line feed) motor 71, a driving circuit 73, and an encoder 75 (rotary encoder) as constituents that convey a sheet to a position where printing is performed by the recording head 21.
The sheet conveyance mechanism 60 includes a plurality of conveyance rollers 61 (see
As shown in
The endless belt 45 is supported by and between a pulley 47 and an idle pulley 48. The endless belt 45 receives drive power from the CR motor 51 via a gear (not shown) provided on a rotation shaft of the pulley 47. In other words, in the carriage conveyance mechanism 40, the endless belt 45 rotates together with rotation of the pulley 47, and thereby the carriage 41 moves in the main scanning direction along the guide shaft 43.
In the present embodiment, the recording head 21 mounted on the carriage 41 is constituted identically to a known piezo type ink-jet head. Specifically, when a driving voltage is applied from the head driving circuit 23 (see
The sheet conveyance mechanism 60 is constituted such that the conveyance rollers 61 rotate in receipt of rotation force of the LF motor 71 via a gear (not shown) and thereby the sheet moves in the sub-scanning direction.
When an image is formed onto the sheet by means of the recording head 21, the sheet is conveyed in such a manner that, each time the recording head 21 moves in the main scanning direction to form an image onto the sheet by a predetermined number of lines, a predetermined amount of the sheet is sent forth due to the rotation of the conveyance rollers 61.
See
The motor controller 30 includes a CR motor controller 31 and an LF motor controller 35. The CR motor controller 31 controls the CR motor 51, and the LF motor controller 35 controls the LF motor 71 in accordance with a command from the CPU 11.
Specifically, the CR motor controller 31 measures an angular velocity ω of the CR motor 51 based on the pulse signals inputted from the encoder 55. On the basis of a result of the measurement, the CR motor controller 31 controls the angular velocity ω of the CR motor 51 to achieve a target velocity ωr. Through this operation, the CR motor controller 31 controls a moving speed of the carriage 41 which moves in synchronization with rotation of the CR motor 51. Specifically, the moving speed of the carriage 41 is controlled so that the carriage 41 moves at a constant speed in an area where an image is formed onto a sheet.
On the other hand, the LF motor controller 35 measures a rotation amount θ of the LF motor 71 based on the pulse signals inputted from the encoder 75. On the basis of a result of the measurement, the LF motor controller 35 controls the rotation amount θ of the LF motor 71 to achieve a target rotation amount θr. Through this operation, the LF motor controller 35 controls a moving amount (feeding amount) of a sheet which moves in synchronization with rotation of the LF motor 71.
In other words, when the print command and the print object data are inputted via the interface 19, the CPU 11 operates the print controller 20 to make the recording head 21 perform ejecting operation of ink droplets in order to form an image based on the print object data onto the sheet. Additionally, the CPU 11 operates the CR motor controller 31 to move the carriage 41 (and therefore the recording head 21) in the main scanning direction. Each time the carriage 41 moves along a moving path in the main scanning direction from end to end, the CPU 11 further operates the LF motor controller 35 to move the sheet by a predetermined amount in the sub-scanning direction. As a result, the image is gradually formed onto the sheet, and the image based on the print object data is to be completed on the sheet.
Now, a constitution of the CR motor controller 31 will be detailed. As shown in
The speed detector 311 measures the angular velocity ω of the CR motor 51 based on the pulse signals inputted from the encoder 55, and inputs a measurement signal representing a measurement ωm of the angular velocity ω into the speed controller 313 and the disturbance suppressor 314.
On the other hand, the target speed command unit 312 inputs a target command signal representing a target speed ωr into the speed controller 313 in accordance with a predetermined target profile. The target speed ωr shown in the target profile includes an acceleration region, a constant speed region, and a deceleration region as in a known ink-jet printer. And the carriage 41 is constituted to move at a constant speed in an area where an image is formed onto a sheet with ink droplets ejected by the carriage 41.
The speed controller 313 generates a control input signal for controlling the CR motor 51 based on the measurement signal representing the angular velocity ω inputted from the speed detector 311 and the target command signal inputted from the target speed command unit 312, and inputs the control input signal into the disturbance suppressor 314. In the present embodiment, a constitution is adopted in which current control is performed on the CR motor 51. The speed controller 313 inputs the control input signal (control input u0), which represents an input current to the CR motor 51, into the disturbance suppressor 314.
Specifically, the speed controller 313 inputs the control input signal representing a manipulated variable (control input u0) into the disturbance suppressor 314 based on the target speed ωr and the measurement ωm of the angular velocity. The manipulated variable is intended to reduce a deviation e=ωr−ωm between the target speed ωr and the measurement ωm.
As shown in
The driving circuit 53 drives the CR motor 51 with a current amount corresponding to the control input uc represented by the control input signal inputted from the corrector 314d. Influence of cogging or the like of a motor may be thereby suppressed and, consequently, the CR motor 51 is so driven as to rotate at the target speed ωr.
When a motor system of the CR motor 51 connected to the carriage conveyance mechanism 40 is expressed using a rigid body model, the motor system may be represented by the following mathematical formula (3).
In the above mathematical formula (3), i represents input current to the CR motor 51, K represents a torque constant, and J represents a moment of inertia. Accordingly, when i is set to the control input u, and ω is set to the control output y, a transfer function G(s) of the CR motor 51 may be represented by the following mathematical formula (4).
In
Specifically, the first signal processor 314a inputs the measurement signal representing the angular velocity ω outputted from the speed detector 311 into a synthetic transfer function E(s) represented by the following mathematical formula (5). The synthetic transfer function E(s) is obtained by synthesizing the inverse model 1/G(s) of the transfer function G(s) and the transfer function F(s,ωy) functioning as the low-pass filter.
The first signal processor 314a inputs an output (d1=E(s)·ωm) of the synthetic transfer function E(s) into the correction signal generator 314c. According to the synthetic transfer function E(s), a high-pass filter may be achieved in which a gain of a high frequency component is suppressed. Therefore, according to the present embodiment, saturation of the high-frequency component in an output signal of the inverse model may be inhibited.
On the other hand, the second signal processor 314b obtains the control input signal (control input uc) to be inputted into the driving circuit 53, and filters the control input signal with a transfer function F(s,ωu) functioning as a low-pass filter, which is represented by the following mathematical formula (6).
Then, the second signal processor 314b inputs a filtered signal (d2=F(s,ωu)·uc) into the correction signal generator 314c.
The correction signal generator 314c subtracts the output (d1=E(s)·ωm) of the first signal processor 314a from the output (d2=F(s,ωu)·uc) of the second signal processor 314b to generate a correction signal having a correction amount d*=d2−d1, and inputs the generated correction signal into the corrector 314d.
Then, the corrector 314d adds the correction signal (correction amount d*) inputted from the correction signal generator 314c to the control input signal (control input u0) inputted from the speed controller 313. Further, the corrector 314d inputs a corrected control input signal (control input uc=u0+d*) into the driving circuit 53. The cutoff frequency ωu is, of course, greater than the cutoff frequency ωy (ωu>ωy).
According to the CR motor controller 31 having the disturbance suppressor 314 constituted as such, influence of disturbance such as cogging may be suppressed and, therefore, it is possible to allow the CR motor 51 to accurately rotate at the target speed ωr. As a result, when ink droplets are ejected from the recording head 21, fluctuation of the speed of the carriage 41 can be inhibited more appropriately than was conventionally possible.
Consequently, according to the printer apparatus 1 of the present embodiment, it can be inhibited that image quality of an image formed onto a sheet is deteriorated because landing positions of the ink droplets ejected from the recording head 21 are displaced due to the fluctuation of the speed of the carriage 41. As a result, an image with higher quality than was conventionally possible can be formed onto the sheet without being influenced by cogging or the like of the motor.
In the meantime, the disturbance suppressor 314 may have a similar constitution as in the control system 160 (see
As shown in
In the disturbance suppressor 314′, the precorrector 314f subtracts an output (d1=E(s)·ωm) of the signal processor 314e from the control input signal (control input u0) inputted from the speed controller 313 to generate a control input signal representing a control input u1=u0−E(s)·ωm.
The postcorrector 314g inputs the control input signal (control input u1=u0−E(s)·ωm) corrected by the precorrector 314f into a transfer function H(s) presented by the following mathematical formula (7) to generate a final control input signal (control input uc=H(s)·u1) to be inputted into the driving circuit 53.
Then, the postcorrector 314g inputs the control input signal (control input uc=H(s)·u1) into the driving circuit 53. The cutoff frequency ωu is, of course, greater than the cutoff frequency ωy (ωu>ωy).
The disturbance suppressor 314′ constituted as such can also accurately suppress disturbance and control the angular velocity ω of the CR motor 51 to the target speed ωr. Consequently, it can be inhibited that the impact points of the ink droplets are displaced and, therefore, an image with high image quality can be formed onto a sheet.
[Examples of Application to Position Control System]
Now, examples where the control system 100 or 160 is applied to a position control system will be described. For example, it is assumed that the CR motor controller 31 is constituted to switch a motor control from a speed control to a position control during deceleration of the carriage 41, and to control the CR motor 51 by the position control system.
In this case, as shown in
In the position control system shown in
On the other hand, the target position command unit 317 inputs a target command signal representing a target position (rotation amount) θr into the position controller 318 in accordance with a target profile. Then, the position controller 318 generates a control input signal (control input u0), which represents an input current to the CR motor 51, based on the measurement signal representing the rotation amount θ inputted from the position detector 316 and the target command signal inputted from the target position command unit 317. The position controller 318 inputs the generated control input signal into the disturbance suppressor 319.
Specifically, the position controller 318 inputs the control input signal representing a manipulated variable (control input u0) into the disturbance suppressor 319 based on the target position θr and the measurement θm of the rotation amount. The manipulated variable is intended to reduce a deviation e=θr−θm between the target position θr and the measurement θm.
As shown in
Then, the driving circuit 53 controls the rotation amount θ of the CR motor 51 to the target position θr by driving the CR motor 51 with a current amount corresponding to the control input uc represented by the control input signal inputted from the corrector 319d.
When a motor system of the CR motor 51 connected to the carriage conveyance mechanism 40 is expressed using a rigid body model, a transfer function G(s) representing an input/output relationship is represented by the following mathematical formula (8). This is based on the assumption that the control input u is an input current to the CR motor 51 and the control output y is a rotation amount θ of the CR motor 51
In
In this case, the first signal processor 319a inputs the measurement signal outputted from the position detector 316 into a synthetic transfer function E(s) represented by the following mathematical formula (9). The synthetic transfer function E(s) is obtained by synthesizing the inverse model 1/G(s) and the transfer function F(s,ωy) functioning as a low-pass filter.
The first signal processor 319a inputs an output (d1=E(s)·θm) of the synthetic transfer function E(s) into the correction signal generator 319c.
On the other hand, the second signal processor 319b obtains the control input signal (control input uc) to be inputted into the driving circuit 53, and filters the control input signal with a transfer function F(s,ωu) represented by the following mathematical formula (10).
The first signal processor 319a inputs a filtered signal (d2=F(s,ωu)·uc) into the correction signal generator 319c.
Then, the correction signal generator 319c subtracts the output (d1=E(s)·θm) of the first signal processor 319a from the output (d2=F(s,ωu)·uc) of the second signal processor 319b to generate a correction signal having a correction amount d*=d2−d1. The corrector 319d adds the correction signal (correction amount d*) inputted from the correction signal generator 319c to the control input signal (control input u0) inputted from the position controller 318. Furthermore, the corrector 319d inputs a corrected control input signal (control input uc=u0+d*) into the driving circuit 53. The cutoff frequency ωu is, of course, greater than the cutoff frequency ωy (ωu>ωy).
When the disturbance suppressor 319 constituted as such is used, it is possible to accurately suppress disturbance and control the rotation amount θ of the CR motor 51 to the target position θr.
The LF motor controller 35 controls the LF motor 71 with a position control system. Therefore, a constitution similar to the above-described position control system of the CR motor controller 31 may be adopted to the LF motor controller 35 to suppress disturbance.
In the meantime, the disturbance suppressor 319 may have a similar constitution as in the control system 160 (see
As shown in
The signal processor 319e corresponds to the signal processor 170 in the control system 160.
The precorrector 319f and the postcorrector 319g are constituted to correct the control input signal (control input u0) outputted from the position controller 318. The precorrector 319f corresponds to the precorrector 180 in the control system 160. The postcorrector 319g corresponds to the postcorrector 190 in the control system 160. As shown in
The disturbance suppressor 319′ constituted as such can also accurately suppress disturbance and control the rotation amount θ of the CR motor 51 to the target position θr.
[Others]
While the embodiments of the present invention have been described above, the present invention is not limited to the above embodiments but various modifications thereof may be adopted. For example, a linear encoder may be used as the encoder 55 instead of the rotary encoder.
Specifically, the printer apparatus 1 may include a linear encoder that detects a position of the carriage 41. The linear encoder is composed of a timing slit having slits formed thereon at constant minute intervals along the guide shaft 43; and a sensor element provided in the carriage 41. The sensor element reads off the intervals of the slits formed on the timing slit and outputs pulse signals corresponding to the position of the carriage 41.
In this case, based on the pulse signals of the linear encoder, the speed detector 311 measures the speed of the carriage 41, and the position detector 316 measures the position of the carriage 41 on the carriage conveyance path. The CR motor controller 31 and the LF motor controller 35 may be constituted to use the above measured speed and position as measurements representing the control output y.
Each constitutions described in the embodiments corresponds to that described in claims as follows: The encoder 55, the speed detector 311, and the position detector 316 are examples of a measurement unit. The first signal processors 120, 314a, and 319a are examples of a first signal processing unit. The second signal processors 130, 314b, and 319b are examples of a second signal processing unit.
The correctors 150, 314d, and 319d, and the correction signal generators 140, 314c, and 319c; or the precorrectors 180, 314f, and 319f, and the postcorrectors 190, 314g, and 319g are examples of a correction input unit. The signal processors 170, 314e, and 319e are examples of a signal processing unit.
The recording head 21 is an example of a printing unit, and the CR motor 51 is an example of a motor that conveys the printing unit.
Number | Date | Country | Kind |
---|---|---|---|
2009-085997 | Mar 2009 | JP | national |
Number | Name | Date | Kind |
---|---|---|---|
5467004 | Matsuo et al. | Nov 1995 | A |
5710500 | Matsuo et al. | Jan 1998 | A |
20050120444 | Takenaka | Jun 2005 | A1 |
20100245409 | Iesaki | Sep 2010 | A1 |
Number | Date | Country |
---|---|---|
H02-010411 | Jan 1990 | JP |
H07-046874 | Feb 1995 | JP |
H09-282008 | Oct 1997 | JP |
H11-031014 | Feb 1999 | JP |
2004-110636 | Apr 2004 | JP |
2006-301682 | Nov 2006 | JP |
2007-283561 | Nov 2007 | JP |
2008-137449 | Jun 2008 | JP |
03058355 | Jul 2003 | WO |
Number | Date | Country | |
---|---|---|---|
20100245450 A1 | Sep 2010 | US |