WO2016051478A1 - 自動制御装置 - Google Patents
自動制御装置 Download PDFInfo
- Publication number
- WO2016051478A1 WO2016051478A1 PCT/JP2014/075948 JP2014075948W WO2016051478A1 WO 2016051478 A1 WO2016051478 A1 WO 2016051478A1 JP 2014075948 W JP2014075948 W JP 2014075948W WO 2016051478 A1 WO2016051478 A1 WO 2016051478A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- filter
- output value
- filter coefficient
- coefficient
- value
- Prior art date
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/406—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by monitoring or safety
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/32—Automatic controllers electric with inputs from more than one sensing element; with outputs to more than one correcting element
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
- G05B19/05—Programmable logic controllers, e.g. simulating logic interconnections of signals according to ladder diagrams or function charts
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41025—Detect oscillation, unstability of servo and change gain to stabilize again
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41116—Compensation for instability
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41423—Noise filter as function of rate of displacement, speed, for stabilisation
Definitions
- the technology disclosed in this specification relates to an automatic control device.
- Japanese Patent Application Laid-Open No. 2008-509480 discloses an automatic control device.
- the automatic control device of Patent Document 1 includes a first control unit that uses the output of the first sensor, a second control unit that uses the output of the second sensor, and a switching unit that switches between the first control unit and the second control unit. I have.
- the control unit is controlled by switching the first control unit and the second control unit by the switching unit.
- a first control unit that performs feedback control using a first sensor (position sensor) and a second control unit that performs feedback control using a second sensor (pressure sensor) are switched.
- the operation of the controlled object may become unstable when changing parameters (coefficients) used for control.
- the filter coefficient used for the digital filter is switched, the input value input to the control target varies greatly, and the control target Operation may become unstable.
- the prior art has not proposed a technique for dealing with such instability of the controlled object.
- This specification describes an automatic control apparatus that outputs the output of a control unit to a control target through a filter, and performs automatic control that can perform stable control when switching filter coefficients and can perform switching of filter coefficients in a short time.
- An object is to provide a control device.
- the automatic control device disclosed in this specification controls a control target.
- the automatic control device includes a control unit that calculates the operation amount of the control target based on the difference between the target value of the control amount of the control target and the current value.
- the automatic control device is arranged in parallel with the first filter that filters the operation amount calculated by the control unit using a predetermined filter coefficient and outputs the first output value, and the first filter.
- a second filter that outputs a second output value by filtering an operation amount calculated by the control unit using a predetermined filter coefficient different from the filter coefficient.
- the automatic control device includes a switching unit that switches between the first output value of the first filter and the second output value of the second filter and sends one of the output values to the control target.
- various filter coefficients can be selectively input to the first filter and the second filter.
- the first filter coefficient or the second filter coefficient can be selectively input to the first filter.
- a third filter coefficient can be input to the second filter.
- the first output value using the first filter coefficient or the first output value using the second filter coefficient is output from the first filter.
- a second output value using the third filter coefficient is output from the second filter.
- the first output value and the second output value are switched by the switching unit, and either one of the output values is input to the control target. In this way, the control state of the controlled object is changed by changing the filter coefficient.
- the operation amount input to each filter is a temporally continuous value.
- the filter coefficient of the filter changes, the output value output to the control target becomes discontinuous with respect to the continuous operation amount (input value).
- the filter coefficient includes a coefficient (a highly responsive coefficient) in which the output value from the filter changes suddenly or a coefficient (in which the output value changes slowly) in response to a change in the input value to the filter ( Low coefficient of response).
- the filter coefficient When the filter coefficient is a highly responsive coefficient, the control amount of the control target can be controlled to the target value in a short time, but the control tends to become unstable. On the other hand, if the filter coefficient is a coefficient with low responsiveness, the controlled variable cannot be controlled to the target value in a short time, but the control is stabilized.
- the first filter coefficient or the second filter coefficient is set as a coefficient that causes a sudden change in the output value from the filter
- the third filter coefficient is set as a change in the output value from the filter. It can be a coefficient that becomes gradual.
- a filter coefficient with a sudden change in the output value from the filter is directly changed to a filter coefficient with a sudden change in the output value, the output value sent to the controlled object becomes unstable, and the operation of the controlled object becomes unstable. May be.
- the filter coefficient is changed to a coefficient that makes the change in the output value from the filter moderate, the change in the output value sent to the controlled object will be moderate even if the manipulated variable input to the filter changes. The operation of the object is stabilized.
- the switching unit when the filter coefficient in the first filter is changed from the first filter coefficient to the second filter coefficient, the switching unit can switch from the first output value to the second output value. Thereby, the 2nd output value using the 3rd filter coefficient can be inputted into a controlled object. Thereafter, the switching unit can switch the second output value to the first output value again. Thereby, the 1st output value using the 2nd filter coefficient can be inputted into a controlled object.
- the switching unit changes the first filter coefficient to the second filter coefficient the third filter coefficient can be interposed therebetween. Therefore, the first output value using the first filter coefficient is sequentially switched to the first output value using the second filter coefficient via the second output value using the third filter coefficient.
- the third filter coefficient of the second filter can be interposed therebetween.
- the characteristics of the output value from the filter can be avoided from changing suddenly and suddenly, It can be changed in order of sudden-slow-sudden.
- movement of a control object is suppressed, and the operation
- the filter coefficient of the first filter is changed from the first filter coefficient to the second filter coefficient
- the filter coefficient is changed by temporarily switching the control target by the automatic control device by switching by the switching unit. be able to. Accordingly, the automatic control device can be continuously operated, and the filter coefficient can be switched in a short time.
- the first filter coefficient or the second filter coefficient may be input to the first filter, and the third filter coefficient may be input to the second filter.
- the time constant of the first output value of the first filter when the first filter coefficient or the second filter coefficient is input to the first filter is the time constant of the second filter when the third filter coefficient is input to the second filter. It may be larger than the time constant of the second output value.
- the filter coefficient input to the first filter is changed from the first filter coefficient to the second filter coefficient or from the second filter coefficient.
- the switching unit may switch to a state in which the second output value of the second filter is sent to the control target before switching the filter coefficient of the first filter.
- the switching unit may switch to a state in which the first output value of the first filter is sent to the control target after the filter coefficient input to the first filter is switched.
- the switching unit is configured to change the second output of the second filter based on a change in the first output value of the first filter observed while the second output value of the second filter is sent to the control target. You may determine the timing which switches from the state where an output value is sent to a controlled object to the state where the 1st output value of the 1st filter is sent to a controlled object.
- the controlled object may be a servo motor.
- the automatic control device 1 includes a control unit 10, a first filter 20, a second filter 30, a switching unit 40, and a detection unit 70.
- the automatic control device 1 is applied to a machine 60 that includes a servo motor 50.
- the control target of the automatic control device 1 is a servo motor 50.
- Examples of the machine 60 include a mounting machine that mounts electronic components on a substrate.
- the automatic control device 1 can control the operation of the machine 60 by controlling the operation of the servo motor 50.
- the control unit 10 of the automatic control device 1 is connected to the input unit 80.
- a target value 101 of a controlled variable to be controlled is input from the input unit 80 to the control unit 10.
- the target value 101 of the controlled variable to be controlled is, for example, a target rotation angle of the servo motor 50.
- the control unit 10 is connected to the detection unit 70.
- the current value 105 of the controlled variable to be controlled is input from the detection unit 70 to the control unit 10.
- the current value 105 of the controlled variable to be controlled is, for example, the rotation angle from the reference value of the servo motor 50 to the current time.
- the control unit 10 includes a proportional control unit P, an integral control unit I, and a differential control unit D, and performs known PID control.
- the proportional control unit P calculates a value proportional to the deviation between the target value 101 to be controlled and the current value 105.
- the integral control unit I calculates a value proportional to the integral of the deviation between the target value 101 to be controlled and the current value 105.
- the differential control unit D calculates a value proportional to the differential of the deviation between the target value 101 to be controlled and the current value 105.
- the control unit 10 calculates an operation amount 102 for operating the torque of the servo motor 50 by PID control.
- the control unit 10 calculates the manipulated variable 102 based on the target value 101 input from the input unit 80 and the current value 105 input from the detection unit 70.
- the operation amount 102 is a value for controlling the torque of the servo motor 50. The torque can be controlled by controlling the current value.
- the control unit 10 outputs the calculated operation amount 102.
- the operation amount 102 output from the control unit 10 is sent to the first filter 20 and the second filter 30.
- the first filter 20 is connected to the control unit 10 as shown in FIG.
- the operation amount 102 output from the control unit 10 is input to the first filter 20 as an input value.
- the first filter 20 filters the operation amount 102 input from the control unit 10 and outputs it as a first output value 103.
- the first filter 20 is a digital filter.
- the digital filter mathematically processes the time-varying input value, thereby removing unnecessary frequency components from the input value and smoothing the time variation of the input value.
- a digital filter for example, a low-pass filter, a high-pass filter, a band-pass filter, or the like is used.
- the low-pass filter attenuates and removes frequency components above a predetermined frequency.
- the high-pass filter attenuates and removes frequency components below a predetermined frequency.
- the bandpass filter attenuates and removes frequency components other than the predetermined frequency band.
- a low pass filter is used as the first filter 20.
- a digital filter having a model shown in FIG. 3 is used as the first filter 20.
- the first filter 20 of the present embodiment includes a plurality of delay units 201, a plurality of multipliers 202, and an adder 203.
- the delay unit 201 delays the input value and outputs it. That is, the delay unit 201 outputs an input value at a time one cycle before the input value at the current time.
- Multiplier 202 multiplies the input value by the filter coefficient and outputs the result.
- the adder 203 adds the input values from the multiple multipliers 202 and outputs the result.
- the input value in the digital filter is a value sampled at a predetermined time interval (period).
- Equation (1) The model of the digital filter shown in FIG. 3 can be expressed by Equation (1).
- Y (n) is an output value of the digital filter at a predetermined time (n).
- X (n), X (n-1), and X (n-2) are input values of the digital filter at predetermined times (n, n-1, and n-2), respectively.
- a 0 , a 1 , and a 2 are filter coefficients to be multiplied with the input value.
- the second filter 30 has the same configuration as the first filter 20. Therefore, detailed description of the second filter 30 is omitted. As shown in FIG. 1, the first filter 20 and the second filter 30 are arranged in parallel. The first filter 20 and the second filter 30 are connected to the control unit 10 and the switching unit 40, respectively. The first filter 20 filters the operation amount 102 input from the control unit 10 and outputs a first output value 103. The second filter 30 filters the operation amount 102 input from the control unit 10 and outputs a second output value 104. The first output value 103 output from the first filter 20 and the second output value 104 output from the second filter 30 are input to the switching unit 40.
- the filter coefficients (a 0 , a 1 , a 2 ) can be changed.
- the user can freely set the filter coefficients (a 0 , a 1 , a 2 ) multiplied by the input values in the multiplication unit 202.
- the filter coefficient in the digital filter By changing the filter coefficient in the digital filter, the output value output from the digital filter changes.
- the first filter coefficient (a 01 , a 11 , a 21 ), the second filter coefficient (a 02 , a 12 , a 22 ), and the third filter coefficient (a 03 , a 13 , a 23). ) Is used.
- the first filter coefficient and the second filter coefficient can be input to the first filter 20. Either the first filter coefficient or the second filter coefficient is selectively input to the first filter 20.
- the third filter coefficient can be input to the second filter 30.
- the time constant of the first output value 103 of the first filter 20 when the first filter coefficient or the second filter coefficient is input to the first filter 20 is the time constant when the third filter coefficient is input to the second filter 30.
- the time constant of the second output value 104 of the second filter 30 is larger.
- the frequency band of the first output value 103 of the first filter 20 when the first filter coefficient or the second filter coefficient is input to the first filter 20 is the same as that when the third filter coefficient is input to the second filter 30. It is higher than the frequency band of the second output value 104 of the second filter 30. That is, when the first filter coefficient or the second filter coefficient is used, the output value output from the digital filter changes rapidly. On the other hand, when the third filter coefficient is used, the output value output from the digital filter changes slowly.
- the servo motor 50 moves faster, and the control amount of the servo motor 50 approaches the target value 101 quickly.
- the third filter coefficient the movement of the servo motor 50 becomes slow, and the control amount of the servo motor 50 approaches the target value 101 slowly. Therefore, when the first filter coefficient or the second filter coefficient is used, the servo motor 50 responds faster to the target value 101 than when the third filter coefficient is used.
- the switching unit 40 is connected to the first filter 20 and the second filter 30, respectively.
- the first output value 103 output from the first filter 20 and the second output value 104 output from the second filter 30 pass through the switching unit 40.
- the switching unit 40 switches between the first output value 103 from the first filter 20 and the second output value 104 from the second filter 30.
- the switching unit 40 switches between the first output value 103 and the second output value 104, outputs one of the output values, and sends it to the servo motor 50.
- a switching circuit can be used as the switching unit 40.
- the switching unit 40 changes the filter coefficient input to the first filter 20 from the first filter coefficient to the second filter coefficient, or changes the filter coefficient from the second filter coefficient to the first filter coefficient. Switch the output value.
- the switching unit 40 is in a state where the first output value 103 of the first filter 20 is being sent to the servo motor 50 and before changing the filter coefficient of the first filter 20, the second output value 104 of the second filter 30. Is switched to a state in which is sent to the servo motor 50.
- the switching unit 40 changes the filter coefficient of the first filter 20 in a state where the second output value 104 of the second filter 30 is sent to the servo motor 50, and then the first output value of the first filter 20. The state is switched to a state in which 103 is sent to the servo motor 50.
- the switching unit 40 may be configured to be able to determine the switching timing based on the change in the output value. That is, the switching unit 40 is configured to be able to determine the switching timing based on the change in the first output value 103 of the first filter 20 and / or the change in the second output value 104 of the second filter 30. It may be.
- the switching unit 40 switches the output value based on the change in the first output value 103 of the first filter 20 observed when the second output value 104 of the second filter 30 is sent to the servo motor 50. Do.
- the switching unit 40 changes the first output value 103 of the first filter 20 from the state in which the second output value 104 of the second filter 30 is sent to the servomotor 50. Determines the timing for switching to the state where the servo motor 50 is sent to the servo motor 50.
- Servo motor 50 is connected to switching unit 40.
- the first output value 103 or the second output value 104 output from the switching unit 40 is input to the servo motor 50.
- the first output value 103 or the second output value 104 is a value for manipulating the torque of the servo motor 50.
- the servo motor 50 operates based on the first output value 103 or the second output value 104 that is input.
- the servo motor 50 operates so as to approach the target value 101.
- the servo motor 50 can rotate forward or reverse.
- the servo motor 50 is connected to a power source (not shown) and energizes the servo motor 50 from the power source. The power supply always supplies power to the servo motor 50.
- the detection unit 70 is connected to the servo motor 50 and the control unit 10.
- the detection unit 70 detects the current value 105 of the control amount of the servo motor 50. Specifically, the detection unit 70 detects the rotation angle of the servo motor 50. The rotation angle from the reference value to the present is detected.
- the detection value (current value 105 of the control amount of the servo motor 50) detected by the detection unit 70 is sent to the control unit 10.
- the current value 105 (detected value) is a value sampled at a predetermined cycle.
- the current value 105 (detected value) sent to the control unit 10 is input to the control unit 10.
- the detection unit 70 returns the current value 105 of the control amount of the servo motor 50 to the control unit 10 so that feedback control is performed.
- a known encoder can be used. The encoder is attached to the servo motor 50.
- the first filter coefficients (a 01 , a 11 , a 21 ) are input to the first filter 20.
- the third filter coefficients (a 03 , a 13 , a 23 ) are input to the second filter 30.
- the switching unit 40 is set to send the first output value 103 output from the first filter 20 to the servo motor 50 (see FIG. 4). That is, the switching unit 40 blocks the second output value 104 output from the second filter 30.
- the target rotation angle (target value 101) of the servo motor 50 is input from the input unit 80 to the control unit 10.
- the detection unit 70 detects the current rotation angle (current value 105) of the servo motor 50.
- the current value 105 detected by the detection unit 70 is input to the control unit 10.
- the control unit 10 calculates the operation amount 102 of the torque of the servo motor 50 by PID control.
- the operation amount 102 calculated by the control unit 10 is input to the first filter 20 and the second filter 30, respectively.
- the first filter 20 filters the input operation amount 102 and outputs it as a first output value 103.
- the first filter 20 filters the input operation amount 102 using the first filter coefficients (a 01 , a 11 , a 21 ).
- the second filter 30 filters the input operation amount 102 and outputs it as a second output value 104.
- the second filter 30 filters the input operation amount 102 using the third filter coefficients (a 03 , a 13 , a 23 ).
- the first output value 103 output from the first filter 20 and the second output value 104 output from the second filter 30 are input to the switching unit 40, respectively.
- the switching unit 40 sends the first output value 103 output from the first filter 20 to the servo motor 50.
- the switching unit 40 blocks the second output value 104 output from the second filter 30.
- the first output value 103 is input to the servo motor 50. Then, the servo motor 50 operates based on the first output value 103.
- the filter coefficient used for the digital filter may be changed depending on the situation.
- the frequency characteristics of the machine 60 change. Accordingly, unnecessary frequency components change accordingly, and the user may change the filter coefficient.
- the type of transport head provided with a suction nozzle that sucks and transports electronic components according to the type of the substrate and / or electronic components. May change automatically.
- the system of the machine 60 such as the coefficient of friction may change depending on the aging of the machine 60. In such a case, the weight characteristics of the machine 60 and the friction characteristics between parts of the machine 60 may change, and the frequency characteristics of the machine 60 may change. Therefore, the filter coefficient of the digital filter is changed accordingly.
- the user changes the filter coefficient used in the first filter 20 from the first filter coefficient (a 01 , a 11 , a 21 ) to the second filter coefficient (a 02 , a 12 , a 22 ). To do. Therefore, the second filter coefficients (a 02 , a 12 , a 22 ) are input to the first filter 20.
- the servo motor 50 May be unstable. More specifically, when the first filter coefficient or the second filter coefficient is used for the first filter 20, the first output value 103 having a large time constant is output from the first filter 20. That is, when the first filter coefficient or the second filter coefficient is used, the first output value 103 having a sharp change is output from the first filter 20 with respect to the change in the operation amount 102 input from the control unit 10. Is done.
- the filter coefficient in the first filter 20 changes from the first filter coefficient to the second filter coefficient
- the first output value 103 output from the first filter 20 is the first that is abruptly changed by the first filter coefficient.
- the output value 103 changes to the first output value 103 that is suddenly changed by the second filter coefficient.
- the operation of the servo motor 50 changes abruptly by changing from the first output value 103 having a large time constant due to the first filter coefficient to the first output value 103 having a large time constant due to the second filter coefficient. .
- the operation of the servo motor 50 for approaching the target value 101 changes rapidly, and the rotation of the servo motor 50 may become unstable.
- the first change is made in the switching unit 40.
- the first output value 103 of the filter 20 and the second output value 104 of the second filter 30 are switched (see FIG. 4).
- the switching unit 40 When the switching unit 40 is switched, the output value sent from the switching unit 40 to the servo motor 50 is switched from the first output value 103 of the first filter 20 to the second output value 104 of the second filter 30.
- the second output value 104 output from the second filter 30 is input to the servo motor 50.
- the third filter coefficients (a 03 , a 13 , a 23 ) are input to the second filter 30, and the second output value 104 output from the second filter 30 using the third filter coefficients is a time constant. Is small. In other words, the second output value 104 output from the second filter 30 using the third filter coefficient changes slowly with respect to the change in the operation amount 102 input from the control unit 10 to the second filter. Accordingly, when the first output value 103 of the first filter 20 is switched to the second output value 104 of the second filter 30 due to the switching in the switching unit 40, the first output value 103 having a sharp change due to the first filter coefficient The change due to the third filter coefficient changes to the second output value 104 that is gentle.
- the output value sent from the switching unit 40 to the servo motor 50 changes from the first output value 103 having a large time constant due to the first filter coefficient to the second output value 104 having a small time constant due to the third filter coefficient.
- the first output value 103 that changes or changes suddenly changes to the second output value 104 that changes gradually a sudden change in operation of the servo motor 50 is suppressed. Therefore, the rotation of the servo motor 50 is stabilized.
- the user switches the second output value 104 of the second filter 30 and the first output value 103 of the first filter 20 again in the switching unit 40. That is, as described above, the user switches the first output value 103 of the first filter 20 from the first output value 103 of the first filter 20 to the second output value 104 of the second filter 30 by the switching unit 40, and then sets the filter coefficient of the first filter 20 to the first value. After changing from the filter coefficient to the second filter coefficient, the switching unit 40 returns the second output value 104 of the second filter 30 to the first output value 103 of the first filter 20 again.
- the first output value 103 output from the first filter 20 varies greatly and becomes unstable. While the first output value 103 output from the first filter 20 varies greatly, the second output value 104 output from the second filter 30 is output to the servo motor 50. This suppresses the control of the servo motor 50 from becoming unstable.
- the first output value 103 output from the first filter 20 is stabilized over time. Therefore, after the change of the first output value 103 output from the first filter coefficient is stabilized, the switching by the switching unit 40 is performed. The output value is switched by the switching unit 40 while the servo motor 50 is always energized from a power source (not shown).
- the first output value 103 output from the first filter 20 is input to the servo motor 50 again by switching by the switching unit 40. Then, the servo motor 50 operates based on the first output value 103.
- the timing at which the switching unit 40 switches from the second output value 104 to the first output value 103 is the timing at which the first output value 103 from the first filter 20 is monitored and the first output value 103 is stabilized. Just do it. That is, the switching timing may be determined based on a change in the first output value 103 observed while the second output value 104 is being sent to the servomotor 50.
- the first output value 103 of the first filter 20 is sent to the servomotor 50 from the state where the second output value 104 of the second filter 30 is sent to the servomotor 50 at the timing when the change of the first output value 103 is stabilized. Switch to state. Whether or not the first output value 103 is stabilized can be determined based on the magnitude of the amplitude of the first output value 103.
- the first filter 20 Since the second filter coefficients (a 02 , a 12 , a 22 ) changed from the first filter coefficients as described above are input to the first filter 20, the first filter 20 The manipulated variable 102 is filtered using the filter coefficient.
- the first filter 20 filters the manipulated variable 102 input from the control unit 10 using the second filter coefficient and outputs it as a first output value 103.
- the first output value 103 output from the first filter 20 using the second filter coefficient is sent to the servo motor 50 by the switching unit 40.
- the output value sent from the switching unit 40 to the servo motor 50 changes from the second output value 104 having a small time constant due to the third filter coefficient to the first output value 103 having a large time constant due to the second filter coefficient.
- the change from the second output value 104 which changes slowly, to the first output value 103, which changes or changes suddenly, is suppressed. Therefore, the rotation of the servo motor 50 is stabilized.
- the automatic control device 1 includes the first filter 20 that filters the operation amount 102 of the servo motor 50 calculated by the control unit 10 and outputs the first output value 103.
- the second filter 30 is arranged in parallel with the first filter 20 and filters the operation amount 102 of the servo motor 50 calculated by the control unit 10 to output a second output value 104.
- the automatic control device 1 includes a switching unit 40 that switches between the first output value 103 of the first filter 20 and the second output value 104 of the second filter 30 and sends one of the output values to the control target.
- the first filter coefficient or the second filter coefficient can be input to the first filter 20.
- the third filter coefficient can be input to the second filter 30.
- the first output value 103 using the first filter coefficient or the first output value 103 using the second filter coefficient can be output from the first filter 20.
- the second output value 104 using the third filter coefficient can be output from the second filter 30.
- the switching unit 40 by switching the switching unit 40, the first output value 103 using the first filter coefficient, the second output value 104 using the third filter coefficient, and the first output value 103 using the second filter coefficient are changed. You can switch in order. Therefore, the first output value 103 having a rapid change due to the first filter coefficient is switched to the second output value 104 having a gentle change due to the third filter coefficient, and again the first output value having a sudden change due to the second filter coefficient. 103 can be switched.
- the third filter coefficient in the second filter 30 can be interposed between the two, and the change is slow.
- the second output value 104 can be interposed. That is, when the filter coefficient of the digital filter is switched, the characteristics of the output value of the digital filter can be prevented from changing in a sudden-steep order, and can be changed in a sudden-slow-steep order. . As a result, rapid fluctuations in the rotation of the servo motor 50 are suppressed, and the rotation of the servo motor 50 is stabilized. Therefore, the control by the automatic control device 1 is stabilized.
- the filter coefficient of the first filter 20 can be changed from the first filter coefficient to the second filter coefficient in a state where electric power is always supplied from the power source to the servo motor 50 (that is, in a controlled state).
- the filter coefficient of the first filter 20 can be changed without stopping the automatic control device 1 once, and the automatic control device 1 can be continuously operated. Therefore, the filter coefficient can be switched in a short time.
- the machine 60 to which the automatic control device 1 is applied is a mounting machine that mounts electronic components on a substrate
- the electronic components can be continuously transferred without stopping the machine 60 by the continuous operation of the automatic control device 1. Can be implemented.
- the model illustrated in FIG. 3 has been described as an example of the digital filter according to the first filter 20 or the second filter 30, but the model is not limited to this configuration.
- the number of delay units 201, multiplication units 202, and addition units 203 in the digital filter is not particularly limited.
- the servo motor 50 is used as a control target of the automatic control device 1, but the control target is not particularly limited.
- the control target can be changed as appropriate.
- the rotation angle of the servo motor 50 is used as the target value 101 input to the control unit 10, but the present invention is not limited to this configuration.
- the target value 101 may be, for example, the rotational speed or torque of the servo motor 50.
- the position of a member of the machine 60 including the servo motor 50 may be used as the target value 101.
- the position of the head that holds the electronic component to be mounted on the substrate may be set as the target value 101.
- a plurality of target values 101 may be combined.
- the rotation angle of the servo motor 50 is used as the current value 105 input to the control unit 10, but the present invention is not limited to this configuration.
- the current value 105 may be, for example, the rotational speed or torque of the servo motor 50.
- a position of a member of the machine 60 including the servo motor 50 may be used as the current value 105.
- the current value 105 may be the position of a head that holds an electronic component to be mounted on a substrate.
- a plurality of current values 105 may be combined.
- the configuration in which the servo motor 50 is operated by controlling the torque of the servo motor 50 has been described.
- the present invention is not limited to this configuration.
- the rotation angle or rotation speed of the servo motor 50 may be manipulated.
- the first filter 20 may include a plurality of filters having different purposes.
- the first filter 20 may include a vibration suppression filter, a torque filter, and a pre-filter.
- the damping filter, the torque filter, and the pre-filter have different purposes, and different frequency components are removed depending on the purpose.
- the damping filter removes unnecessary frequency components in order to suppress the vibration of the machine 60 to which the automatic control device 1 is applied.
- the torque filter removes unnecessary frequency components in order to stabilize the torque of the servo motor 50.
- the pre-filter removes unnecessary frequency components in order to stabilize the rotation of the servo motor 50.
- the second filter 30 is not limited to the above embodiment, similarly to the first filter 20.
- the filter coefficient of the first filter 20 is switched from the first filter coefficient to the second filter coefficient, but the present invention is not limited to this configuration. Even when the filter coefficient of the first filter 20 is switched from the second filter coefficient to the first filter coefficient, the operation of the servo motor 50 can be stabilized by performing the same switching as described above.
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Control Of Electric Motors In General (AREA)
- Feedback Control In General (AREA)
Abstract
Description
10;制御部
20;第1フィルタ
30;第2フィルタ
40;切替部
50;サーボモータ
60;機械
70;検出部
80;入力部
201;遅延部
202;乗算部
203;加算部
101;目標値
102;操作量
103;第1出力値
104;第2出力値
105;現在値
P;比例制御部
I;積分制御部
D;微分制御部
Claims (5)
- 制御対象を制御する自動制御装置であって、
前記制御対象の制御量の目標値と現在値の差に基づいて前記制御対象の操作量を演算する制御部と、
前記制御部により演算された操作量を所定のフィルタ係数を用いてフィルタリングして第1出力値を出力する第1フィルタと、
前記第1フィルタと並列に配置され、前記第1フィルタのフィルタ係数とは異なる所定のフィルタ係数を用いて前記制御部により演算された操作量をフィルタリングして第2出力値を出力する第2フィルタと、
前記第1フィルタの第1出力値と前記第2フィルタの第2出力値を切り替えていずれか一方の出力値を前記制御対象に送る切替部と、を備える自動制御装置。 - 前記第1フィルタには、第1フィルタ係数または第2フィルタ係数を入力可能であり、
前記第2フィルタには、第3フィルタ係数を入力可能であり、
第1フィルタ係数または第2フィルタ係数が前記第1フィルタに入力されたときの前記第1フィルタの第1出力値の時定数が、第3フィルタ係数が前記第2フィルタに入力されたときの前記第2フィルタの第2出力値の時定数よりも大きい、請求項1に記載の自動制御装置。 - 前記第1フィルタの第1出力値が前記制御対象に送られている状態で、前記第1フィルタに入力されるフィルタ係数を第1フィルタ係数から第2フィルタ係数、あるいは、第2フィルタ係数から第1フィルタ係数へと切替える場合に、前記切替部は、前記第1フィルタのフィルタ係数を切替える前に前記第2フィルタの第2出力値が前記制御対象に送られる状態に切替え、前記第1フィルタに入力されるフィルタ係数が切替えられた後に、前記第1フィルタの第1出力値が前記制御対象に送られる状態に切替える、請求項2に記載の自動制御装置。
- 前記切替部は、前記第2フィルタの第2出力値が前記制御対象に送られている間に観測される前記第1フィルタの第1出力値の変化に基づいて、前記第2フィルタの第2出力値が前記制御対象に送られる状態から前記第1フィルタの第1出力値が前記制御対象に送られる状態に切替えるタイミングを決定する、請求項3に記載の自動制御装置。
- 前記制御対象は、サーボモータである、請求項1から4のいずれか一項に記載の自動制御装置。
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US15/514,987 US10345787B2 (en) | 2014-09-29 | 2014-09-29 | Automatic control device |
JP2016551365A JP6393767B2 (ja) | 2014-09-29 | 2014-09-29 | 自動制御装置 |
CN201480082105.4A CN107077116B (zh) | 2014-09-29 | 2014-09-29 | 自动控制装置 |
EP14903489.4A EP3203332B1 (en) | 2014-09-29 | 2014-09-29 | Automatic control device |
PCT/JP2014/075948 WO2016051478A1 (ja) | 2014-09-29 | 2014-09-29 | 自動制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2014/075948 WO2016051478A1 (ja) | 2014-09-29 | 2014-09-29 | 自動制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2016051478A1 true WO2016051478A1 (ja) | 2016-04-07 |
Family
ID=55629577
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2014/075948 WO2016051478A1 (ja) | 2014-09-29 | 2014-09-29 | 自動制御装置 |
Country Status (5)
Country | Link |
---|---|
US (1) | US10345787B2 (ja) |
EP (1) | EP3203332B1 (ja) |
JP (1) | JP6393767B2 (ja) |
CN (1) | CN107077116B (ja) |
WO (1) | WO2016051478A1 (ja) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6602044B2 (ja) * | 2015-05-08 | 2019-11-06 | キヤノン株式会社 | 振動型駆動装置、制御装置及び医用システム |
JP6568148B2 (ja) * | 2017-06-06 | 2019-08-28 | ファナック株式会社 | サーボモータ制御装置 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH09330101A (ja) * | 1996-06-13 | 1997-12-22 | Kokusai Chodendo Sangyo Gijutsu Kenkyu Center | 制御装置及び方法 |
JPH11184527A (ja) * | 1997-12-24 | 1999-07-09 | Yaskawa Electric Corp | モータ駆動制御装置およびその制御方法 |
JP2010198517A (ja) * | 2009-02-27 | 2010-09-09 | Daihatsu Motor Co Ltd | 可変構造制御装置 |
Family Cites Families (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4609855A (en) * | 1984-11-09 | 1986-09-02 | Motorola, Inc. | Adaptive servomotor control |
EP0477412A1 (de) | 1990-09-27 | 1992-04-01 | Siemens Aktiengesellschaft | Verfahren zur Filterung digitaler Signale |
CN1112317A (zh) * | 1994-03-07 | 1995-11-22 | 王幼华 | 自适应噪声滤波器 |
JPH08172371A (ja) * | 1994-12-19 | 1996-07-02 | Toshiba Corp | Fm受信機 |
US5730861A (en) * | 1996-05-06 | 1998-03-24 | Sterghos; Peter M. | Swimming pool control system |
JP4422875B2 (ja) * | 2000-08-30 | 2010-02-24 | キヤノン株式会社 | モータ駆動装置 |
JP2004152119A (ja) * | 2002-10-31 | 2004-05-27 | Yaskawa Electric Corp | マシンコントローラのフィルタ |
US20070052556A1 (en) * | 2003-04-17 | 2007-03-08 | Koninklijke Philips Electronics N.V. Groenewoudseweg 1 | Adaptive filtering |
US7145300B2 (en) * | 2003-05-05 | 2006-12-05 | International Rectifier Corporation | Multi-axis AC servo control system and method |
JP2005266902A (ja) * | 2004-03-16 | 2005-09-29 | Yaskawa Electric Corp | 位置制御装置および方法 |
EP1779204B1 (en) | 2004-08-04 | 2011-05-18 | Fisher Controls International Llc | System and method for transfer of feedback control for a process control device |
JP4094045B2 (ja) * | 2004-09-08 | 2008-06-04 | 富士通株式会社 | Pll周波数シンセサイザ |
CN101040320B (zh) * | 2005-07-21 | 2011-01-05 | 松下电器产业株式会社 | 有源降噪装置 |
JP4174543B2 (ja) * | 2007-01-29 | 2008-11-05 | ファナック株式会社 | サーボモータの制御装置 |
CN101552640B (zh) * | 2008-04-01 | 2012-04-11 | 富士通株式会社 | 滤波器系数变更装置和方法 |
GB0821772D0 (en) * | 2008-11-28 | 2009-01-07 | Zarlink Semiconductor Inc | Soft reference switch for phase locked loop |
CN101615876B (zh) * | 2009-08-07 | 2011-07-27 | 北京和利时电机技术有限公司 | 一种隐极式永磁同步电机的调速控制系统和方法 |
CN101888355A (zh) * | 2010-04-22 | 2010-11-17 | 深圳市云海通讯股份有限公司 | 一种自适应滤波器及滤波方法 |
EP2418773A1 (en) * | 2010-07-28 | 2012-02-15 | Brandenburgische Technische Universität Cottbus | Glitch-free switchable FIR-filter |
JP6046182B2 (ja) * | 2015-02-27 | 2016-12-14 | ファナック株式会社 | 振動を抑制する機能を備えたモータ制御装置 |
-
2014
- 2014-09-29 US US15/514,987 patent/US10345787B2/en active Active
- 2014-09-29 EP EP14903489.4A patent/EP3203332B1/en active Active
- 2014-09-29 CN CN201480082105.4A patent/CN107077116B/zh active Active
- 2014-09-29 WO PCT/JP2014/075948 patent/WO2016051478A1/ja active Application Filing
- 2014-09-29 JP JP2016551365A patent/JP6393767B2/ja active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH09330101A (ja) * | 1996-06-13 | 1997-12-22 | Kokusai Chodendo Sangyo Gijutsu Kenkyu Center | 制御装置及び方法 |
JPH11184527A (ja) * | 1997-12-24 | 1999-07-09 | Yaskawa Electric Corp | モータ駆動制御装置およびその制御方法 |
JP2010198517A (ja) * | 2009-02-27 | 2010-09-09 | Daihatsu Motor Co Ltd | 可変構造制御装置 |
Non-Patent Citations (1)
Title |
---|
See also references of EP3203332A4 * |
Also Published As
Publication number | Publication date |
---|---|
JPWO2016051478A1 (ja) | 2017-07-13 |
US10345787B2 (en) | 2019-07-09 |
CN107077116A (zh) | 2017-08-18 |
EP3203332A4 (en) | 2017-11-01 |
CN107077116B (zh) | 2019-05-03 |
US20170212497A1 (en) | 2017-07-27 |
EP3203332B1 (en) | 2019-10-23 |
JP6393767B2 (ja) | 2018-09-19 |
EP3203332A1 (en) | 2017-08-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2007138758A1 (ja) | サーボ制御装置 | |
JP6192559B2 (ja) | クレーン装置 | |
WO2015004885A1 (ja) | 電動機の制御装置 | |
KR100723087B1 (ko) | 모터 제어 장치 | |
KR101562218B1 (ko) | 전동식 동력 조향장치의 제어장치 | |
JP2015151211A5 (ja) | ||
US8296011B2 (en) | Systems and methods involving quadrant dependent active damping | |
JP6393767B2 (ja) | 自動制御装置 | |
JP2010051104A (ja) | モータ制御装置 | |
TWI632768B (zh) | 馬達控制裝置 | |
WO2015152068A1 (ja) | 電動車両の駆動力制御装置 | |
WO2012067229A1 (ja) | 電動機の位置制御装置 | |
JP4507110B2 (ja) | ディジタルサーボ制御装置 | |
JP5127767B2 (ja) | 駆動制御装置 | |
JP2004252924A (ja) | アクチュエータの制御装置 | |
JP2008079477A5 (ja) | ||
JP2009070050A (ja) | 位置制御装置 | |
JP5256704B2 (ja) | 慣性モーメント推定装置 | |
JP2008079478A5 (ja) | ||
JP4151401B2 (ja) | サーボ制御装置 | |
JP5278333B2 (ja) | モータ制御装置 | |
JP2006187191A (ja) | モータ制御装置 | |
JP5805016B2 (ja) | モータ制御装置 | |
JP2002044976A (ja) | 電動機速度制御装置 | |
JP2005115586A (ja) | フィードバック制御装置およびその振動抑制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 14903489 Country of ref document: EP Kind code of ref document: A1 |
|
ENP | Entry into the national phase |
Ref document number: 2016551365 Country of ref document: JP Kind code of ref document: A |
|
REEP | Request for entry into the european phase |
Ref document number: 2014903489 Country of ref document: EP |
|
WWE | Wipo information: entry into national phase |
Ref document number: 15514987 Country of ref document: US Ref document number: 2014903489 Country of ref document: EP |
|
NENP | Non-entry into the national phase |
Ref country code: DE |