CN101329359B - Multi-point smoothing motor speed estimation method - Google Patents
Multi-point smoothing motor speed estimation method Download PDFInfo
- Publication number
- CN101329359B CN101329359B CN2007101094415A CN200710109441A CN101329359B CN 101329359 B CN101329359 B CN 101329359B CN 2007101094415 A CN2007101094415 A CN 2007101094415A CN 200710109441 A CN200710109441 A CN 200710109441A CN 101329359 B CN101329359 B CN 101329359B
- Authority
- CN
- China
- Prior art keywords
- speed
- motor
- speed estimation
- sampling
- estimation value
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 42
- 238000009499 grossing Methods 0.000 title claims description 26
- 238000005070 sampling Methods 0.000 claims abstract description 47
- 238000001914 filtration Methods 0.000 claims abstract description 7
- 238000012935 Averaging Methods 0.000 abstract description 6
- 230000009191 jumping Effects 0.000 abstract description 2
- 238000005259 measurement Methods 0.000 abstract 1
- 238000006073 displacement reaction Methods 0.000 description 9
- 238000005516 engineering process Methods 0.000 description 8
- 238000010009 beating Methods 0.000 description 6
- 238000010586 diagram Methods 0.000 description 5
- 230000008569 process Effects 0.000 description 5
- 230000004044 response Effects 0.000 description 5
- 230000015572 biosynthetic process Effects 0.000 description 4
- 238000003786 synthesis reaction Methods 0.000 description 4
- 238000004422 calculation algorithm Methods 0.000 description 3
- 230000008859 change Effects 0.000 description 3
- 238000013139 quantization Methods 0.000 description 3
- 230000036461 convulsion Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- JEIPFZHSYJVQDO-UHFFFAOYSA-N ferric oxide Chemical compound O=[Fe]O[Fe]=O JEIPFZHSYJVQDO-UHFFFAOYSA-N 0.000 description 2
- 230000006872 improvement Effects 0.000 description 2
- 238000010587 phase diagram Methods 0.000 description 2
- 206010021703 Indifference Diseases 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000035876 healing Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000011664 signaling Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 230000002194 synthesizing effect Effects 0.000 description 1
- 238000010189 synthetic method Methods 0.000 description 1
Images
Landscapes
- Control Of Electric Motors In General (AREA)
Abstract
A method for estimating the speed of multi-point smooth motor includes such steps as over-sampling the output of encoder according to over-sampling factor M, and averaging the over-sampled results to obtain the initial speed estimation value. And finally, performing low-pass filtering processing on the preliminary speed estimation value to obtain a final speed estimation value, and sending the final speed estimation value to a speed controller to control the speed of the motor. In addition, the present invention can also use two oversampling factors to perform oversampling processing respectively, and selectively use one of the results obtained by the two oversampling factors according to the average value of the results obtained by the two oversampling factors. The method of the invention can greatly improve the problem of the measurement of the jumping of the rotating speed of the motor during high-speed operation.
Description
Technical field
The present invention relates to a kind of motor speed estimating and measuring method, relate in particular to a kind of method for estimating multi-point smoothing motor velocity.
Background technology
In motor endless loop speed control, speed estimation is indispensable function.Generally when motor is done speed estimation, often use scrambler to estimate the running speed of motor rotor.Known speed estimation algorithm is resolved deficiency because the position of scrambler itself quantizes (position quantization), and resulting estimation speed is difficult to take into account simultaneously flatness (smoothness) and real-time (real-time).Yet these two characteristics are to need indispensable simultaneously characteristic on the robotization industry is used, and level and smooth more speed estimation method can not cause the vibrations of the noise and the board of running more; Speed estimation with real-time can show the characteristic of raw velocity more, reduces to postpone, and then improves the performance of speed control performance.
Figure 1 shows that the block scheme of AC motor control system,, control the rotating speed of motor 10a by measuring the feedback information of motor speed.This known speed estimation 20a of system comprises counter 22a and speed estimation unit 24a.The motor position that scrambler 12a output pulse wave pulse signal measures with expression, counter 22a are handled the position signalling P that obtains motor behind this pulse wave pulse signal.Speed estimation unit 24a handles motor position signal P, to obtain motor rotary speed V
LPF Position control unit 40a is according to position command P
CmdWith with feedback from counter 22a, calculate speed command V
Cmd Speed control unit 30a is according to this speed command V then
CmdCalculate current order i
CmdExport to Current Control and with driver element 50a.This Current Control with and driver element 50a according to this current order i
CmdAnd motor is feedback feedback current with CD-ROM drive motor 10a.
Fig. 2 and 3 has illustrated principle and the step that known technology speed estimation unit 24a handles respectively.As shown in Figure 2, known speed estimation unit 24a utilizes the displacement in the unit interval to estimate present translational speed:
Wherein V (t) is an estimation speed, and the feedback position of P (t) presentation code device, T are sample time.As shown in Figure 3, speed estimation unit 24a obtains the numerical value P (t) (step S12) of counter feedback when the interruption of each time T (step S10a).Speed estimation unit 24a deducts the position P (t-T) (step S14) that last time interrupted by the numerical value P (t) of counter feedback again.Then speed estimation unit 24a according to the difference of twice position and sample time T calculate preliminary estimation speed
(step S16).The preliminary estimation speed V that will try to achieve then forms last velocity amplitude V after via the low-pass filter smoothing
LPF(step S18).
Because the quantization error (quantization error) of encoder position, there is the jerk value problem of measuring in known technology.That supposes that scrambler one changes resolves to the 1 living N that changes the line of production
tIndividual pulse, the sampling frequency of speed estimation are fsHz,, it is (60*fs/N that the rough rotating speed of speed then takes place
t) integral multiple of RPM.
With the example that is measured as of motor rotary speed, suppose that sample time, T was (6kHz)
-1, and the resolution of scrambler revolution is 10000 pulse/commentaries on classics, motor rotary speed is done when measuring from 0rpm to 500rpm, in the time of can finding that rotating speed is about the multiple of 36rpm, estimate its jerk value of rotating speed that can be bigger with respect to other rotating speed.Be motor when being controlled at these rotating speeds, running has rough phenomenon.
U.S. Patent application US20070043528A1 discloses a kind of method that the measuring speed of a plurality of sample periods is averaged, to reduce ripple (ripple) problem of measuring.Yet the mode that this patent provided has the problem of phase delay (phase delay) when the motor high frequencies of operation.
Summary of the invention
Therefore the object of the present invention is to provide a kind of motor speed estimating and measuring method of taking into account smoothing and high frequency response.
According to a kind of method for estimating multi-point smoothing motor velocity provided by the invention, measure the speed estimation value of motor according to the output of scrambler, so that described speed estimation value is sent to the motor speed control module, this method comprises: decision over sampling factor M; Read the output of described scrambler; Output to described scrambler is counted; According to described over sampling factor M and rated speed control sampling fs, did sampling for the output of described scrambler; Reach a plurality of sampling results of crossing are done average treatment, to obtain the initial velocity estimated value.
According to another kind of method for estimating multi-point smoothing motor velocity provided by the invention, measure the speed estimation value of motor according to the output of scrambler, so that described speed estimation value is sent to motor speed controller, this method comprises: determine the first over sampling factor M1 and the second over sampling factor M2; Read the output of described scrambler; Output to described scrambler is counted; According to described first over sampling factor M1 and rated speed control sampling, did sampling for the output of described scrambler, and a plurality of sampling results of crossing were done average treatment, to obtain the first initial velocity estimated value V1; According to described second over sampling factor M2 and rated speed control sampling, did sampling for the output of described scrambler, and a plurality of sampling results of crossing were done average treatment, to obtain the second initial velocity estimated value V2; Calculate the mean value V of described first initial velocity estimated value V1 and the described second initial velocity estimated value V2
AvgAccording to described mean value V
Avg, judge that using described initial velocity estimated value V1 still is the described second initial velocity estimated value V2.
According to motor speed estimating and measuring method provided by the invention, can not only take into account the real-time of smoothing and high frequency response, and the problem of beating can significantly improve motor rotary speed and measure the time.
Description of drawings
Fig. 1 is the block scheme of AC motor control system;
Fig. 2 shows the principle of known technology speed estimation cell processing;
Fig. 3 shows the step of known technology speed estimation cell processing;
Fig. 4 is for realizing the block scheme of this method for estimating multi-point smoothing motor velocity according to the preferred embodiments of the invention;
Fig. 5 is the synoptic diagram of the present invention and known technology sampling mode;
Fig. 6 is the process flow diagram according to method for estimating multi-point smoothing motor velocity of the present invention;
Fig. 7 is all 8 and 16 o'clock system responses phase diagram for method of the present invention and above-mentioned patent at average.
Fig. 8 A to 8C is the method for estimating multi-point smoothing motor velocity process flow diagram of second preferred embodiment according to the present invention.
[primary clustering symbol description]
[known technology]
Counter 22a speed estimation unit 24a
Current Control and driver element 50a
[the present invention]
Impulse meter 22 is crossed sampling unit 24
Embodiment
Referring to Fig. 4, it is for realizing the block scheme of this method for estimating multi-point smoothing motor velocity according to the preferred embodiments of the invention.Estimating multi-point smoothing motor velocity device 20 of the present invention is connected between impulse type scrambler 12 and the speed control unit 30, to handle the motor position information that transmits from impulse type scrambler 12, and the estimation motor rotary speed, and then output estimation speed is to speed control unit 30.
This estimating multi-point smoothing motor velocity device 20 mainly comprises impulse meter 22, crosses sampling unit 24, displacement averaging unit 26 and low-pass filter 28.
Impulse meter 22 is made accumulated counts with the umber of pulse of scrambler, its function and known counter and indifference.Cross sampling unit 24 and be the umber of pulse sampler of discrete time, its sampling rate is M a times of rated speed control sampling (rated speed sampling).Suppose that rated speed control originally is sampled as fs Hz, the corresponding sample cycle is T=1/fs (Sec).According to estimating multi-point smoothing motor velocity rule of the present invention, crossing sampling unit 24 pairing sampling frequencies is M*fs Hz, be Ts=1/ (M*fs) Sec its sample time, and wherein M is an over sampling factor (over-sampling factor), and it is the integer greater than 1.Displacement averaging unit 26 will obtain M group displacement through average treatment, again divided by the sample period time T, then can tentatively be estimated velocity amplitude V (t).The raw velocity estimated value V (t) of 28 pairs of displacement averaging units 26 of low-pass filter does low-pass filtering treatment, and to obtain the final speed estimated value, the final speed estimated value can be used for the speed closed-loop control.
For illustrating further method for estimating multi-point smoothing motor velocity of the present invention, be example with over sampling factor M=4, its sampling mode is as shown in Figure 5.4 groups of displacements process average treatment with Fig. 5 sampling obtains again divided by the sample period time T, then can obtain raw velocity estimated value V (t),
V (t) representation can be written as following formula,
Having served as sampling frequency is M times that rated speed control is taken a sample, and its general formula is
The raw velocity estimated value that the displacement averaging unit is calculated by the filtering of a low-pass filter, is exported a final speed estimated value more at last, and this final speed estimated value can be used for the motor speed closed-loop control.
Referring to Fig. 6, it is the process flow diagram according to method for estimating multi-point smoothing motor velocity of the present invention.At first determine an over sampling factor M (step S20), then read the output (step S22) of scrambler and do counting (step S24) for the output of scrambler.Did sampling (step S26) according to over sampling factor M for the output position information of scrambler, and a plurality of sampling results of crossing were done average treatment (step S28), to obtain the raw velocity estimated value.At last this raw velocity estimated value is done low-pass filtering treatment (step S29), to obtain the final speed estimated value.
(U.S. Patent application 20070043528A1) compares with known technology, when method for estimating multi-point smoothing motor velocity of the present invention strengthens over sampling factor M, can not form the obvious delay of above-mentioned patent velocity estimated value and actual speed.And this method is used fixing average (over sampling factor M), not with the rotating speed change, its role is on average cross the multi-point displacement that sampling obtains.Above-mentioned patented method reaches the position deviation of eliminating scrambler with rotating speed change average, thereby above-mentioned patent is because the delay of speed estimation value also can't be applied to the high-speed servocontrol of this patent.
Fig. 7 is all 8 and 16 o'clock system responses phase diagram for method of the present invention and above-mentioned patent at average, and from then on figure can find out obviously that this method when increase average improves the smoothness of speed estimation, can't additionally cause the time delay of signal.In other words, this method is taken into account the performance requirement of flatness and high frequency response simultaneously.And rate algorithm of the present invention can improve the flatness of speed, and average is bigger, and level and smooth effect better.Simultaneously, the inventor finds originally at rotating speed (60 * fs/N
t) that speed takes place is unsmooth for RPM, only occurs in (60 * fs * M/N at new algorithm
t) RPM.Served as the sampling frequency height of healing and made average M bigger, it is higher that rough rotating speed takes place, and when the highest operating speed of rough rotating ratio is higher, can avoid the rough operating point of all speed.
Referring to Fig. 8 A to 8C, it is respectively the method for estimating multi-point smoothing motor velocity of second preferred embodiment according to the present invention.It is discontinuous that this method mainly more effectively is reduced in ripple rotating speed fr=(M/Nt) * 60 * fsRPM generation speed.This embodiment is utilized the level and smooth speed estimation of the multiple spot of two different over sampling factors (M value) V as a result
M1With V
M2, M wherein
1≠ M
2If, with two speed estimation combinations that the M value is different, then will be at fr * (M
1With M
2Lowest common multiple) on rotating speed the phenomenon of beating just can appear estimating.Suppose that sample time, T was (6kHz)
-1, and the resolution of scrambler revolution is 10000 pulse/commentaries on classics, then ripple rotating speed fr is about the multiple of 36rpm.
Following to improve multiple spot according to this thinking level and smooth, and it is called synthesis type multiple spot smoothing method (composite multiple-point smoothing method for motor-speedestimation).With M
1=8 and M
2=9 is example, and the computing method of synthesis type multiple spot smoothing method are as follows:
V wherein
M1With V
M2Resulting speed estimation numerical value when representing M=8 and M=9 respectively and V
M1_M2_avgRepresent V
M1With V
M2Mean value, if
Utilize multiple spot smoothly to estimate process flow diagram that synthetic method estimates speed shown in 8A to 8C, computing T break period originally is divided into M
1With M
2Five equilibrium is at every turn
With
Interruption the time, obtain the numerical value P of counter, utilize the P value to obtain P (1-z again
-M1), P (1-z
-M2), try to achieve V
M1, V
M2(step S42, and in the lump referring to the explanation of Fig. 8 B and Fig. 8 C).When the interruption of T, utilize V
M1With V
M2Mean value V
M1_M2_avg(calculating in step S44) judged will use V
M1Or V
M2The input signal (step S46) of being used as low-pass filtering, last selected signal obtain V after by low-pass filtering treatment
LPFUse (step S48) to the control loop that is T break period.
Simulation according to the inventor is found: when supposing M=8, speed still has the phenomenon of beating on 36 * 8=288rpm, and when M=9, is that the phenomenon of beating is arranged on 36 * 9=324rpm.In order to improve this phenomenon, utilize synthesis type multiple spot smoothing method to come estimation speed after, can find that then speed estimation beating on these two rotating speeds (288rpm and 324rpm) all obtained improvement.
Though strengthen M value also just like above-mentioned effect, be that the system of high speed is an example with a 3000rpm, if utilize multiple spot smoothly will improve jumping phenomena on all 36 multiple rotating speeds merely, then need the M value is enlarged to more than 84 (84 * 36〉3000).And use level and smooth the synthesizing of multiple spot, and as long as then utilize M=9 and M=10, just can reach requirement (9 and 10 lowest common multiples) * 36=90 * 36〉3000.Therefore get two relatively prime integers as can be seen and make synthesis type multiple spot smoothing method, the problem of can more effective improvement beating.
Generally speaking, technical characterictic of the present invention and advantage are described below:
Technical characterictic of the present invention was for using sampling (over-sampling) device, and its sampling frequency is higher than the sampling frequency of speed control.And technological merit of the present invention can not cause time delay too much between speed estimation value and true velocity again for producing level and smooth speed estimation value.
The foregoing description for explanation the present invention's usefulness, and is not a limitation of the present invention only, those skilled in the art under the premise without departing from the spirit and scope of the present invention, the various equivalent structures of being made change all within the scope of the present invention.Protection scope of the present invention is defined by the claims.
Claims (2)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN2007101094415A CN101329359B (en) | 2007-06-21 | 2007-06-21 | Multi-point smoothing motor speed estimation method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN2007101094415A CN101329359B (en) | 2007-06-21 | 2007-06-21 | Multi-point smoothing motor speed estimation method |
Related Child Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN2010102430561A Division CN101907632B (en) | 2007-06-21 | 2007-06-21 | Multi-point smoothing motor speed estimation method |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN101329359A CN101329359A (en) | 2008-12-24 |
| CN101329359B true CN101329359B (en) | 2011-02-16 |
Family
ID=40205269
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN2007101094415A Active CN101329359B (en) | 2007-06-21 | 2007-06-21 | Multi-point smoothing motor speed estimation method |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN101329359B (en) |
Families Citing this family (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| TWI424163B (en) * | 2010-10-04 | 2014-01-21 | Teco Elec & Machinery Co Ltd | Estimation method for rotational speed and computer readable medium using the same |
| CN103546076B (en) * | 2010-10-08 | 2015-12-09 | 东元电机股份有限公司 | Rotational speed estimation method and computer-readable medium using same |
| CN107102162A (en) * | 2017-04-21 | 2017-08-29 | 中国神华能源股份有限公司 | Rotary shaft rotating speed measuring method and device |
| TWI627410B (en) | 2017-05-17 | 2018-06-21 | 財團法人工業技術研究院 | Rotor driving system and method for driving rotor |
| TWI733951B (en) * | 2017-11-20 | 2021-07-21 | 達明機器人股份有限公司 | Method for dynamically sampling encoder in motor ripple of a motor |
| CN112986605B (en) * | 2021-02-22 | 2022-12-16 | 宏晶微电子科技股份有限公司 | Motor speed measuring method and device |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN1026937C (en) * | 1991-05-20 | 1994-12-07 | 株式会社明电舍 | System and method for controlling speed of electric motor |
| US5886491A (en) * | 1995-09-29 | 1999-03-23 | Mitsubishi Denki Kabushiki Kaisha | Position control unit for electric motor |
| CN1592070A (en) * | 2003-09-01 | 2005-03-09 | 佳能株式会社 | Vibration type actuator drive controller and method of controlling drive speed of vibration type actuator |
-
2007
- 2007-06-21 CN CN2007101094415A patent/CN101329359B/en active Active
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN1026937C (en) * | 1991-05-20 | 1994-12-07 | 株式会社明电舍 | System and method for controlling speed of electric motor |
| US5886491A (en) * | 1995-09-29 | 1999-03-23 | Mitsubishi Denki Kabushiki Kaisha | Position control unit for electric motor |
| CN1592070A (en) * | 2003-09-01 | 2005-03-09 | 佳能株式会社 | Vibration type actuator drive controller and method of controlling drive speed of vibration type actuator |
Also Published As
| Publication number | Publication date |
|---|---|
| CN101329359A (en) | 2008-12-24 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN101329359B (en) | Multi-point smoothing motor speed estimation method | |
| CN101292163B (en) | Speed measurement system for speed control of high-speed motors | |
| CN1087422A (en) | Vortex flowmeter electronics | |
| CN107769643B (en) | Stepping motor control method and device, stepping motor and storage medium | |
| CN106405142A (en) | Device and method for measuring rotational speed ripple and torque ripple of motor | |
| Shaowei et al. | Velocity and acceleration computations by single-dimensional Kalman filter with adaptive noise variance | |
| CN109347397A (en) | The current of electric method of sampling and system based on three resistance of three-phase drive bridge lower bridge arm | |
| CN114509159B (en) | Order tracking analysis method, system and computer readable storage medium | |
| JP2002344290A (en) | Unit and method for converting sampling rate | |
| JP5056853B2 (en) | Speed detection method and motor control apparatus using the same | |
| CN112636660B (en) | Servo drive control system and absolute position signal processing method, device and equipment | |
| DE102020200115A1 (en) | DEVICE FOR CONTROLLING AN ENGINE, SYSTEM FOR CONTROLLING THE ENGINE, AND METHOD FOR CONTROLLING THE ENGINE | |
| CN104990717B (en) | A kind of magnetic-levitation train sensor signal processing method | |
| CN1043395C (en) | Control method and device for single-phase induction motor | |
| CN101789741A (en) | Motor speed controller | |
| CN102055402A (en) | Rotation speed and parameter simultaneous identification method of induction machine | |
| CN1226603C (en) | Embedded data collector capable of accurately measuring phase | |
| Yang et al. | Fast identification of resonance characteristic for 2-mass system with elastic load | |
| CN101907632B (en) | Multi-point smoothing motor speed estimation method | |
| US7460974B2 (en) | Multiple-point smoothing method for motor-speed estimation | |
| CN109782013B (en) | Motor speed measuring method and device, readable storage medium and electric equipment | |
| CN117309378A (en) | Fault degree identification method and device for speed reducer gear, electronic equipment and medium | |
| CN114578682B (en) | Coal mining machine towing cable control method, device and storage medium | |
| JP2006217729A (en) | Motor control device and its control method | |
| CN101499696A (en) | Servo system controlling method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant |