A method for damping vibrations in a stepper motor with micro-stepping control which comprises the steps of identifying the force amplitudes and phase shifts of multiple harmonic detent torques of the stepper motor, such as the first, second and fourth harmonic detent torques, and tuning the stepper motor with different current commands until minimum friction and resistive torque are obtained. Thereafter, a compensating harmonic current derived from said force amplitudes and phase shifts of the said multiple harmonic detent torques is injected into a current command during operation of the stepper motor to compensate for torque ripples.
|
1. Method for damping vibrations in a stepper motor with micro-stepping control, comprising the steps of:
identifying the force amplitudes and phase shifts of multiple harmonic detent torques of the stepper motor;
tuning the stepper motor with different current commands until minimum friction and resistive torque are obtained; and then
injecting a compensating harmonic current derived from said force amplitudes and phase shifts of the said multiple harmonic detent torques into a current command during operation of the stepper motor to compensate for torque ripples.
2. Method for damping vibrations as claimed in
3. Method for damping vibrations as claimed in
4. Method for damping vibrations as claimed in
wherein iq
5. Method for damping vibrations as claimed in
6. Method for damping vibrations as claimed in
wherein iq
7. Method for damping vibrations as claimed in
τ=Km[−ia sin(Nrθ)+ib cos(Nrθ)]−Kd4 sin(4Nrθ)−Kd2 sin(2Nrθ+φ2)−Kd1 sin(Nrθ+φ1)−Fs wherein Km is a motor force constant of the stepper motor; ia is a phase A current; ib is a phase B current; Kd1 is a force amplitude of the first harmonic detent torque; Kd2 is a force amplitude of the second harmonic detent torque; Kd4 is a force amplitude of the fourth harmonic detent torque; φ1 is a phase shift of the first harmonic detent torque; φ2 is a phase shift of the second harmonic detent torque; and Fs is the static friction.
|
This application claims the benefit and priority of U.S. Provisional Application Ser. No. 60/866,634 filed on Nov. 21, 2006, and entitled MODEL-BASED ACTIVE ELECTRONIC DAMPING FOR STEPPER MOTORS, the disclosure of which is incorporated herein by reference.
The invention relates to stepper motors, and in particular, to the damping of vibrations in stepper motors during operation, especially mechanical resonance at low speeds.
A stepper motor is a motor wherein its driveshaft rotates in small angular steps rather than continuously. For example, each angular step in a commercial stepper system may comprise rotation of 1.8°. The driveshaft can thus be moved to any position reliably by sending an appropriate number of step pulses. Although stepper motors are generally slower as compared to servo motors, stepper motor systems have several significant advantages and thus are very popular in many industries. In particular, no position feedback information is normally required for either position control or speed control. Furthermore, in normal working states, positional error is non-accumulative. Besides, stepper motors are generally compatible with modern digital equipment.
For these reasons, various types and classes of stepping motor have been used in computer peripherals, automated machinery and similar systems. The cost of stepper systems is significantly lower than that of servo systems, mainly due to the removal of costly position feedback devices and complicated feedback control. Moreover, it does not require the tuning of feedback control which needs extra expertise and effort. Also, the simple hardware and control configuration improves system reliability.
However, one of the most unfavorable features of stepper motors is mechanical resonance, especially at low speeds. The problem is less significant at high speeds as the mechanical system tends to filter out high frequency resonance. Resonance prevents the stepper motor from running steadily at certain speeds and reduces the usable torque. Also, it prevents stepper motors from being used on applications that require smooth low speed motion. Resonance exists even with very fine microstepping control due to motor characteristics.
Various damping techniques have been applied in the art to overcome this problem, including mechanical damping, linearized feedback control and electronic damping.
U.S. Pat. No. 5,659,234 entitled “Vibration reduction for stepping motor by vector angle and vector length modulation” describes a method which reduces the vibration caused by system characteristics (including motor characteristic, speed of operation and stepping noise). On a test rig, the dynamic behaviour of the stepping motor in micro stepping mode is measured by a system comprising a rotation encoder. The measured data are filtered and used to compensate the unwanted speed fluctuations. A correction vector table is found iteratively by observing a velocity ripple. The method is applied to a particular configuration of a system characteristic at fixed speed. It is not applicable to a particular motor model as such and cannot be applied to various configurations and speeds.
U.S. Pat. No. 5,847,535 entitled “Active electronic damping for step motor” discloses a different type of damping method based on sensorless technology. A motor torque output is estimated and is compared with an expected value in real time during operation. Position commands are adjusted accordingly to compensate for the torque ripple.
U.S. Pat. No. 6,040,676 entitled “Passive electronic damping for step motor” describes yet another different type of damping method based on capacitor-inductor electrical interaction. A capacitor with matched value is used to create a virtual short circuit path for the electric frequency in vibration. Vibration energy is thus quickly dissipated.
Nevertheless, prior art damping methods have their limitations. For example, mechanical dampers will wear out with prolonged use. Feedback control requires the use of high resolution position feedback devices. Finally, electronic damping usually requires high order equations and complicated motor characteristics identification. Therefore, the need for an effective and practical damping technique still exists. It would be advantageous to provide a novel damping approach that can be applied to different stepper motor models with variable configurations and operation speeds.
It is thus an object of the invention to seek to model the behavior of a commercial stepper motor accurately and efficiently, and to provide a damping technique that can be applied to different stepper motor models with variable configurations and operation speeds.
Accordingly, the invention provides a method for damping vibrations in a stepper motor with micro-stepping control, comprising the steps of: identifying the force amplitudes and phase shifts of multiple harmonic detent torques of the stepper motor; tuning the stepper motor with different current commands until minimum friction and resistive torque are obtained; and then injecting a compensating harmonic current derived from said force amplitudes and phase shifts of the said multiple harmonic detent torques into a current command during operation of the stepper motor to compensate for torque ripples.
It would be convenient hereinafter to describe the invention in greater detail by reference to the accompanying drawings which illustrates a preferred embodiment of the invention. The particularity of the drawings and the related description is not to be understood as superseding the generality of the broad identification of the invention as defined by the claims.
Examples of preferred embodiments of electronic damping systems in accordance with the invention will now be described with reference to the accompanying drawings, in which:
In the following description, it is assumed that the stepper motor used is optimized for sinusoidal microstep control. For open loop damping algorithms, it is assumed that fine microstepping (e.g. 1/64 or less) is used.
A simplified stepper motor model, including electrical dynamics and torque expression, is used most of the time for efficiency. The simplified stepper motor electrical dynamics and torque expressions are as follows:
With micro-stepping control, the above simplified model predicts only one resonant speed, which is caused by the 4th harmonic detent torque ripple, the last term in Equation (3). This is not fully compatible with that of a commercial stepper in real life. Commercial stepper motors may have multiple resonant speeds, such as three resonant speeds. Thus, it would be desirable to define a new stepper torque expression to model this characteristic without using high order equations and complicated identification procedures. Open loop and servo control algorithms with feed forward damping techniques are proposed accordingly. The damping techniques have been simulated and the results show that the proposed algorithms can effectively reduce the adverse effects of resonance at low speed.
A. Stepper Motor Model
With the above set-up, we can identify the motor characteristics to fill in all the required constants in the following equation:
τ=Km[−ia sin(Nrθ)+ib cos(Nrθ)]−Kd4 sin(4Nrθ)−Kd2 sin(2Nrθ+φ2)−Kd1 sin(Nrθ+φ1)−Fs (4)
To fill in the constants Kd4 Kd2 Kd1 φ2 φ1 Fs in the above Equation (4), we need to identify the characteristics of the studied stepper motor. The stepper system is running in servo mode with the control algorithm described in equations (5) and (6) below.
For reference,
The parameters to be identified are tuned until minimum friction and resistive torque are observed and a period torque ripple is removed. The obtained parameters are then substituted back into Equation (4) above to complete the torque expression. Note that the parameters can also be obtained by measuring the motor static torque-position characteristic followed by a frequency domain analysis, but implementing such an approach would be complicated and expensive.
B. Open Loop System
The damping algorithms according to the preferred embodiments of the invention for open loop and servo control are based on the mentioned stepper motor model. Harmonic current is injected into the current command (Q axis, on DQ plane) to compensate for the identified torque ripple.
vd=Kp(id
An Inverse Park Transform module 12 transforms variables vd and vq from a rotating reference frame to a stationary reference frame based on a position command θcmd input into it. A SVPWM 3-phase chopper 13 generates a 3-phase voltage from the 2-phase voltage command produced by the Inverse Park Transform module 12. The 3-phase voltage 18 (vα, vβ and vγ) generated by the 3-phase SVPWM chopper 13 is transmitted to the stepper motor 14, which generates torque τ according to the phase current and the rotor position. A resultant motor load 16 is exerted. A simple inertia load is assumed for simple analysis. Its position, velocity and acceleration are responsive to the torque τ exerted on it.
A feedback current ia
Based on the stepper motor model proposed in relation to the closed-loop system shown in
Assuming rigid mounting of a dummy load without load torque, the load is described by Equation (9). D is a damping factor which is assumed to be 0.001 Nm/rad s−1 for a lightly damped system.
A three phase SVPWM driving scheme is described by Equations (10)-(13).
In addition, zero-order hold is applied on vαvβvγ to simulate the periodic PWM update of the chopper drive.
With the injection of 4th, 2nd and 1st harmonic detent torque compensation in Iq
Note that Id
C. Servo System
A MatLab model of a servo controlled stepper system is built as illustrated in
A standard PI (proportion-integration) controller 11 receives the current command id, such that the vd produced (including the subtraction between the PI controller 11 and the open loop control algorithm 10) is:
vd=Kp(id
An Inverse Park Transform module 12 transforms variables vd and vq from a rotating reference frame to a stationary reference frame based on a position feedback θfb input into it. A SVPWM 3-phase chopper 13 generates a 3-phase voltage from the 2-phase voltage command produced by the Inverse Park Transform module 12. The 3-phase voltage 18 (vα, vβ and vγ) generated by the 3-phase SVPWM chopper 13 is transmitted to the stepper motor 14, which generates torque τ according to the phase current and the rotor position. A resultant motor load 16 is exerted. A simple inertia load is assumed for simple analysis. Its position, velocity and acceleration are responsive to the torque τ exerted on it.
A feedback current ia
The following control algorithm in Equations (14) and (15) is proposed for smooth low speed servo motion:
The effect of finite resolution of the encoder is modeled by the quantization of θfb. As the velocity is found by differentiating the motor's respective positions, the resolution of the velocity depends on the sample rate as well as the resolution of the encoder 9. In the servo system, the encoder resolution may be 4000 pulses/rev and the calculation may be done at 20 kHz. This means the resolution may be 1/4000×20000×60=300 rpm.
Note that with a low resolution optical encoder, velocity feedback ωfb 26 is noisy since it is obtained by differentiating the position feedback θfb 24. A low pass filter 25 is needed to filter out the noise. Thus, system response to velocity error is unsatisfactory without the torque ripple compensation as described. Also note that the position feedback θfb 24 may be obtained by any position sensing device or sensorless observer.
The damping and control algorithm is preferably coded into the DSP controller 2 and the current loop is tuned to ensure good current tracking even when the motor is running at high speed.
In open loop mode, all resonance points are eliminated.
In servo mode, the smoothness of low speed motion is improved.
It would be appreciated that the stepper torque expression as applied to the dampening system according to the preferred embodiment of the invention can model the characteristics of a stepper motor without using high order equations and complicated identification procedures. The described procedure used to identify the motor characteristics is simple and requires only a low resolution position feedback device, which is relatively inexpensive.
Both simulation and experimental results show that the damping system according to the preferred embodiment of the invention can effectively damp out low speed motor vibration.
The invention described herein is susceptible to variations, modifications and/or additions other than those specifically described and it is to be understood that the invention includes all such variations, modifications and/or additions which fall within the spirit and scope of the above description.
Ng, Hon Yu Peter, Ou, Gang, Gan, Wai Chuen, Tam, Shing Wai, Tsui, Wang Hay Kenneth
Patent | Priority | Assignee | Title |
7969113, | Jul 31 2008 | Sanyo Denki Co., Ltd. | Motor control system |
8080956, | Aug 26 2010 | Ford Global Technologies, LLC | Electric motor torque estimation |
8963475, | Oct 05 2010 | Mitsubishi Electric Corporation | Micro-step driving control apparatus for stepping motor |
Patent | Priority | Assignee | Title |
3660746, | |||
5659234, | Feb 04 1994 | AGFA Gevaert, N.V.; AGFA-GEVAERT N V | Vibration reduction for stepping motor by vector angle and vector length modulation |
5847535, | Jan 22 1997 | Parker Intangibles LLC | Active electronic damping for step motor |
6002232, | Aug 15 1997 | Iowa State University Research Foundation Inc | Robust vibration suppression methods and systems |
6040676, | Jan 31 1996 | Parker Intangibles LLC | Passive electronic damping for step motor |
6140793, | Aug 19 1999 | Bristol-Myers Squibb Company | Stepper motor controller for microstepping a stepper motor and a method for microstepping a stepper motor |
6229277, | Dec 19 1996 | Kone Corporation | Method and apparatus for the damping of motor vibrations |
7429846, | Dec 25 2002 | MINEBEA CO , LTD | Stepping motor control apparatus |
Executed on | Assignor | Assignee | Conveyance | Frame | Reel | Doc |
Nov 14 2007 | NG, HON YU PETER | ASM Assembly Automation Ltd | CORRECTIVE ASSIGNMENT TO CORRECT THE NAME OF THE ASSIGNEE PREVIOUSLY RECORDED ON REEL 020355 FRAME 0457 ASSIGNOR S HEREBY CONFIRMS THE ASSIGNMENT | 020686 | /0919 | |
Nov 14 2007 | GAN, WAI CHUEN | ASM Assembly Automation Ltd | CORRECTIVE ASSIGNMENT TO CORRECT THE NAME OF THE ASSIGNEE PREVIOUSLY RECORDED ON REEL 020355 FRAME 0457 ASSIGNOR S HEREBY CONFIRMS THE ASSIGNMENT | 020686 | /0919 | |
Nov 14 2007 | TSUI, WANG HAY KENNETH | ASM Assembly Automation Ltd | CORRECTIVE ASSIGNMENT TO CORRECT THE NAME OF THE ASSIGNEE PREVIOUSLY RECORDED ON REEL 020355 FRAME 0457 ASSIGNOR S HEREBY CONFIRMS THE ASSIGNMENT | 020686 | /0919 | |
Nov 14 2007 | NG, HON YU PETER | ASM TECHNOLOGY AUTOMATION LTD | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 020355 | /0457 | |
Nov 14 2007 | GAN, WAI CHUEN | ASM TECHNOLOGY AUTOMATION LTD | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 020355 | /0457 | |
Nov 14 2007 | TSUI, WANG HAY KENNETH | ASM TECHNOLOGY AUTOMATION LTD | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 020355 | /0457 | |
Nov 18 2007 | TAM, SHING WAI | ASM TECHNOLOGY AUTOMATION LTD | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 020355 | /0457 | |
Nov 18 2007 | TAM, SHING WAI | ASM Assembly Automation Ltd | CORRECTIVE ASSIGNMENT TO CORRECT THE NAME OF THE ASSIGNEE PREVIOUSLY RECORDED ON REEL 020355 FRAME 0457 ASSIGNOR S HEREBY CONFIRMS THE ASSIGNMENT | 020686 | /0919 | |
Nov 19 2007 | ASM Assembly Automation Ltd. | (assignment on the face of the patent) | / | |||
Dec 07 2007 | OU, GANG | ASM TECHNOLOGY AUTOMATION LTD | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 020355 | /0457 | |
Dec 07 2007 | OU, GANG | ASM Assembly Automation Ltd | CORRECTIVE ASSIGNMENT TO CORRECT THE NAME OF THE ASSIGNEE PREVIOUSLY RECORDED ON REEL 020355 FRAME 0457 ASSIGNOR S HEREBY CONFIRMS THE ASSIGNMENT | 020686 | /0919 |
Date | Maintenance Fee Events |
Nov 06 2013 | M1551: Payment of Maintenance Fee, 4th Year, Large Entity. |
Nov 23 2017 | M1552: Payment of Maintenance Fee, 8th Year, Large Entity. |
Nov 24 2021 | M1553: Payment of Maintenance Fee, 12th Year, Large Entity. |
Date | Maintenance Schedule |
Jun 08 2013 | 4 years fee payment window open |
Dec 08 2013 | 6 months grace period start (w surcharge) |
Jun 08 2014 | patent expiry (for year 4) |
Jun 08 2016 | 2 years to revive unintentionally abandoned end. (for year 4) |
Jun 08 2017 | 8 years fee payment window open |
Dec 08 2017 | 6 months grace period start (w surcharge) |
Jun 08 2018 | patent expiry (for year 8) |
Jun 08 2020 | 2 years to revive unintentionally abandoned end. (for year 8) |
Jun 08 2021 | 12 years fee payment window open |
Dec 08 2021 | 6 months grace period start (w surcharge) |
Jun 08 2022 | patent expiry (for year 12) |
Jun 08 2024 | 2 years to revive unintentionally abandoned end. (for year 12) |