CN104184382B - Method for observing speed of permanent magnet motor - Google Patents
Method for observing speed of permanent magnet motor Download PDFInfo
- Publication number
- CN104184382B CN104184382B CN201410393609.XA CN201410393609A CN104184382B CN 104184382 B CN104184382 B CN 104184382B CN 201410393609 A CN201410393609 A CN 201410393609A CN 104184382 B CN104184382 B CN 104184382B
- Authority
- CN
- China
- Prior art keywords
- observer
- kalman
- motor
- speed
- rotating speed
- Prior art date
Links
- 230000001360 synchronised Effects 0.000 claims abstract description 28
- 230000000051 modifying Effects 0.000 claims abstract description 7
- 238000005070 sampling Methods 0.000 claims description 27
- 239000011159 matrix materials Substances 0.000 claims description 12
- 238000000034 methods Methods 0.000 claims description 10
- 230000004301 light adaptation Effects 0.000 claims description 7
- 230000005389 magnetism Effects 0.000 claims 1
- 230000003044 adaptive Effects 0.000 abstract description 16
- 230000011664 signaling Effects 0.000 description 12
- 238000004458 analytical methods Methods 0.000 description 4
- 238000010586 diagrams Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 4
- 230000005540 biological transmission Effects 0.000 description 3
- 238000004422 calculation algorithm Methods 0.000 description 3
- 230000001276 controlling effects Effects 0.000 description 3
- 230000035772 mutation Effects 0.000 description 3
- 230000003287 optical Effects 0.000 description 3
- 238000000827 velocimetry Methods 0.000 description 3
- 230000000875 corresponding Effects 0.000 description 2
- 238000001914 filtration Methods 0.000 description 2
- 230000003068 static Effects 0.000 description 2
- 206010011878 Deafness Diseases 0.000 description 1
- YBMRDBCBODYGJE-UHFFFAOYSA-N Germanium dioxide Chemical compound data:image/svg+xml;base64,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 data:image/svg+xml;base64,PD94bWwgdmVyc2lvbj0nMS4wJyBlbmNvZGluZz0naXNvLTg4NTktMSc/Pgo8c3ZnIHZlcnNpb249JzEuMScgYmFzZVByb2ZpbGU9J2Z1bGwnCiAgICAgICAgICAgICAgeG1sbnM9J2h0dHA6Ly93d3cudzMub3JnLzIwMDAvc3ZnJwogICAgICAgICAgICAgICAgICAgICAgeG1sbnM6cmRraXQ9J2h0dHA6Ly93d3cucmRraXQub3JnL3htbCcKICAgICAgICAgICAgICAgICAgICAgIHhtbG5zOnhsaW5rPSdodHRwOi8vd3d3LnczLm9yZy8xOTk5L3hsaW5rJwogICAgICAgICAgICAgICAgICB4bWw6c3BhY2U9J3ByZXNlcnZlJwp3aWR0aD0nODVweCcgaGVpZ2h0PSc4NXB4JyB2aWV3Qm94PScwIDAgODUgODUnPgo8IS0tIEVORCBPRiBIRUFERVIgLS0+CjxyZWN0IHN0eWxlPSdvcGFjaXR5OjEuMDtmaWxsOiNGRkZGRkY7c3Ryb2tlOm5vbmUnIHdpZHRoPSc4NScgaGVpZ2h0PSc4NScgeD0nMCcgeT0nMCc+IDwvcmVjdD4KPHBhdGggY2xhc3M9J2JvbmQtMCcgZD0nTSAxMy43NzE5LDQ1LjM0MzIgTCAyMy40MjQzLDQ1LjM0MzInIHN0eWxlPSdmaWxsOm5vbmU7ZmlsbC1ydWxlOmV2ZW5vZGQ7c3Ryb2tlOiNFODQyMzU7c3Ryb2tlLXdpZHRoOjJweDtzdHJva2UtbGluZWNhcDpidXR0O3N0cm9rZS1saW5lam9pbjptaXRlcjtzdHJva2Utb3BhY2l0eToxJyAvPgo8cGF0aCBjbGFzcz0nYm9uZC0wJyBkPSdNIDIzLjQyNDMsNDUuMzQzMiBMIDMzLjA3NjcsNDUuMzQzMicgc3R5bGU9J2ZpbGw6bm9uZTtmaWxsLXJ1bGU6ZXZlbm9kZDtzdHJva2U6IzNCNDE0MztzdHJva2Utd2lkdGg6MnB4O3N0cm9rZS1saW5lY2FwOmJ1dHQ7c3Ryb2tlLWxpbmVqb2luOm1pdGVyO3N0cm9rZS1vcGFjaXR5OjEnIC8+CjxwYXRoIGNsYXNzPSdib25kLTAnIGQ9J00gMTMuNzcxOSwzOC42NTY4IEwgMjMuNDI0MywzOC42NTY4JyBzdHlsZT0nZmlsbDpub25lO2ZpbGwtcnVsZTpldmVub2RkO3N0cm9rZTojRTg0MjM1O3N0cm9rZS13aWR0aDoycHg7c3Ryb2tlLWxpbmVjYXA6YnV0dDtzdHJva2UtbGluZWpvaW46bWl0ZXI7c3Ryb2tlLW9wYWNpdHk6MScgLz4KPHBhdGggY2xhc3M9J2JvbmQtMCcgZD0nTSAyMy40MjQzLDM4LjY1NjggTCAzMy4wNzY3LDM4LjY1NjgnIHN0eWxlPSdmaWxsOm5vbmU7ZmlsbC1ydWxlOmV2ZW5vZGQ7c3Ryb2tlOiMzQjQxNDM7c3Ryb2tlLXdpZHRoOjJweDtzdHJva2UtbGluZWNhcDpidXR0O3N0cm9rZS1saW5lam9pbjptaXRlcjtzdHJva2Utb3BhY2l0eToxJyAvPgo8cGF0aCBjbGFzcz0nYm9uZC0xJyBkPSdNIDUwLjkyMzMsNDUuMzQzMiBMIDYwLjU3NTcsNDUuMzQzMicgc3R5bGU9J2ZpbGw6bm9uZTtmaWxsLXJ1bGU6ZXZlbm9kZDtzdHJva2U6IzNCNDE0MztzdHJva2Utd2lkdGg6MnB4O3N0cm9rZS1saW5lY2FwOmJ1dHQ7c3Ryb2tlLWxpbmVqb2luOm1pdGVyO3N0cm9rZS1vcGFjaXR5OjEnIC8+CjxwYXRoIGNsYXNzPSdib25kLTEnIGQ9J00gNjAuNTc1Nyw0NS4zNDMyIEwgNzAuMjI4MSw0NS4zNDMyJyBzdHlsZT0nZmlsbDpub25lO2ZpbGwtcnVsZTpldmVub2RkO3N0cm9rZTojRTg0MjM1O3N0cm9rZS13aWR0aDoycHg7c3Ryb2tlLWxpbmVjYXA6YnV0dDtzdHJva2UtbGluZWpvaW46bWl0ZXI7c3Ryb2tlLW9wYWNpdHk6MScgLz4KPHBhdGggY2xhc3M9J2JvbmQtMScgZD0nTSA1MC45MjMzLDM4LjY1NjggTCA2MC41NzU3LDM4LjY1NjgnIHN0eWxlPSdmaWxsOm5vbmU7ZmlsbC1ydWxlOmV2ZW5vZGQ7c3Ryb2tlOiMzQjQxNDM7c3Ryb2tlLXdpZHRoOjJweDtzdHJva2UtbGluZWNhcDpidXR0O3N0cm9rZS1saW5lam9pbjptaXRlcjtzdHJva2Utb3BhY2l0eToxJyAvPgo8cGF0aCBjbGFzcz0nYm9uZC0xJyBkPSdNIDYwLjU3NTcsMzguNjU2OCBMIDcwLjIyODEsMzguNjU2OCcgc3R5bGU9J2ZpbGw6bm9uZTtmaWxsLXJ1bGU6ZXZlbm9kZDtzdHJva2U6I0U4NDIzNTtzdHJva2Utd2lkdGg6MnB4O3N0cm9rZS1saW5lY2FwOmJ1dHQ7c3Ryb2tlLWxpbmVqb2luOm1pdGVyO3N0cm9rZS1vcGFjaXR5OjEnIC8+Cjx0ZXh0IGRvbWluYW50LWJhc2VsaW5lPSJjZW50cmFsIiB0ZXh0LWFuY2hvcj0iZW5kIiB4PScxMi42NTc1JyB5PSc0My42NzE2JyBzdHlsZT0nZm9udC1zaXplOjExcHg7Zm9udC1zdHlsZTpub3JtYWw7Zm9udC13ZWlnaHQ6bm9ybWFsO2ZpbGwtb3BhY2l0eToxO3N0cm9rZTpub25lO2ZvbnQtZmFtaWx5OnNhbnMtc2VyaWY7ZmlsbDojRTg0MjM1JyA+PHRzcGFuPk88L3RzcGFuPjwvdGV4dD4KPHRleHQgZG9taW5hbnQtYmFzZWxpbmU9ImNlbnRyYWwiIHRleHQtYW5jaG9yPSJtaWRkbGUiIHg9JzQyJyB5PSc0My42NzE2JyBzdHlsZT0nZm9udC1zaXplOjExcHg7Zm9udC1zdHlsZTpub3JtYWw7Zm9udC13ZWlnaHQ6bm9ybWFsO2ZpbGwtb3BhY2l0eToxO3N0cm9rZTpub25lO2ZvbnQtZmFtaWx5OnNhbnMtc2VyaWY7ZmlsbDojM0I0MTQzJyA+PHRzcGFuPkdlPC90c3Bhbj48L3RleHQ+Cjx0ZXh0IGRvbWluYW50LWJhc2VsaW5lPSJjZW50cmFsIiB0ZXh0LWFuY2hvcj0ic3RhcnQiIHg9JzcxLjM0MjUnIHk9JzQzLjY3MTYnIHN0eWxlPSdmb250LXNpemU6MTFweDtmb250LXN0eWxlOm5vcm1hbDtmb250LXdlaWdodDpub3JtYWw7ZmlsbC1vcGFjaXR5OjE7c3Ryb2tlOm5vbmU7Zm9udC1mYW1pbHk6c2Fucy1zZXJpZjtmaWxsOiNFODQyMzUnID48dHNwYW4+TzwvdHNwYW4+PC90ZXh0Pgo8L3N2Zz4K O=[Ge]=O YBMRDBCBODYGJE-UHFFFAOYSA-N 0.000 description 1
- 230000000903 blocking Effects 0.000 description 1
- 238000004364 calculation methods Methods 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 235000012489 doughnuts Nutrition 0.000 description 1
- 235000013399 edible fruits Nutrition 0.000 description 1
- 238000005516 engineering processes Methods 0.000 description 1
- 238000002474 experimental methods Methods 0.000 description 1
- 239000004744 fabrics Substances 0.000 description 1
- 230000004907 flux Effects 0.000 description 1
- 229910000448 germanium dioxide Inorganic materials 0.000 description 1
- 239000011521 glasses Substances 0.000 description 1
- 230000036039 immunity Effects 0.000 description 1
- 238000000691 measurement method Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000006011 modification reactions Methods 0.000 description 1
- 229920003023 plastics Polymers 0.000 description 1
- 239000004033 plastics Substances 0.000 description 1
- 230000000630 rising Effects 0.000 description 1
- 238000006467 substitution reactions Methods 0.000 description 1
- 230000001629 suppression Effects 0.000 description 1
Abstract
Description
Technical field
The present invention relates to motor speed observation and speed controlling field, more particularly, to a kind of magneto speed observation side Method.
Background technology
For permagnetic synchronous motor (PMSM) servosystem, the rotor-position of motor and rotating speed are closed loop control systems Requisite feedback quantity in system.In traditional location measurement method, position signalling is many to be obtained by optical encoder.Light Learn encoder and be generally divided into incremental encoder, absolute type encoder and hybrid encoder.Wherein, absolute type encoder energy Enough directly obtain the binary coding of rotor absolute position, each position has unique binary coding.Compile compared to other Code device, absolute type encoder has obvious advantage at aspects such as capacity of resisting disturbance, stationkeeping abilities, thus sets in high-accuracy mechanical The place such as standby has obtained many applications.
The reason such as non-ideal being made due to quantizing noise and optical encoder itself, by turning that optical encoder records There is measurement noise in sub- position, thus certain error be there is also by the calculated rotating speed of rotor position information.Additionally, passing The encoder of system tests the speed computational methods, such as:The speed-measuring methods such as measured frequency method, measuring period method, are all based on derivative algorithms solution and turn The meansigma methodss of speed, so cause rotating speed value of calculation to there is error and delay, thus have impact on permanent magnet synchronous electric to a certain extent The dynamic and static performance of machine servo system.In order to reduce the problem that traditional speed-measuring method exists, generally adopt wave digital lowpass filter To suppress noise, but conventional lowpass filter cannot realize the purpose suppressing noise and reducing time delay simultaneously.
In order to solve the shortcoming of traditional speed-measuring method, the method that scholars propose multiple observation rotating speeds, such as nonlinear riew Survey device, sliding mode observer etc..System, in the case of low cruise, is not each sampling period to calculate rotating speed, in order to true Protect within each sampling period rotating speed can real-time update, can be using adaptive speed observer, instantaneous velocity observer, complete Dimension or Reduced-Order State Observer are observed and carry out motor control to the rotating speed of magneto, rotor-position etc., but these Method depends on the accurate mathematical model of motor, and systematic function is vulnerable to Parameters variation and the impact of various uncertain factor, makes Obtain its application limited.Because the measurement noise of encoder can be counted as white Gaussian noise, Kalman (Kalman) filtering algorithm As the optimal effectiveness method of estimation in a kind of minimum variance meaning, it using recurrence method directly to random noise disturbance at Reason, and have less dependency to model, therefore, obtain relatively broad application in terms of system speed observation.However, by Need to carry out many experiments to noise parameter in traditional Kalman filter algorithm, just can have preferable observation effect, so, Work efficiency undoubtedly can be reduced, therefore, seek a kind of method solving or substitute this problem urgently important.
Content of the invention
The invention provides a kind of magneto speed observation procedure, present invention, avoiding the differential in traditional speed-measuring method Process and filtering, make up the measurement error of the absolute type encoder of finite accuracy, thus improve motor speed to control system The control accuracy of system and Immunity Performance, described below:
A kind of magneto speed observation procedure, the method comprising the steps of:
The rotor-position that absolute type encoder is obtained is combined with three parts of designed kalman observer, sees Measure rotor speed and the load torque values of motor, using the rotating speed observed as control system for permanent-magnet synchronous motor der Geschwindigkeitkreis Feedback signal;
The load torque that permagnetic synchronous motor is mutated regards system interference amount as, is seen using constructed kalman observer The electric motor load torque surveyed, as the feed-forward signal of electric current loop, builds feedforward control system;
Obtain the switching sequence of inverter by current controller and space vector width pulse modulation method, and then acquisition is passed through The three-phase voltage of permagnetic synchronous motor, finally makes magneto with certain rotational speed.
Three parts of described designed kalman observer are specially:
1) by coefficient square based on durface mounted permanent magnet synchronous motor mathematical model is obtained to the design of Kalman's observer Battle array;
2) part is observed according to Kalman's observer, devise the alternative manner of Kalman observer;
3) according to measurement noise self adaptation part, the computational methods of measurement noise are devised.
Described it is specially based on the coefficient matrix of durface mounted permanent magnet synchronous motor mathematical model:
In formula, J is rotary inertia;F is friction torque coefficient;KTFor motor torque coefficient;TsFor the sampling period.
Described part is observed according to Kalman's observer, the alternative manner devising Kalman observer is specially:
The alternative manner of Kalman observer is
In formula, and x (k | k) it is kth TsThe posterior estimate of moment state variable;P (k | k) it is kth TsMoment error covariance Posterior estimate;X (k | k-1) it is kth TsEstimated value is tested before the state variable in moment;P (k | k-1) it is respectively kth TsMoment Estimated value is tested before error covariance;I is unit matrix;K (k), err (k) are kth TsThe Kalman gain in moment and tested The residual error of signal.
Described according to measurement noise self adaptation part, the computational methods devising measurement noise are specially:
Wherein, k is kth time sampling, TsFor the sampling period, ω (k | k-1) test discreet value for before kth moment state variable, Δ is quantization error.
The beneficial effect of technical scheme that the present invention provides is:
(1) present invention be directed to speed error during magneto low cruise and filter delay problem it is proposed that a kind of from Adapt to Kalman's observer, compared to traditional speed-measuring method, adaptive Kalman observer proposed by the invention becomes in rotating speed In the case of change, can more accurately realize the identification of rotor-position, and realize the quick tracking of rotating speed.
(2) PMSM can be entered using the rotor-position and rotating speed of adaptive Kalman observer proposed by the present invention identification Row closed loop control well, and there is the less fluctuation of speed, reduce the fluctuation of q shaft current during startup simultaneously.
(3) adaptive Kalman observer can promptly and accurately identifying motor dynamic change when rotating speed so that system tool There is dynamic responding speed faster.
(4) the load change feelings of system can be reflected in time using the load torque that adaptive Kalman observer obtains Condition, the load torque estimated is carried out the feedforward, it is possible to increase the accurate ability of tracking of rotating speed.
Brief description
Fig. 1 is permagnetic synchronous motor Feedforward-feedback control block diagram;
Fig. 2 measures figure for rotor-position signal, and Fig. 2 (a) is signal measurement figure during motor low cruise;Fig. 2 (b) is electricity Signal measurement figure during machine high-speed cruising;
Fig. 3 is the flow chart of Kalman observer;
Fig. 4 is permagnetic synchronous motor Feedforward-feedback control simplified block diagram;
Fig. 5 is the experimental waveform under cycle overlay method, and Fig. 5 (a) calculates rotating speed n for cycle overlay method3And iqWaveform;Fig. 5 B () is enlarged drawing when starting;
Fig. 6 is the experimental waveform under Adaptive Kalman observer, and Fig. 6 (a) estimates rotating speed for KalmaniqWith's Waveform;Fig. 6 (b) is enlarged drawing when starting;
Fig. 7 is that the observer of the present invention adds experimental waveform under feedforward controller, and Fig. 7 (a) estimates rotating speed for Kalman iqWithWaveform;Fig. 7 (b) is enlarged drawing when starting.
Specific embodiment
For making the object, technical solutions and advantages of the present invention clearer, below embodiment of the present invention is made further Ground describes in detail.
A kind of magneto speed observation procedure, this method carries out rotating speed using the rotor-position that absolute type encoder records And load torque estimates, and controlled using rotating speed, current double closed-loop, outer shroud is der Geschwindigkeitkreis, feedback signal is to estimate rotating speed, adopts Ratio and integral controller, abbreviation PI controller, internal ring is electric current loop, and using PI controller, estimating load torque is feedforward letter Number, using feedforward controller;The motor speed measurement based on adaptive Kalman observer of present invention design is by three part groups Become, a part is Kalman's observer modeled segments, and a part is Kalman's observer observation part, another part is that measurement is made an uproar Sound self adaptation part, this three parts collective effect obtains speed feedback signal and the load torque feed-forward signal of system, the method Concrete operation step described below:
The present invention devises the permagnetic synchronous motor Feedforward-feedback control system based on Adaptive Kalman observer, such as Shown in Fig. 1.In figure, permagnetic synchronous motor adopts id=0 rotating speed, the vector control strategy of current double closed-loop, and using limited The absolute type encoder of precision is accurately observed to rotor-position, rotating speed and load torque with adaptive Kalman observer, And using the signal of observation as the feedback signal of der Geschwindigkeitkreis and load torque interference compensation signal.
To control from the analysis of absolute type encoder range rate error, the design of Adaptive Kalman observer, rotating speed PI below The design of link, the design of feedforward compensation link, current controller, space vector pulse width modulation, inverter and PMSM, experiment knot Fruit is analyzed eight aspects and is described further.
1st, absolute type encoder range rate error analysis
The code-disc of n position absolute type encoder is on the donut of circular glass or plastics, depicts n circle and uniformly divides The printing opacity of cloth and light tight alternate groove, the value of adjacent code channel is according to certain rule arrangement, any one radial position Only unique 2 scale codings correspond to therewith, and binary coding scope is 0~2n-1.N position absolute type encoder is corresponding Resolution is 1/2n, be equivalent to n position absolute type encoder and be melted into 2 by discrete for the circumference of 2 π radnIndividual differ as 2 pi/2snThe one of rad The position signalling of series.
Fig. 2 (a) and Fig. 2 (b) is respectively under low speed and high-speed case, continuous rotor-position signal, absolute type encoder The position signalling picking out and the position signalling being obtained through digital signal processor (DSP) sampling by absolute type encoder output Curve chart.For the ease of analysis it is assumed that rotating speed is the steady state value more than zero.
In figure, k is sampling number, k=1,2 ...;θ is rotor-position;θ (m) is the rotor-position of the m time reading of DSP, m =1,2 ...;For the derivative of rotor-position, i.e. rotational speed omega;TsSampling period for controller;T1_actualFor absolute encoding The double time interval picking out new rotor-position of device;T1For the double time interval reading new rotor-position of DSP.
As seen from Figure 2, when rotor-position variable quantity is equal to its quantization error Δ=2 pi/2nDuring rad, absolute type is compiled Code device can obtain the rotor-position of discretization in time, but only when next sampled signal arrives, new rotor-position is Can be read by DSP.This has resulted in exists between the position signalling that the position signalling that absolute type encoder picks out and DSP read Measurement error.When sampling instant just occur before encoder picks out new rotor-position at that moment when, measurement occurs Error is maximum, and its value is quantization error Δ=2 pi/2nrad;And work as sampling instant and just occur to pick out new turning in encoder During sub- position, measurement error is minimum, and its value is 0.
By Fig. 2 (a) as can be seen that when system low cruise, rotor-position signal change is slow, absolute type encoder is even Continuous time interval T picking out new rotor-position twice1_actualMore than sampling time Ts, i.e. the fixing sampling period, now DSP Double time interval T reading new rotor-position1More than Ts;By Fig. 2 (b) as can be seen that when system high-speed runs, turning Sub- position signalling change is rapid, T1_actual<Ts, now T1=Ts.
The rotor-position signal derivation that DSP is read, you can obtain tach signal.Traditional speed-measuring method such as Euler test the speed Method, variable period velocimetry and cycle overlap velocimetry all obtain rotating speed using the method that difference coefficient forward approximately to replace derivative.On State three kinds of algorithms and only after DSP continuously reads new rotor-position signal, just calculate rotating speed, be not within each sampling period All calculate rotating speed, therefore, the speed-measuring method based on above-mentioned algorithm unavoidably has larger speed error and delay of testing the speed.
2nd, the design of Adaptive Kalman observer
1) by coefficient square based on durface mounted permanent magnet synchronous motor mathematical model is obtained to the design of Kalman's observer Battle array;
Voltage equation under synchronous rotating frame (d-q) for the durface mounted permanent magnet synchronous motor is
Wherein, ω is the mechanical angular velocity of motor;D axle is rotor magnetic pole axis, q axle advanced 90 degree of spaces of d axle counterclockwise Electrical angle, this d-q coordinate system is spatially rotated therefore referred to as synchronously rotating reference frame with electromechanics angular velocity omega together with rotor System;ud、uq、id、iq、Ld、LqIt is respectively motor d, q shaft voltage, electric current and stator inductance, and Ld=Lq;P is number of pole-pairs;RsIt is fixed Sub- resistance;ψfFor rotor flux.
Motor movement equation is
In formula, J is rotary inertia;F is friction torque coefficient;KTFor motor torque coefficient;TLFor load torque, testing the speed One controlling tests the speed, and the cycle is interior it is believed that load torque is definite value, that is,
Wherein, this step is specially:Discretization is carried out to the equation of motion of permagnetic synchronous motor, following karr can be designed Graceful observer:
In formula, k represents sampling number;X=[θ ω TL]TFor state variable;U=[iq] it is control signal;Y=[θ] is It is observed signal;W is system noise, the impact that the system parameter error of representative is brought;R is measurement noise, including encoder Other noises in quantization error and measurement process and interference;θ is motor rotor position;ω is the mechanical angular velocity of motor; iqFor motor q shaft current;TLFor load torque, it is believed that load torque is definite value, that is, within a cycle of testing the speed of control of testing the speed The derivative of load torqueCoefficient matrix is
In formula, TsFor the sampling period.
It is generally acknowledged that w (k) and r (k) is stable white Gaussian noise, its meansigma methods is zero, and the variance matrix of noise meets
In formula, Q and R is diagonal matrix, due to being observed signal y=[θ] herein, therefore error r and observational variance R= [R (k)] is first order matrix.
2) part is observed according to Kalman's observer, devise the alternative manner of Kalman observer;
Wherein, the alternative manner of Kalman observer is
In formula, and x (k | k) it is kth TsThe posterior estimate of moment state variable;P (k | k) it is kth TsMoment error covariance Posterior estimate;X (k | k-1) it is kth TsEstimated value is tested before the state variable in moment;P (k | k-1) it is respectively kth TsMoment Estimated value is tested before error covariance;I is unit matrix;K (k), err (k) are kth TsThe Kalman gain in moment and tested The residual error of signal, its value can be updated by following formula:
Wherein, y (k | k-1) is kth TsThe measured signal estimated value in moment, can be seen that survey by above recurrence formula Amount noise variance R (k) impact Kalman gain K (k), and then the correction feelings to x (k | k) for the err (k) and x (k | k-1) can be affected Condition.
In traditional Kalman observer, system noise variance Q (k) and measurement noise variance R (k) are all gathered by examination Method, come to determine, needs multigroup repeatability to attempt.After system reaches and stablizes, gain matrix K (k) convergence of Kalman observer For definite value matrix, in each sampling instant, err (k) is identical to the correcting rate of x (k | k-1) for that is, traditional Kalman observer. In rotating speed mutation or load torque mutation, K (k) still keeps constant, and this results in traditional Kalman observer cannot be according to tool Body rotating speed is carrying out rational parameter regulation, and then cannot carry out optimal predictor to rotating speed.
3) according to measurement noise self adaptation part, the computational methods of measurement noise are devised;
At low speeds, DSP may not read new rotor-position in each sampling, now T1>Ts.In present sample In the cycle, when DSP does not export new rotor-position, there is relatively large measurement error in the position signalling that sampling obtains, that is, think The position signalling that this time sampling obtains is incredible, and being manually set measurement noise is Rw, RwFor one larger on the occasion of now blocking Gain K is less for Germania, approximates 0, from formula (5) first formula, the observed result x of Kalman (k | k) can be partial to x (k | k- 1), ignore measured value y (k), do not carry out estimating the correction of position using the rotor-position that DSP reads, but conduct is estimated Device carries out estimating of rotor-position and rotating speed.
In current sample period, when DSP has read new rotor-position, the measurement error of the position signalling now obtaining is relatively Little, its maximum is The rotating speed estimated for Kalman observer.Because measurement error is as random Variable, with TsUncorrelated, you can to think measurement error in 0~emaxIn the range of be equal-probability distribution, the distribution of measurement error is close Degree is inversely proportional to constant interval, then the excursion of measurement error e (t), anticipation error and distribution density are respectively
In formula, e (t) is measurement error value;E [e (t)] is expected error value;F (e, t) is measurement error distribution density.
Can be obtained by formula (7), in current sample period, when DSP reads new rotor-position, measurement noise RtFor
The discrete form of above formula is
Using the calculated R of formula (8)tWhen can reflect under different rotating speeds that DSP reads new rotor-position exactly, Measurement noise between the position signalling being obtained and actual rotor position, by this RtCalculated K can utilize err (k) X (k | k-1) is corrected, obtains accurate x (k | k), now Kalman observer as a state observer to state Variable is observed.
To sum up analysis understands, the Adaptive Kalman observer being constructed is carried out to state variable in each sampling instant Estimate, but only when DSP reads new rotor-position, just carry out the correction of state variable.Then Kalman observer is pre- Estimate the sampling period T that the cycle is fixations, the error correction period interval time T that read new rotor-position double with DSP1Phase Deng.
Measurement noise variance yields R (k) of Adaptive Kalman observer is
Wherein, θ (k) is kth TsThe rotor-position that moment digital signal processor obtains;Rt(k) and RwValue condition such as Under:When digital signal processor (DSP) obtains new rotor-position, the rotor-position recording is relatively accurate, and Kalman observes Device is corrected to predicted state amount using the rotor-position reading, and Kalman's observer enters to quantity of state as state observer Row observation, now the maximum of measurement error is The rotating speed estimated for Kalman observer, now Measurement noise is Rt(k):
Wherein, k is kth time sampling, TsFor the sampling period, ω (k | k-1) test discreet value for before kth moment state variable, Δ is quantization error.
If DSP does not obtain new rotor-position, the rotor position error recording is larger, and the rotor-position now obtaining is by mistake Difference is larger, and the position signalling that is, this time sampling obtains is insincere, and now measurement noise is set as a higher value Rw, now Kalman Gain K is less, approximates 0, iterative from state, and the observed result x of Kalman (k | k) can be partial to x (k | k-1), and Ignore measured value y (k), do not carry out estimating the correction of position using the rotor-position that DSP reads, but carry out as prediction device The estimating of rotor-position and rotating speed.The calculating process of Kalman observer is as shown in Figure 3.
3. the design of rotating speed PI controlling unit
Combined with three parts of designed kalman observer using the rotor-position that absolute type encoder obtains, can So that rotor speed and the load torque values of motor quick and precisely must be observed, using the rotating speed observed as permagnetic synchronous motor control The feedback signal of the der Geschwindigkeitkreis of system processed, can improve the dynamic and static state performance of system.
4. the design of feedforward compensation link
In traditional rotating speed, the double PI feedback control system of electric current, in the case of load changing, rotating speed PI controls motor Device cannot be realized following the tracks of the purpose of rotating speed and opposing load disturbance simultaneously.For the problems referred to above, the load torque that PMSM is mutated Regard system interference amount as, by the use of constructed kalman observer observation electric motor load torque as electric current loop feedforward letter Number, build feedforward control system.Fig. 4 is PMSM Feedforward-feedback control simplified block diagram.
In figure, Gw、GFIt is respectively rotating speed PI controller, feedforward controller transmission function;GIFor system internal ring transmission function, It is approximately the proportional component that proportionality coefficient is 1;GT、GMFor motor model parameter.From motor movement equation
From the figure 3, it may be seen that rotating speed with the transmission function of load torque is
In order to reduce the impact to system rotating speed for the load torque interference, G should be madeF=GT=1.Due to loading the feedforward Device is worked to PMSM system with rotating speed PI controller simultaneously, therefore, GFValue should choose near 1 it is ensured that feedforward control Under device processed and rotating speed PI controller dual function, rotating speed control effect reaches most preferably.By GFAnd the observation of Kalman observer is negative Set torque, as PMSM system feedforward compensation link, is combined with speed feedback link, constitutes PMSM Feedforward-feedback control system System.
5. current controller
Current controller adopts traditional PI controller, and wherein, the set-point of q shaft current controller is rotating speed PI controller The output valve of output valve and front deaf controller value preset, its value of feedback is the electromagnetic torque of motor;The giving of d shaft current controller Definite value is id=0, its value of feedback is motor d shaft current.
6. space vector pulse width modulation
Space vector pulse width modulation strategy (SVPWM) to be modulated using seven sections of traditional methods, the input voltage of SVPWM It is to be obtained after anti-PARK coordinate transform by the magnitude of voltage of d axle and q axle, wherein, d axle and q shaft voltage value are respectively corresponding electricity The output valve of stream controller, 6 groups of height pulses of its SVPWM output are the on off sequence of inverter.
7. inverter and PMSM
Pulse train using SVPWM output is controlled to the switch of inverter, obtains the three-phase voltage of PMSM, PMSM Rotor rotated with certain rotating speed under the driving of three-phase voltage.
8. interpretation
Fig. 5 and Fig. 6 is respectively using the cycle overlay method in traditional velocimetry and self adaptation proposed by the invention Kalman observer gained rotating speed carries out the experimental waveform of closed loop control;Fig. 7 is that the Adaptive Kalman that the present invention is designed is seen Survey the experimental waveform that device acquired results carry out Feedforward-feedback control.
T be can be seen that by Fig. 5 (b) and Fig. 6 (b)1Moment motor starts to start, iqRapid rising, the cycle, overlay method was in t2 , there is time delay after 7ms in moment ability measuring rotating speed;And when being controlled using this paper observer, it is possible to achieve the accurate control of motor System, and there is the less fluctuation of speed and response speed faster;From Fig. 6 and Fig. 7, when motor load is mutated, adaptive Answer Kalman observer can realize accurately estimating of load torque in about 200ms;And after adopting Feedforward-feedback control, bear When carrying mutation, the fluctuation of speed is less.
It will be appreciated by those skilled in the art that accompanying drawing is the schematic diagram of a preferred embodiment, the embodiments of the present invention Sequence number is for illustration only, does not represent the quality of embodiment.
The foregoing is only presently preferred embodiments of the present invention, not in order to limit the present invention, all spirit in the present invention and Within principle, any modification, equivalent substitution and improvement made etc., should be included within the scope of the present invention.
Claims (3)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410393609.XA CN104184382B (en) | 2014-08-11 | 2014-08-11 | Method for observing speed of permanent magnet motor |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410393609.XA CN104184382B (en) | 2014-08-11 | 2014-08-11 | Method for observing speed of permanent magnet motor |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104184382A CN104184382A (en) | 2014-12-03 |
CN104184382B true CN104184382B (en) | 2017-02-15 |
Family
ID=51965188
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410393609.XA CN104184382B (en) | 2014-08-11 | 2014-08-11 | Method for observing speed of permanent magnet motor |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104184382B (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110858758A (en) * | 2018-08-23 | 2020-03-03 | 深圳市优必选科技有限公司 | Motor speed estimation method and device, and motor control method and system |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104950806B (en) * | 2015-06-18 | 2017-07-28 | 南京航空航天大学 | A kind of Machine Tool Feeding System feed forward control method based on GMDH data mining algorithms |
CN105356823A (en) * | 2015-10-30 | 2016-02-24 | 中国兵器工业集团第二O二研究所 | Load torque observation and compensation method for servo system |
CN105915144B (en) * | 2016-05-16 | 2018-08-03 | 南京航空航天大学 | A kind of permanent magnet synchronous motor rotary speed tracing control method |
CN106533291A (en) * | 2016-08-31 | 2017-03-22 | 东菱技术有限公司 | Inertia identification and load torque observation-based speed loop response improvement method |
CN109061537B (en) * | 2018-08-23 | 2019-07-16 | 重庆大学 | Electric vehicle lithium ion battery sensor fault diagnosis method based on observer |
CN110345554A (en) * | 2019-05-17 | 2019-10-18 | 烟台锐控自动化控制工程有限公司 | Mist based on fluid heat transferring modeling calculates three-level net for thermal control system |
FR3097090A1 (en) * | 2019-06-04 | 2020-12-11 | Renault Sas | Method for estimating the electromagnetic torque of a synchronous electric machine |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101800505A (en) * | 2010-03-12 | 2010-08-11 | 北京航空航天大学 | Method for controlling rotary speed of magnetically suspended flywheel |
CN102176653A (en) * | 2011-01-19 | 2011-09-07 | 哈尔滨工业大学 | Method for observing rotary speed of induction motor of Kalman filter with index fading factor |
CN103684178A (en) * | 2013-12-17 | 2014-03-26 | 清华大学 | Rotating speed filtering device and filtering method of PMSM |
-
2014
- 2014-08-11 CN CN201410393609.XA patent/CN104184382B/en active IP Right Grant
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101800505A (en) * | 2010-03-12 | 2010-08-11 | 北京航空航天大学 | Method for controlling rotary speed of magnetically suspended flywheel |
CN102176653A (en) * | 2011-01-19 | 2011-09-07 | 哈尔滨工业大学 | Method for observing rotary speed of induction motor of Kalman filter with index fading factor |
CN103684178A (en) * | 2013-12-17 | 2014-03-26 | 清华大学 | Rotating speed filtering device and filtering method of PMSM |
Non-Patent Citations (1)
Title |
---|
基于扰动观测器和卡尔曼滤波器的永磁直线同步电机扰动抑制;杨俊友等;《组合机床与自动化加工技术》;20130630(第6期);第2节,第3节 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110858758A (en) * | 2018-08-23 | 2020-03-03 | 深圳市优必选科技有限公司 | Motor speed estimation method and device, and motor control method and system |
Also Published As
Publication number | Publication date |
---|---|
CN104184382A (en) | 2014-12-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Tsuji et al. | A sensorless vector control system for induction motors using q-axis flux with stator resistance identification | |
Kim et al. | High performance PMSM drives without rotational position sensors using reduced order observer | |
Feng et al. | Hybrid terminal sliding-mode observer design method for a permanent-magnet synchronous motor control system | |
EP2543133B1 (en) | Current sensor error compensation | |
CN103647490B (en) | A kind of sliding mode control strategy of magneto | |
Schauder | Adaptive speed identification for vector control of induction motors without rotational transducers | |
KR100790914B1 (en) | Active reduction of torque irregularities in rotating machines | |
EP1835613B1 (en) | System and method for motor speed estimation using hybrid model reference adaptive system | |
CN101964624B (en) | Sensorless control system of permanent magnet synchronous motor | |
CN103401501B (en) | A kind of PMSM servo system control method based on fuzzy active disturbance rejection | |
CN102497141B (en) | High torque starting method for high power alternating current (AC) servo driver | |
CN102811015B (en) | Alternating current induction motor control system based on self-immunity to interference control | |
CN105492869B (en) | Rotary encoder | |
CN103872962B (en) | A kind of online faults-tolerant control device of permagnetic synchronous motor velocity transducer | |
CN103124158B (en) | Based on the automatic setting method of the permagnetic synchronous motor speed ring controling parameters of fractional order | |
KR102099075B1 (en) | System and method for error correction in angular position sensors | |
JP2014204668A (en) | Sensor-less vector control apparatus for induction motor | |
Ben-Brahim et al. | Speed control of induction motor without rotational transducers | |
CN105429540B (en) | A kind of AC servo motor vibration suppressing method based on Model following control | |
Kweon et al. | High-performance speed control of electric machine using low-precision shaft encoder | |
CN103414423A (en) | Surface-mounted permanent magnet synchronous motor sensorless direct torque control method | |
CN102035456B (en) | Direct torque control system of permanent magnet synchronous motor based on terminal sliding mode | |
CN103312244B (en) | Based on the brshless DC motor Direct Torque Control of segmented sliding moding structure | |
CN101873096B (en) | Method for determining the position of the flux vector of a motor | |
CN105119549A (en) | Motor stator resistor recognition 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 |