Motor control device and motor control method

Abstract

To provide a motor control device and a motor control method capable of realizing both a reduction in speed fluctuation rate at constant speed and an early stop.SOLUTION: A control device 10 for a linear motor 1 in which disturbance correction is performed includes a disturbance control system 60 that reduces the speed fluctuation rate when the linear motor 1 is at a constant speed, and an FF compensator 40 that shortens a settling time when the linear motor 1 stops.SELECTED DRAWING: Figure 3

Description

[Technical Field]

[0001] The present invention relates to a motor control device and a motor control method. [Background technology]

[0002] A motor has a stator and a mover, and is configured to move the mover relative to the stator by magnetically generating a thrust between the stator and the mover. A typical example of a motor is a linear motor, which has a mover in which multiple permanent magnets are arranged so that their magnetism alternates, and a stator in which a coil is wound around each of multiple magnetic pole teeth, and is configured to be spaced apart by a predetermined distance, and which generates a thrust by the attraction / repulsion force between the permanent magnets and the stator coils when an AC current is passed through the stator coils, thereby linearly moving the mover relative to the stator.

[0003] For example, Patent Document 1 discloses that a PID servo algorithm unit feedback controls a linear motor using a speed and position signal detected by a stage position detection device. [Prior art documents] [Patent documents]

[0004] [Patent Document 1] Japanese Patent Application Laid-Open No. 2000-167717 Summary of the Invention [Problem to be solved by the invention]

[0005] Many of the positioning stages used in semiconductor transport devices use linear motors. These stages are broadly divided into stepper types, in which exposure and other processes are performed while the stage is stationary, and scanner types, in which processing is performed while the stage moves at a constant speed. To improve processing accuracy, stepper types require the ability to stop quickly in response to commands, i.e., high responsiveness, while scanner types require reduced speed fluctuations while moving at a constant speed.

[0006] In order to satisfy these requirements, a stage that uses feedback control, such as that described in Patent Document 1, needs to have either increased stage rigidity or additional equipment for early stage stopping. However, in either case, expensive materials are used, which increases the manufacturing cost of the stage.

[0007] The present invention has been made in view of the above circumstances, and has as its object to provide a motor control device and a motor control method that can reduce the speed fluctuation rate during constant speed operation and achieve early stopping at low cost. [Means for solving the problem]

[0008] The motor control device according to the present invention is a motor control device that performs disturbance correction and includes a first control system for reducing the speed fluctuation rate when the motor is at a constant speed, and a second control system for shortening the settling time when the motor stops.

[0009] In the present invention, the first control system reduces the speed fluctuation rate when the motor is moving at a constant speed, and the second control system shortens the settling time when the motor is stopped, so that it is possible to achieve both a reduction in the speed fluctuation rate when the motor is moving at a constant speed and early stopping.

[0010] In the motor control device according to the present invention, the second control system performs feedforward control of the motor using the disturbance-corrected input value input to the motor.

[0011] In the present invention, the second control system performs the feedforward control using the disturbance-corrected input value input to the motor, and since the input value that has already been disturbance-corrected is used for the feedforward control, the disturbance suppression effect of the motor can be improved.

[0012] The motor control device according to the present invention includes a storage unit that stores in advance the actual measured values ​​of the input values, and the second control system performs the feedforward control using the actual measured values ​​of the input values.

[0013] In the present invention, the second control system performs the feedforward control using an actual measurement of the disturbance-corrected input value input to the motor, and therefore, the input value that has already been subjected to disturbance correction is used for the feedforward control, thereby improving the effect of suppressing disturbances in the motor.

[0014] In the motor control device of the present invention, the first control system includes a nonlinear compensator that determines a first disturbance estimate value used to suppress periodic disturbances, and a disturbance observer that determines a second disturbance estimate value used to suppress non-periodic disturbances.

[0015] In the present invention, the first control system performs disturbance control to suppress periodic disturbances using a first disturbance estimate determined by the nonlinear compensator, and to suppress non-periodic disturbances using a second disturbance estimate determined by the disturbance observer, thereby significantly suppressing disturbances that occur when the motor is at a constant speed, and reducing the speed fluctuation rate.

[0016] A motor control device according to the present invention comprises a controller that performs feedback control of the motor based on the difference between the position of an object driven by the motor and a position command value for the motor, a first subtractor that calculates the difference between the output value of the controller and the second disturbance estimated value, and a second subtractor that calculates the difference between the first disturbance estimated value and the sum of the output value of the first subtractor and the output value of the second control system, and outputs the difference to the motor.

[0017] In the present invention, the feedforward control by the second control system is added to the result of the feedback control by the controller, and thereafter the disturbance control by the first control system is performed, thereby reducing the speed fluctuation rate when the motor is moving at a constant speed and enabling the motor to be stopped quickly.

[0018] A motor control method according to the present invention is a motor control method for controlling a motor by performing disturbance correction, which performs a first control to reduce the speed fluctuation rate when the motor is moving at a constant speed, and a second control to shorten the settling time when the motor is stopped.

[0019] In the present invention, the first control reduces the speed fluctuation rate when the motor is moving at a constant speed, and the second control shortens the settling time when the motor is stopped, so that it is possible to achieve both a reduction in the speed fluctuation rate when the motor is moving at a constant speed and early stopping.

[0020] In the motor control method according to the present invention, the second control performs feedforward control of the motor using the disturbance-corrected input value input to the motor.

[0021] In the present invention, in the second control, the feedforward control is performed using the disturbance-corrected input value input to the motor, and since the input value that has already been disturbance-corrected is used for the feedforward control, the disturbance suppression effect of the motor can be improved.

[0022] In the motor control method according to the present invention, an actual measurement value of the input value is stored in advance, and the second control performs the feedforward control using the actual measurement value of the input value.

[0023] In the present invention, the feedforward control is performed using the actual measurement value of the disturbance-corrected input value input to the motor in the second control, and therefore, the input value that has already been subjected to disturbance correction is used for the feedforward control, thereby improving the effect of suppressing disturbances in the motor.

[0024] In the motor control method according to the present invention, the first control determines a first disturbance estimated value used to suppress a periodic disturbance, and determines a second disturbance estimated value used to suppress a non-periodic disturbance.

[0025] In the present invention, the first control system performs disturbance control by determining the first disturbance estimated value to suppress periodic disturbances and determining the second disturbance estimated value to suppress non-periodic disturbances, thereby significantly suppressing disturbances that occur when the motor is at a constant speed, and reducing the speed fluctuation rate.

[0026] A motor control method according to the present invention performs feedback control of the motor based on the difference between a position of an object driven by the motor and a position command value for the motor, calculates the difference between a value obtained by the feedback control and the second disturbance estimated value, calculates the difference between the first disturbance estimated value and the sum of the calculated difference and the value obtained by the feedforward control, and outputs the difference to the motor.

[0027] In the present invention, the feedforward control is added to the result of the feedback control, and then the disturbance control is performed, thereby reducing the speed fluctuation rate when the motor is running at a constant speed and enabling the motor to be stopped quickly. [Effects of the Invention]

[0028] According to the present invention, it is possible to reduce the speed fluctuation rate during constant speed operation and achieve early stopping at low cost. [Brief explanation of the drawings]

[0029] [Figure 1] FIG. 2 is a perspective view showing the configuration of a linear motor. [Figure 2] FIG. 2 is a side view showing the configuration of a linear motor. [Figure 3] FIG. 2 is a block diagram showing the configuration of an embodiment of a control device according to the present embodiment. [Figure 4] FIG. 4 is an illustrative diagram showing an example of a current command input to a linear motor. [Figure 5] FIG. 4 is an illustrative diagram showing an example of a feedforward value used in feedforward control. [Figure 6] FIG. 2 is a block diagram showing the internal configuration of a disturbance control system of the control device. [Figure 7] 4 shows operational waveforms when disturbance observer control is performed by the control device according to the present invention. [Figure 8] 6 shows operational waveforms when feedforward control is performed using the feedforward values ​​shown in FIG. 5. DETAILED DESCRIPTION OF THE INVENTION

[0030] DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS The present invention will be described in detail with reference to the drawings showing embodiments thereof. In the following, a case will be described in which the present invention is applied to a positioning stage that employs a linear motor as an example of a motor.

[0031] 1 and 2 are a perspective view and a side view showing the configuration of a linear motor 1. The linear motor 1 has a mover 2 and a stator 3 that face each other with a predetermined distance between them.

[0032] The mover 2 is configured by supporting and fixing, at equal intervals, for example, 14 rectangular permanent magnets 21 to a thin plate-like back yoke 22 and arranging them side by side in the direction of movement (left and right direction in FIG. 2). Each permanent magnet 21 is magnetized in the thickness direction (up and down direction in FIG. 2), and the magnetization directions of adjacent permanent magnets 21, 21 are opposite to each other. In other words, permanent magnets 21 magnetized in the direction from the mover 2 side toward the stator 3 side (top to bottom direction in FIG. 2) and permanent magnets 21 magnetized in the direction from the stator 3 side toward the mover 2 side (bottom to top direction in FIG. 2) are arranged alternately.

[0033] Meanwhile, the stator 3 is configured by integrally providing, for example, 30 rectangular magnetic pole teeth 32 at equal intervals in the moving direction on a thin plate-like core 31, and by winding a coil 33 around each magnetic pole tooth 32. U, V, and W in Fig. 2 respectively represent the U-phase, V-phase, and W-phase of a three-phase AC power supply, and three pairs of forward and reverse two-slot are formed as one set to perform three-phase parallel current conduction. The linear motor 1 has a basic unit of a seven-pole, six-slot configuration having seven permanent magnets 21, six magnetic pole teeth 32, and coils 33.

[0034] When a three-phase alternating current is passed through the coil 33 of the stator 3 to generate a magnetic field in the magnetic pole teeth 32, the permanent magnets 21 of the mover 2 are sequentially magnetically attracted and repelled by this magnetic field, generating a thrust in the mover 2, causing the mover 2 to move linearly relative to the stator 3.

[0035] A method and apparatus for reducing the influence of disturbances that inevitably occur in the linear motor 1 having such a configuration will be described in detail below.

[0036] In the present invention, a control is performed in which nonlinear compensation control for suppressing periodic disturbances, disturbance observer control for suppressing other non-periodic disturbances, and feedforward control for shortening settling time are added to basic control (feedback control). The nonlinear compensation control suppresses periodic disturbances, mainly cogging, in the constant speed range. The disturbance observer control uses a steady Kalman filter to suppress disturbances that cannot be fully suppressed by the nonlinear compensation control in the constant speed range. Hereinafter, the nonlinear compensation control and disturbance observer control will be collectively referred to as disturbance control.

[0037] Taking the linear motor 1 as an example, disturbances include the effect of tension on the current-carrying cable (a phenomenon in which tension causes a difference in thrust between the forward and backward directions of the linear motor 1), friction, and vibration of the base that holds the linear motor 1. In the present invention, the effect of such disturbances on the linear motor 1 is suppressed by feedforward control and disturbance control.

[0038] 3 is a block diagram showing the configuration of an embodiment of a control device 10 according to this embodiment. The control device 10 is attached to a stage 11 (object) and controls a linear motor 1 that drives the stage 11 as appropriate.

[0039] The control device 10 includes a position command unit 80, a control controller 50 (controller), an FF corrector (feedforward corrector) 40 (second control system), a storage unit 41, a nonlinear compensator 51, a disturbance observer 61, a differentiator 62, a third subtractor 81, a first subtractor 71, and a second subtractor 72. The nonlinear compensator 51, the disturbance observer 61, and the differentiator 62 configure a disturbance control system 60.

[0040] The input terminal of the linear motor 1 to be controlled is connected to the output terminal of the second subtractor 72. The output terminal of the linear motor 1 is connected to the input terminal of the nonlinear compensator 51, the input terminal of the differentiator 62, and the subtraction input terminal of the third subtractor 81. The output terminal of the nonlinear compensator 51 is connected to the subtraction input terminal of the second subtractor 72, one of the addition input terminals of the second subtractor 72 is connected to the output terminal of the FF corrector 40, and the other addition input terminal of the second subtractor 72 is connected to the output terminal of the first subtractor 71. The output terminal of the differentiator 62 is connected to the input terminal of the disturbance observer 61, and the output terminal of the disturbance observer 61 is connected to the subtraction input terminal of the first subtractor 71. The addition input terminal of the first subtractor 71 is connected to the output terminal of the control controller 50. The input terminal of the control controller 50 is connected to the output terminal of the third subtractor 81. The addition input terminal of the third subtractor 81 and the input terminal of the FF corrector 40 are connected to the output terminal of the position command unit 80. The FF corrector 40 is connected to a storage unit 41.

[0041] An input command u1 (position command value) is input to an addition input terminal of the third subtractor 81 from the position command unit 80, a current command u3 is input to an addition input terminal of the first subtractor 71 from the control controller 50, and a second disturbance estimated value ^d (an estimated value of a non-periodic disturbance) is input to a subtraction input terminal of the first subtractor 71 from the disturbance observer 61. A current command u2 is input to one addition input terminal of the second subtractor 72 from the FF corrector 40, a current command u4 is input to the other addition input terminal of the second subtractor 72 from the first subtractor 71, and a first disturbance estimated value ^i (an estimated value of a periodic disturbance) is input to a subtraction input terminal of the second subtractor 72 from the nonlinear compensator 51. The symbol "^" represents an estimated value.

[0042] A current command u (input value) is input to the linear motor 1. The current command u is a current command output from the second subtractor 72 to the linear motor 1 side, and is a current value input to, for example, a driver or a servo amplifier (not shown), and output to the linear motor 1 from the driver or servo amplifier.

[0043] Fig. 4 is an illustrative diagram showing an example of a current command u input to the linear motor 1. In Fig. 4, the command speed is a speed corresponding to the input command u1. As can be seen from Fig. 4, the current command u changes over time and in accordance with the speed.

[0044] In addition, the position of the stage 11 is detected by a position detection unit (not shown) provided on the stage 11, and position information x representing the position of the stage 11 is output to the subtraction input terminal of the third subtractor 81, the differentiator 62, the nonlinear compensator 51, and to the outside.

[0045] The position command unit 80 outputs an input command u1 to the linear motor 1 side in accordance with a predetermined program in order to control the position of the stage 11. The input command u1 is input to the FF corrector 40, and is also input to the controller 50 via a third subtractor 81.

[0046] The controller 50 performs feedback control on the input command u1. That is, the third subtractor 81 calculates the difference between the input command u1 input to the addition input terminal and the position information x input to the subtraction input terminal, and a difference signal representing this difference is input to the control controller 50. The control controller 50 applies proportional (P), integral (I), and differential (D) processing to this difference so as to match the input command u1 with the position information x, calculates a current command u3, and outputs it to the first subtractor 71.

[0047] Furthermore, the FF corrector 40 performs feedforward control on the input command u1 when the linear motor 1 stops, as will be explained in detail below. The FF corrector 40 is connected to a storage unit 41. A plurality of patterns of feedforward values ​​are stored in the storage unit 41. That is, the storage unit 41 stores a lookup table in which a feedforward value is associated with each input command u1. The feedforward value stored in the memory unit 41 is the actually measured current command u, which is the current command u for the time range (hereinafter referred to as the settling interval) related to the settling time when the linear motor 1 stops (see the dashed ellipse in Figure 4).

[0048] Here, the settling time is the time required for the response to settle within a predetermined range of the target value after the command speed becomes 0 when the response is oscillatory, and in this embodiment, for example, it is the time required for the linear motor 1 (stage 11) to settle within ±150 nm after the command speed becomes 0. Also, the settling interval is a time range in time series that includes the settling time and further includes predetermined times immediately before and after the settling time.

[0049] In the present invention, the stage 11 is operated in advance, and the current command u input to the linear motor 1 at this time, with the disturbance suppressed, is measured, and of the measured current commands u, the current command u corresponding to the settling interval is stored in the memory unit 41 as a feedforward value.

[0050] That is, such a feedforward value is a current command in a state where feedback control by the control controller 50 and disturbance control by the disturbance control system 60 have been performed, and is a corrected current command in a state where correction for the disturbance has already been performed and the disturbance has been suppressed.

[0051] FIG. 5 is an illustrative diagram showing an example of a feedforward value used in feedforward control. In FIG. 5, the command speed is the speed corresponding to the input command u1. The feedforward value is zero before the command speed becomes zero, but indicates a predetermined value after the command speed becomes zero. As can be seen from FIGS. 4 and 5, the feedforward value is approximately the same as the current command u corresponding to the settling interval.

[0052] The FF corrector 40 performs feedforward control when the linear motor 1 stops, using the feedforward value stored in the storage unit 41. That is, when an input command u1 corresponding to stopping the linear motor 1 is input, the FF corrector 40 obtains the feedforward value from the storage unit 41 and performs feedforward control. For example, the FF corrector 40 does not perform feedforward control before the command speed becomes zero, or performs feedforward control using zero as the feedforward value, and when the command speed becomes zero, that is, just before the linear motor 1 stops, performs feedforward control using the feedforward value shown in Figure 5. In detail, the FF corrector 40 performs a predetermined processing on the input command u1 from the position command unit 80, appropriately selects one of the feedforward values ​​stored in the memory unit 41 in accordance with the input command u1, multiplies it by the input command u1, and outputs the current command u2 to the second subtractor 72.

[0053] In this way, the FF compensator 40 uses the corrected current command u, which has already undergone disturbance compensation, as a feedforward value for feedforward control, thereby effectively suppressing disturbances. This removes disturbances related to stopping the linear motor 1, shortening the settling time of the linear motor 1, i.e., allowing the linear motor 1 to stop quickly.

[0054] The disturbance control system 60 performs disturbance control against disturbances in order to reduce the speed fluctuation rate when the linear motor 1 is moving at a constant speed. The disturbance control system 60 has a nonlinear compensator 51 that determines a first disturbance estimate value ^i used to suppress periodic disturbances among the disturbances that occur when the linear motor 1 is moving at a constant speed, and a disturbance observer 61 that determines a second disturbance estimate value ^d used to suppress non-periodic disturbances other than periodic disturbances. In other words, the disturbance control includes nonlinear compensation control that suppresses periodic disturbances, in which the first disturbance estimate value ^i determined by the nonlinear compensator 51 is used, and disturbance observer control that suppresses non-periodic disturbances, in which the second disturbance estimate value ^d determined by the disturbance observer 61 is used.

[0055] Fig. 6 is a block diagram showing the internal configuration of the disturbance control system 60 of the control device 10. In Fig. 6, the same parts as in Fig. 3 are assigned the same numbers and symbols. As described above, the nonlinear compensator 51 determines and outputs the first disturbance estimated value ^i based on the position information x from the stage 11, and the disturbance observer 61 determines and outputs the second disturbance estimated value ^d based on the position information x from the stage 11.

[0056] The disturbance observer 61 has a stationary Kalman filter 100. The stationary Kalman filter 100 is a type of infinite impulse response filter used to estimate or control the state of a dynamic system using actual measurements containing errors. The stationary Kalman filter 100 is widely used to estimate quantities that change over time (for example, the position and velocity of an object) from actual measurements containing discrete errors.

[0057] The disturbance observer 61 has a first parameter section 86, a second parameter section 87, a third parameter section 88, a fourth parameter section 89, a fifth parameter section 90, a first adder 91, a second adder 92, a subtractor 93, a first integrator 94, and a second integrator 95. Among these components, the first parameter section 86, the second parameter section 87, the third parameter section 88, the fourth parameter section 89, the first adder 91, the second adder 92, the subtractor 93, and the first integrator 94 configure a steady-state Kalman filter 100.

[0058] The input terminal of the second parameter unit 87 is connected to the output terminal of the controller 50, and the output terminal of the second parameter unit 87 is connected to one of the addition input terminals of the first adder 91. The output terminal of the first adder 91 is connected to the input terminal of the first integrator 94, and the output terminal of the first integrator 94 is connected to the input terminal of the first parameter unit 86 and the input terminal of the third parameter unit 88. The output terminal of the third parameter unit 88 is connected to the subtraction input terminal of the subtractor 93. The addition input terminal of the subtractor 93 is connected to the output terminal of the differentiator 62. The output terminal of the subtractor 93 is connected to the input terminal of the fourth parameter unit 89 and the input terminal of the fifth parameter unit 90. The output terminal of the first parameter unit 86 is connected to one of the addition input terminals of the second adder 92, and the output terminal of the fourth parameter unit 89 is connected to the other addition input terminal of the second adder 92. The output terminal of the second adder 92 is connected to the other addition input terminal of the first adder 91. The output terminal of the fifth parameter unit 90 is connected to the input terminal of the second integrator 95 , and the output terminal of the second integrator 95 is connected to the subtraction input terminal of the first subtractor 71 .

[0059] A first parameter section 86, a second parameter section 87, and a third parameter section 88 store state variable parameters A, B, and C of the model (input: current, output: speed), respectively. These parameters A, B, and C are derived according to a MATLAB (registered trademark) program.

[0060] The fourth parameter section 89 calculates the state estimation parameters L of the model. x The fifth parameter section 90 stores the disturbance estimation parameter L of the linear motor 1. d Parameter L x is the model gain, which determines the sensitivity to errors that occur between the waveform of the compared model and the waveform of the actual device. If you want to correct even small errors, you need to set this parameter L x Also, set the parameter L d Also, parameter L x Similarly, it is a model gain for specifying the sensitivity in correction.

[0061] In actual implementation, it is preferable to use discretized values ​​for each of these parameters.

[0062] An estimated value of the velocity waveform (a velocity waveform when there is no influence of disturbance) when a current command u3 is input from the controller 50 to the model is calculated. This calculated velocity waveform of the model is compared with the actual velocity waveform of the linear motor 1 obtained by differentiating the position information x by the differentiator 62, and the difference is calculated by the subtractor 93. In this way, the estimated value from the model is used to estimate the movement of the dynamic system (the object to be controlled), and the parameter L x Since a fixed value is used as the model gain, it takes the form of a stationary Kalman filter.

[0063] The difference (error) obtained by the subtractor 93 is used to determine a second disturbance estimate ^d, which is an estimate of the non-periodic disturbance, and the determined second disturbance estimate ^d is subtracted from the current command u3 by the first subtractor 71, thereby reducing the non-periodic disturbance. In this way, of the disturbances that occur when the linear motor 1 is moving at a constant speed, the non-periodic disturbance is suppressed (disturbance observer control).

[0064] The first subtractor 71 obtains the difference between the current command u3 input to the addition input terminal and the second disturbance estimated value ^d input to the subtraction input terminal, and outputs the current command u4 to the second subtractor 72.

[0065] The nonlinear compensator 51 compensates for periodic disturbances, such as cogging, that occur when the linear motor 1 is moving at a constant speed. The nonlinear compensator 51 applies inverse compensation to the state of the periodic disturbance based on the position information x, and outputs a first disturbance estimate ^i, which is an estimate of the disturbance compensation, to the second subtractor 72. This first disturbance estimate ^i is derived from a model of the disturbance element. The second subtractor 72 subtracts the first disturbance estimate ^i input to its subtraction input terminal from the sum of the current command u2 input to one of its addition input terminals and the current command u4 input to its other addition input terminal, thereby reducing the periodic disturbance. In this way, the periodic disturbance that occurs when the linear motor 1 is moving at a constant speed is suppressed (nonlinear compensation control).

[0066] In this way, in the present invention, with respect to disturbances when the linear motor 1 is moving at a constant speed, inverse compensation control of periodic disturbances is performed using the first disturbance estimate value ^i determined by the nonlinear compensator 51, and non-periodic disturbances are suppressed using the second disturbance estimate value ^d determined by the disturbance observer 61. In other words, the influence of periodic disturbances is roughly removed using the nonlinear compensator 51, and the influence caused by non-periodic disturbances is reduced using the disturbance observer 61.

[0067] The second subtractor 72 has one addition input terminal that receives the feedforward controlled current command u2, the other addition input terminal that receives the current command u4 obtained by subtracting the second disturbance estimated value ^d from the feedback controlled current command u3, and a subtraction input terminal that receives the first disturbance estimated value ^i from the nonlinear compensator 51. The second subtractor 72 finds the difference between the sum of the current command u2 and the current command u4 and the first disturbance estimated value ^i, and outputs the current command u to the linear motor 1.

[0068] As described above, the control device 10 according to the present invention combines feedback control by the controller 50, feedforward control by the FF corrector 40, and disturbance control by the disturbance control system 60 (nonlinear compensation control and disturbance observer control).

[0069] That is, when the linear motor 1 is moving at a constant speed, disturbance control is performed to suppress periodic disturbances and non-periodic disturbances, and when the linear motor 1 stops, feedforward control is performed in addition to the disturbance control. By using a combination of controls in this way, the control device 10 according to the present invention can reduce the speed fluctuation rate when the linear motor 1 is moving at a constant speed and stop the linear motor 1 early at low cost.

[0070] Next, the results when the control according to the present invention is carried out will be described. Fig. 7 shows operational waveforms when disturbance observer control is performed by the control device 10 according to the present invention. In Fig. 7, "A-1", "A-2", and "A-3" show the case where only feedback control by the control controller 50 is performed (Comparative Example 1), and "B-1", "B-2", and "B-3" show the case where feedback control by the control controller 50 and disturbance control by the disturbance control system 60 are performed (Example of the present invention).

[0071] Also, "A-1" and "B-1" show the overall operating waveform of the speed from the start to the stop of the linear motor 1 (stage 11), with the horizontal axis representing time [sec] and the vertical axis representing speed [mm / s]. Also, the dashed line represents the command speed, and the solid line represents the actual speed. Furthermore, "A-2" and "B-2" indicate the speed fluctuation rate (%) in the section of the overall operating waveform where the linear motor 1 is moving at a constant speed and is a "+" value, and "A-3" and "B-3" indicate the speed fluctuation rate (%) in the section where the linear motor 1 is moving at a constant speed and is a "-" value. In "A-2", "A-3", "B-2", and "B-3", the horizontal axis represents time [sec], the left vertical axis represents speed [mm / s], and the right vertical axis represents speed fluctuation rate (%). Also, the dashed line indicates the command speed, and the solid line represents the speed fluctuation rate (%).

[0072] Comparing the present invention example with comparative example 1, the effects of periodic and non-periodic disturbances are reduced in the present invention example, and the speed fluctuation rate (%) when the linear motor 1 is moving at a constant speed is significantly reduced from 1.0% in comparative example 1 to 0.1%.

[0073] Fig. 8 shows operational waveforms when feedforward control is performed using the feedforward values ​​shown in Fig. 5. In Fig. 8, "A-1" and "A-2" show the case where only disturbance control by the disturbance control system 60 is performed (Comparative Example 2), and "B-1" and "B-2" show the case where both disturbance control by the disturbance control system 60 and feedforward control by the FF corrector 40 are performed (Example of the present invention).

[0074] Furthermore, "A-1" and "B-1" show the overall operating waveform of the speed from the start of operation to the stop of the linear motor 1 (stage 11), with the horizontal axis representing time [sec], the left vertical axis representing speed [mm / s], and the right vertical axis representing position deviation [μm]. Furthermore, "A-2" and "B-2" show enlarged views of the settling section of the overall operating waveform, with the horizontal axis representing time [sec], the left vertical axis representing speed [mm / s], and the right vertical axis representing position deviation [μm]. Here, the position deviation indicates the deviation from the target stop position.

[0075] Comparing the present invention example with the comparative example 2, as shown in FIG. 8, in the present invention example, the settling time is significantly reduced from 230 msec in the comparative example 2 to 140 msec by feedforward control.

[0076] The disclosed embodiments should be considered in all respects as illustrative and not restrictive. The scope of the present invention is defined by the claims, not by the above description, and is intended to include all modifications within the meaning and scope of the claims. [Explanation of symbols]

[0077] 1. Linear motor 10 Control device 11 Stage (Object) 40 FF corrector (second control system) 41 Storage section 50 Controller (controller) 51 Nonlinear Compensator 60 Disturbance control system (first control system) 61 Disturbance Observer 71 First subtractor 72 Second subtractor 100 Stationary Kalman Filter u Current command (input value)

Claims

1. In a motor control device that performs disturbance correction, a first control system for reducing a speed fluctuation rate when the motor is moving at a constant speed; a second control system for shortening a settling time when the motor is stopped; The second control system is a motor control device that performs feedforward control of the motor using the disturbance-corrected input value input to the motor.

2. a storage unit that stores in advance the actual measured values ​​of the input values, The motor control device according to claim 1 , wherein the second control system performs the feedforward control using an actual measurement value of the input value.

3. The first control system a nonlinear compensator that determines a first disturbance estimate used to suppress the periodic disturbance; 3. The motor control device according to claim 1, further comprising a disturbance observer that determines a second disturbance estimate used to suppress a non-periodic disturbance.

4. a controller that performs feedback control of the motor based on a difference between a position of an object driven by the motor and a position command value for the motor; a first subtractor that calculates a difference between the output value of the controller and the second disturbance estimate value; a second subtractor that calculates a difference between an added value of an output value of the first subtractor and an output value of the second control system and the first disturbance estimated value, 4. The motor control device according to claim 3, wherein the second subtractor outputs the difference to the motor.

5. A motor control method for controlling a motor by performing disturbance correction, comprising: performing a first control for reducing a speed fluctuation rate when the motor is rotating at a constant speed; performing a second control for shortening a settling time when the motor is stopped; In the second control, a feedforward control of the motor is performed using the disturbance-corrected input value input to the motor.

6. The actual measured values ​​of the input values ​​are stored in advance; The motor control method according to claim 5 , wherein the second control performs the feedforward control using an actual measurement value of the input value.

7. The first control is determining a first disturbance estimate used for suppressing the periodic disturbance; 7. The motor control method according to claim 5, further comprising determining a second disturbance estimate value used for suppressing non-periodic disturbances.

8. feedback control of the motor based on a difference between a position of an object driven by the motor and a position command value for the motor; determining a difference between the value obtained by the feedback control and the second disturbance estimated value; calculating a difference between the sum of the calculated difference and the value obtained by the feedforward control and the first disturbance estimated value; The motor control method according to claim 7, wherein the difference is output to the motor.

Images