Академический Документы
Профессиональный Документы
Культура Документы
Fig. 1.
The Kalman filter generates the estimated values of the where the quantity Ts represents the sampling period, and
stator linkage flux, actual angular velocity of the rotor and Ad is the matrix of the discrete linearised system,
position of the stator flux phasor, using the measured values
of the currents and voltages from the motor terminals. expressed by:
Ad = I n + T s A . (9)
II. THE KALMAN FILTER In these relationships, the (n × m) matrix K represents the
In principle, the Kalman filter is a state observer that Kalman gain, P represents the covariance state matrix and
establishes the best approximation by minimization of the I n is the (n × n) unit matrix. In the recurrent computation
square error for the state variables of a system, subjected at relationships, the subscript index notations of type k k − 1
both its input and output to random disturbances. If the
show that the respective quantities (state vectors or their
dynamic system of which the state is being observed is non-
linear, then the Kalman filter is called an extended one covariance matrices) are computed for sample k , using the
(EKF).The development of the Kalman filter is closely values of similar quantities from the previous sample.
linked to the stochastic systems. The linear stochastic For non-linear stochastic systems, the dynamic state model
systems are described by relations: is described by the following expressions:
x! (t ) = A x (t ) + B u(t ) + w (t ), x (t 0 ) = x 0 , (1) x! (t ) = f ( x (t ), u(t ), t ) + w (t ) , (10)
y (t ) = C x (t ) , (2) y (t ) = h ( x (t ), t ) , (11)
z (t ) = y (t ) + v (t ) , (3) z (t ) = h ( x (t ), t ) + v (t ) , (12)
where x , y , u , A , B , C have the significance known where f and h are (n × 1) and (m × 1) function vectors,
from deterministic systems [1, 2]. In these expressions, respectively. Matrices A and C of the EKF structure,
w (t ) represents the vector of disturbances applied at the dependent now upon the state of the system, are determined
by using relationships:
system input, while z (t ) is the vector of the measurable
outputs, affected by the random noise v (t ) . It can be ∂ f ( x (t ), u(t ), t )
A( xˆ (t ), t ) = , (13)
considered that vector w (t ) includes, besides the input ∂ x T (t ) x (t )= xˆ (t )
disturbances, some uncertainties referring to the process
model. It will be assumed that the vector functions w (t ) ∂ h( x (t ), t )
C ( xˆ (t ), t ) = . (14)
and v (t ) are not correlated and zero-mean stochastic ∂ x T (t ) x (t )= xˆ (t )
processes. Additionally to the fact that matrices A and C have now
From the statistic point of view, the stochastic processes
became dependent on the state of the system, the algorithm
w (t ) and v (t ) are characterized by the covariance matrices suffers some further changes, which affect relationships (5)
Q and R respectively. and (7), now expressed as:
It is further assumed that the initial state x 0 is a vector of xˆ k k = xˆ k k −1 + K k [ y k − h ( xˆ k k −1 )] , (15)
random variables, of mean x 0 and covariance P0 , not
correlated with the stochastic processes w (t ) and v (t ) over xˆ k +1 k = xk k + Ts f ( xˆ k k , uk ) . (16)
the entire interval of estimation. The Kalman filter algorithm is initiated by adopting
The covariance matrices Q , R and P0 that characterize adequate values for the covariance matrix of the initial
the noise sources of system (1)–(3) are, by definition, state P0 = P0 −1 , as well as for the weighting matrices Q
symmetrical and positively semi-definite, of dimensions
and R , the latter two being constant during the estimation.
(n × n) , (m × m) and (n × n) respectively, where n and m
represent the number of state and output variables, III. MACHINE MODEL FOR EKF DEVELOPMENT
respectively.
For linear time invariant systems, the following relations of The studied SPMSM is assumed to have a symmetrical
recurrent computation describe the general form of the three-phase, Y-connected, isolated neutral point stator
implementation algorithm of Kalman filters: winding. The on-line implementation computations of the
EKF algorithm are carried out based on an dynamic model
K k = Pk k −1C
T
(C Pk k −1C
T
+ R) −1 ,(4) of the SPMSM expressed in the stationary reference frame,
xˆ k = xˆ k + K k ( y k − C xˆ k α − β , attached to the stator.
k k −1 k −1 ) , (5)
The state variables of the model deterministic part are
Pk k = ( I n − K k C ) Pk k −1 , (6) included in vector:
m e = 3 p (Ψ
ˆ i −Ψ
α β
ˆ i ), Ψ = Ψ
β α s
ˆ 2 +Ψ
α
ˆ2 .
β
B. Angular Velocity Controller 2
The angular velocity controller has an important influence The model of the simulated machine considers the load
on the entire control system performance, both during torque and the viscous friction torque: ml N = 1 Nm,
transient and steady state regimes. Good performance could
be achieved using an I type control law for the angular DN =0.002 Nms/rad. The rated data related to the motor
∗
velocity reference quantity ω , and a PI control law for the employed for simulation were: p =2, Rs N = 0.98 Ω ,
angular velocity feedback ω respectively. The I+PI
LsN =18. mH, Ψ eN =0.174 Wb; J N =0.006 Kg m2. The
controller will operate with both these laws. The main
advantage of an I+PI controller is the achievement of good synchronous machine is fed from a PWM converter of 12
transient performance. At the same time, due to the unitary kHz frequency. The sampling periods are of 2 ms for the
discrete pole, a null stationary error with respect to the angular velocity controller and of 0.1 ms for the stator flux
perturbation of the load torque (including the friction torque and electromagnetic torque control loops and also for the
of the machine) is achieved. Kalman filter. It is assumed that the reference quantity for
the angular velocity has a trapezoidal waveform, specific
for servo-drives with incremental motion. As previously
shown, in order to optimize the dynamic behavior of the
Kalman filter, it is required to adopt adequate values for the
elements of the square matrices P0 , Q and R . In the paper
the following values were adopted: P0 = 0.01 I 4 , Q =
Fig. 3.
0.00002 I 4 and R =0.9 I 2 . In order to highlight the
The block diagram of this controller, using z-transfer performances of the Kalman filter control system, at first
functions, is presented in Fig.3. It can be noticed that the the behavior of the direct torque digital control system in
integration uses the trapeze method. absence of a Kalman filter is presented.
The controller algorithm, obtained by applying the inverse
Z transform, is described by recurrent equations:
a) b)
Fig. 4
a) b)
Fig.5
Fig. 4 presents the waveforms of the mechanical quantities mismatch of the inertia, damping factor and load torque
(rotor angular velocity, electromagnetic torque), of the related to the rated values: J = 0.7 J N , D = 0.5 D N ,
amplitudes of the reference and real stator linkage flux and ml = 0.5 ml N (Fig. 7) and J = 1.4 J N (Fig. 8). In these
of the a stator phase linkage flux Ψsa = Ψα , obtained by a
DTFC system without EKF, for precise tuning of the figures, Δω = ω − ωˆ , Δθ = θ − θˆ are the estimation errors of
velocity controller. The same quantities, obtained for the the angular velocity and position, respectivelly. The scales
control system with an EKF are presented in fig. 5. used in all figures presented above and below are the
A comparison of figures 4 and 5 shows insignificant follwing: t − 66 ms/div , ω ∗ , ω, ω
ˆ − 32 rads −1 /div ,
modifications in the behavior of the dynamic control
system. The wave forms from Fig. 6 have been obtained for Δω − 2 rads −1 / div , Δθ = 10 " / div , m e − 4 Nm/div ,
a mismatch of the model electrical parameters values ˆ , Ψ ,Ψ
Ψs∗ , Ψs , Ψ ˆ − 0.16 Wb/div ,
s sa sa
( R s = 1.7 R s N , Ls = 0.7 L s N , Ψ e = 0.8 Ψ eN ) related to the
rated values used for tuning of the speed controller and for
EKF. Figures 7 and 8 was obtained for a simultaneous
a) b)
Fig.6
a) b)
Fig.7
a) b)
Fig.8
[4] Moerschell I., Tursini M., A New Vector Control Scheme for
Inverter-fed Permanent Magnet Synchronous Motor Using DSP,
VI. CONCLUSION Proceedings of 4th European Conference on Power Electronics and
The paper develops a mechanical sensorless digital control Applications, Firenze (Italy) 1991, Vol. 4, pp. 683-688.
system of the rotor angular velocity for an PMSM . The [5] Beierke, S.; Vas, P.; Simor, B.; Stronach, A. F., DSP-Controlled
Sensorless AC Vector Drives Using Extended Kalman Filter,
estimation of the mechanical states quantities of the drive Proceedings of the International Conference on Power Conversion
system is made using an extended Kalman filter. The paper and Intelligent Motion, PCIM‘97, Nuremberg (Germany), June 1997,
studies the interaction between the observer and closed loop pp. 31-41.
[6] Kettle, P., Murray, A., Moynihan, F., Sensorless Control of a
control system. The simulations show that the dynamic
Brushless DC Motor Using an Extended Kalman Estimator. .
behavior of the Kalman filter-based control system is good Proceedings of the International Conference on Power Electronics
even if the electric and mechanic parameters of the machine and Motion Control PCIM ‘98, Nuremberg (Germany), May 1998,
are different from the nominal values used for the design of pp.385-392
[7] Liu, S.; Stiebler, M., State Estimation of PWM Inverter’s Fed
the controllers and the Kalman filter and also for an
Synchronous Motor by Using Stochastic Filtering Techniques.,
incorrect initialization of the estimated position. Proceedings of the International Conference on Electrical Machines
ICEM’90, Cambridge-Massachusetts (USA), 1990,1206-1211.
VII. REFERENCES [8] Comnac, V.; Moldoveanu, F.; Cernat, M.; ,Draghici, I.; Cernat, R.
M.: Sensorless Control of Interior Permanent Magnet Synchronous
[1] Vas, P., Sensorless Vector and Direct Torque Control, Oxford Machine Using Stochastic Filtering Techniques. Proceedings of the
University Press (UK), 1998. 7th International Conference on Optimization of Electrical and
[2] Comnac, V., Contributions to the Study of Incremental Motion Electronic Equipment OPTIM 2000, Brasov Romania, 11 – 12 May
Drive Systems with Permanent Magnet Synchronous Machines, PhD 2000, pp. 619-624.
thesis, (In Romanian), Transilvania University of Brasov (Romania), [9] Dhaouadi, R., Mohan, N., Application of Stochastic Filtering to a
1998. Permanent Magnet Synchronous Motor Drive System without
[3] Comnac, V., Cernat, M., Moldoveanu, F., Draghici, I., Cernat, R. Electro-Mechanical Sensors. Proceedings of International
M., Variable Structure Control of Surface Permanent Magnet Conference on Electrical Machines ICEM’90, Cambridge-
Synchronous Machines (SPMSM), Proceedings of the International Massachusetts (USA), 1990, pp.1225-1230
Conference on Power Conversion and Intelligent Motion, PCIM‘99,
Nuremberg (Germany), June 1999, pp. 351-356.