Motor parameter estimation method based on adaptive extended Kalman filtering

文档序号:1158872 发布日期:2020-09-15 浏览:12次 中文

阅读说明:本技术 一种基于自适应扩展卡尔曼滤波的电机参数估计方法 (Motor parameter estimation method based on adaptive extended Kalman filtering ) 是由 丁洁 曹正鑫 林金星 于 2020-06-23 设计创作,主要内容包括:本发明公开了一种自适应扩展卡尔曼滤波的电机参数估计方法,包括:将在αβ静止参考坐标系下的电流方程作为电机的连续状态空间表达式描述电机的内部动态特性;离散化状态空间方程同时将所需辨识参数增广到系统状态中;仿真电机采用双闭环控制方式,通过从电流检测单元和电压检测单元获得相电流、相电压;用当前时刻状态估计值代替系统真实值,并考虑满足白噪声时刻无关的性质,估计出当前时刻的系统噪声协方差矩阵;对噪声协方差估计值进行加权,得到当前时刻估计的噪声协方差矩阵;通过获得的相电流、相电压,利用已计算得到噪声协方差矩阵的扩展卡尔曼滤波算法估计反电动势同时辨识电机参数。该方法可提升电机参数估计的精度。(The invention discloses a motor parameter estimation method of adaptive extended Kalman filtering, which comprises the following steps: taking a current equation under an alpha beta static reference coordinate system as a continuous state space expression of the motor to describe the internal dynamic characteristics of the motor; the discretization state space equation simultaneously expands the needed identification parameters into the system state; the simulation motor adopts a double closed-loop control mode, and phase current and phase voltage are obtained from a current detection unit and a voltage detection unit; replacing a system true value with a current time state estimation value, and estimating a system noise covariance matrix at the current time by considering the property of meeting the white noise moment independence; weighting the noise covariance estimated value to obtain a noise covariance matrix estimated at the current moment; and estimating the back electromotive force and identifying the motor parameters by utilizing an extended Kalman filtering algorithm of the noise covariance matrix obtained by calculation through the obtained phase current and phase voltage. The method can improve the precision of motor parameter estimation.)

1. A motor parameter estimation method based on adaptive extended Kalman filtering is characterized in that:

the method comprises the following steps:

(1) taking a current equation under an alpha beta static reference coordinate system as a continuous state space expression of the motor to describe the internal dynamic characteristics of the motor;

(2) the discretization state space equation simultaneously expands the needed identification parameters into the system state;

(3) the simulation motor adopts a double closed-loop control mode, and phase current and phase voltage are obtained from a current detection unit and a voltage detection unit;

(4) replacing a system true value with a current time state estimation value, and estimating a system noise covariance matrix at the current time by considering the property of meeting the white noise moment independence; weighting the noise covariance estimated value to obtain a noise covariance matrix estimated at the current moment;

(5) and estimating the back electromotive force and identifying the motor parameters by utilizing an extended Kalman filtering algorithm of the noise covariance matrix obtained by calculation through the obtained phase current and phase voltage.

2. The motor parameter estimation method based on adaptive extended kalman filter according to claim 1, characterized in that: the current equation under the alpha beta static reference frame in the step (1) is as follows:

wherein iα,iβIs the stator current, eα,eβIs the back-emf of the winding, uα,uβIs the stator voltage in the αβ coordinate system;

r is stator resistance, L is stator inductance, which is equal to the difference between self inductance and mutual inductance of the winding,

the state space expression is expressed as:

wherein x0=[iα,iβ,eα,eβ]TIs the system state vector, z ═ iα,iβ]TFor system output, u ═ uα,uβ]TIs the input of the system, and the system is,

3. the motor parameter estimation method based on adaptive extended kalman filter according to claim 2, characterized in that:

and (3) expanding L and R into a system state vector to obtain the following six-order model:

Figure FDA0002551725030000022

wherein x ═ x0 T,L,R]TAnd

Figure FDA0002551725030000023

obtaining a discrete time model by using a first-order Euler discretization method, and using T as the discrete time modelsIn order to be the sampling period of time,

Ak=(I+TsA),Bk=TsB,Hk=TsH

since the upper and R are unknown, Akxk+BkukIs a non-linear function of fk(xk,uk) The non-linear function is represented by a linear function,

xk=fk-1(xk-1,uk-1)+wk-1

Zk=Hkxk+vk

Figure FDA0002551725030000024

wherein wkAnd vkSystem noise and measurement noise.

4. The motor parameter estimation method based on adaptive extended kalman filter according to claim 1, characterized in that: and (3) in a double closed loop control mode, the difference between the given value of the motor rotating speed and the actual rotating speed value calculated by the Hall signal is input as an input speed controller, the difference between the output of the speed controller and the current feedback quantity acquired by the current detection unit is input of the current controller, a PWM control signal generator judges the current motor rotor position according to the Hall sensor, and then the PWM control signal generator is connected to a power tube to be opened to finish the speed regulation of the motor, and meanwhile, phase current and phase voltage are obtained from the current detection unit and the voltage detection unit.

5. The motor parameter estimation method based on the adaptive extended kalman filter according to claim 1 or 2, wherein the specific process of the step (4) is as follows:

to estimate the noise covariance matrix Qk-1X is to bekBy using

Figure FDA0002551725030000025

further, it is possible to obtain:

at the same time, it is desirable to estimate process noise

Figure FDA0002551725030000032

finally, obtaining an estimation formula of the noise covariance:

to avoid certain system states, the corresponding coefficients in H are all 0, so thatCorresponding to the case where the value is 0,

Figure FDA0002551725030000036

where λ is a constant of (0, 1).

6. The motor parameter estimation method based on adaptive extended kalman filter according to claim 1, characterized in that: the estimation process is as follows:

Kk=Pk/k-1Hk T(HkPk/k-1Hk T+Rk)-1(3)

Figure FDA0002551725030000039

Figure FDA00025517250300000310

will obtain

Figure FDA00025517250300000311

Pk=(I-KkHk)Pk/k-1

Technical Field

The invention relates to a motor parameter estimation method, in particular to a motor parameter estimation method based on adaptive extended Kalman filtering.

Background

Brushless dc motor is widely used in various industrial equipments with its advantages such as long service life, simple control, reliable operation, etc., like: an industrial robot. At present, a plurality of controllers for controlling the brushless direct current motor are provided, such as various types of single chip microcomputers, DSPs, FPGAs and the like, and the controllers mostly adopt PWM and PID control modes. The inductance and resistance parameters are not only the precondition for realizing the precise control of the motor, but also the important basis for realizing the control algorithm of the frequency converter, analyzing the performance of the motor and optimizing the design, so in order to ensure the control precision and improve the performance of the motor, the motor parameters need to be identified in the actual engineering.

Brushless direct current motor (BLDCM) with its advantage such as long-lived, control is simple, operation are reliable, the wide application is in industrial equipment such as industrial robot, digit control machine tool. At present, the hot spots of the brushless dc motor are mainly the design and control thereof, including the design of the brushless motor body, torque ripple, sensorless control, torque control, and the like. The key of most realizing sensorless control and torque control is to obtain accurate and real-time back electromotive force of the motor, generally, the back electromotive force of the motor is considered to be ideal trapezoidal wave, but the control precision is low; or calculating the back emf value in the control scheme by table look-up, however, this adds an operational step.

When the motor back emf is taken as the state variable, the estimation can be done with a state observer or filter. The problem is that the state estimation method relies on accurate motor parameters. For a brushless direct current motor, the current change is large in the commutation process, and the deviation of inductance and resistance parameters has great influence on back electromotive force estimation. Therefore, in order to ensure the control precision and improve the motor performance, it is necessary to identify the motor parameters in engineering practice. The parameter identification method mainly comprises a least square method, sliding mode identification, a model reference self-adaption method, an artificial neural network, a Kalman filter and the like. Kalman filtering is an effective filtering method for multidimensional states and non-stationary processes, with high accuracy even in the presence of noisy disturbances. Due to the non-linearity, it is one of the most common methods in motor parameter identification. The extended Kalman filtering algorithm is simple to calculate and easy to track. However, since only the first order term of the Taylor expansion is retained, the result obtained by the algorithm may have errors, and the stronger the nonlinearity degree of the system, the larger the error of the predicted result is. Unknown noise or poor estimation accuracy may affect the accuracy control of the motor.

Disclosure of Invention

The invention aims to provide a motor parameter estimation method based on adaptive extended Kalman filtering, which has high accuracy and does not generate larger deviation and divergence during filtering.

The invention discloses a motor parameter estimation method based on adaptive extended Kalman filtering, which comprises the following steps:

(1) taking a current equation under an alpha beta static reference coordinate system as a continuous state space expression of the motor to describe the internal dynamic characteristics of the motor;

(2) the discretization state space equation simultaneously expands the needed identification parameters into the system state;

(3) the simulation motor adopts a double closed-loop control mode, and phase current and phase voltage are obtained from a current detection unit and a voltage detection unit;

(4) replacing a system true value with a current time state estimation value, and estimating a system noise covariance matrix at the current time by considering the property of meeting the white noise moment independence; weighting the noise covariance estimated value to obtain a noise covariance matrix estimated at the current moment;

(5) and estimating the back electromotive force and identifying the motor parameters by utilizing an extended Kalman filtering algorithm of the noise covariance matrix obtained by calculation through the obtained phase current and phase voltage.

Further, the current equation in the α β stationary reference frame in step (1) is as follows:

wherein iα,iβIs the stator current, eα,eβIs the back-emf of the winding, uα,uβIs the stator voltage in the αβ coordinate system;

r is stator resistance, L is stator inductance, which is equal to the difference between self inductance and mutual inductance of the winding,

the state space expression is expressed as:

Figure BDA0002551725040000023

wherein x0=[iα,iα,eα,eβ]TIs the system state vector, z ═ iα,iβ]TFor system output, u ═ uα,uβ]TIs input to the system, and

Figure BDA0002551725040000025

further, L and R are augmented into the system state vector, resulting in the following sixth order model:

Figure BDA0002551725040000027

wherein x ═ x0 T,L,R]TAnd

obtaining a discrete time model by using a first-order Euler discretization method, and using T as the discrete time modelsIn order to be the sampling period of time,

Ak=(I+TsA),Bk=TsB,Hk=TsH

since L and R are unknown, Akxk+BkukIs a non-linear function of fk(xk,uk) The non-linear function is represented by a linear function,

xk=fk-1(xk-1,uk-1)+wk-1

Zk=Hkxk+vk

Figure BDA0002551725040000032

wherein wkAnd vkSystem noise and measurement noise.

Further, the simulation motor in the step (3) is controlled by adopting a two-by-two 120-degree conduction mode, in a double closed loop control mode, the difference between the given value of the motor rotating speed and the actual rotating speed value calculated by the Hall signal is input into the speed controller, the difference between the output of the speed controller and the current feedback quantity acquired by the current detection unit is input into the current controller, the PWM control signal generator judges the current motor rotor position according to the Hall sensor, and then the PWM control signal generator is connected to a power tube to be opened to finish the speed regulation of the motor, and meanwhile, the phase current and the phase voltage are obtained from the current detection unit and the voltage detection unit.

Further, the specific process of the step (4) is as follows:

to estimate the noise covariance matrix Qk-1X is to bekBy usingInstead, one can obtain:

further, it is possible to obtain:

at the same time, it is desirable to estimate process noiseThe different moments are independent, namely:

finally, obtaining an estimation formula of the noise covariance:

Figure BDA0002551725040000041

to avoid certain system states, the corresponding coefficients in H are all 0, so thatCorresponding to the case where the value is 0,

where λ is a constant of (0, 1).

Further, the estimation process is as follows:

Figure BDA0002551725040000044

Kk=Pk/k-1Hk T(HkPk/k-1Hk T+Rk)-1(3)

will obtain

Figure BDA0002551725040000048

Replace the original

Figure BDA0002551725040000049

Back to the formulas (2) - (4)

Pk=(I-KkHk)Pk/k-1

Has the advantages that: the method fully utilizes the input and output data of the motor model, improves the precision of parameter estimation, is simple and easy to realize, has small filtering deviation and is not easy to disperse.

Drawings

Fig. 1 is a block flow diagram illustrating a method for estimating parameters of a brushless dc motor based on adaptive extended kalman filter according to an embodiment of the present invention;

FIG. 2 is a control frame diagram of a brushless DC motor in simulation according to the present invention;

FIG. 3 shows the EKF and AEKF vs. the motor status e in the simulation of the present inventionαA comparison graph of the estimated values;

FIG. 4 is a graph of estimated values and errors of EKF and AEKF on motor parameters L in simulation of the present invention;

FIG. 5 is a graph of estimated values and errors of EKF and AEKF on motor parameters R in simulation of the present invention.

Detailed Description

The parameter estimation method of the brushless direct current motor based on the adaptive extended kalman filter is provided by the embodiment.

Referring to fig. 1, the method specifically includes the following steps:

1. and describing the internal dynamic characteristics of the motor by using a current equation under an alpha beta static reference frame as a continuous state space expression of the motor.

2. The discretization state space equation simultaneously expands the needed identification parameters into the system state; firstly, taking motor parameters L and R as motor states to be expanded to the original motor states to obtain a six-order model:wherein x ═ x0 T,L,R]TAnd

Figure BDA0002551725040000052

H=[H0,02×2](ii) a Secondly, a discrete time model is obtained by utilizing first-order Euler discretization and is represented by TsIs a sampling period: a. thek=(I+TsA),Bk=TsB,Hk=TsH. Since L and R are unknown, Akxk+BkukIs a non-linear function. By fk(xk,uk) Represents a non-linear function: x is the number ofk=fk-1(xk-1,uk-1)+wk-1,zk=Hkxk+vk

Wherein wkAnd vkSystem noise and measurement noise.

3. The experimental motor of the permanent magnet synchronous direct current motor in the simulation system is a surface-mounted permanent magnet brushless direct current motor, the two-two 120-degree conduction mode control is adopted, a double-closed-loop control mode is used, and as shown in fig. 2, the difference between the given value of the motor rotating speed and the actual rotating speed value calculated by the Hall signal is used as the input of an input speed controller. The difference between the output of the speed controller and the current feedback quantity acquired by the current detection unit is the input of the current controller. And the PWM control signal generator can interpret the current position of the motor rotor according to the Hall sensor and then is connected to a power tube to be opened so as to finish the speed regulation of the motor. Meanwhile, the phase current and the phase voltage are obtained by obtaining them from the current detection unit and the voltage detection unit.

4. Known from the traditional extended kalman filter algorithm:

to estimate Qk-1X is to bekBy using

Figure BDA0002551725040000055

Instead, one can obtain:

further, it is possible to obtain:

Figure BDA0002551725040000057

at the same time, it is desirable to estimate process noise

Figure BDA0002551725040000058

The different moments are independent, namely:

Figure BDA0002551725040000059

is equivalent to: (I-K)kHk)Fk-1Pk-1Fk-1 T(Hk TKk T-I)+(I-KkHk)Qk-1Hk TKk T-KkRkKk TAvailable as 0:use ofIn place of Qk-1The modified noise covariance may be modified to

Figure BDA0002551725040000063

To avoid certain system states, the corresponding coefficients in H are all 0, so that

Figure BDA0002551725040000064

Case where the corresponding value is 0:wherein λ is a constant of (0, 1)

5. Setting the sampling period Ts=2×10-6λ is 0.7, and each initial value is x0=[0,0,0,0,0.01,0.5]T,P0=diag[1,1,1,1,1,1]T,Q0Biag (0.01, 0.01, 10, 10, 0, 0) R ═ diag (1000 ). And respectively using an extended Kalman filtering algorithm and a self-adaptive extended Kalman filtering algorithm to estimate the back electromotive force of the motor and simultaneously identify motor parameters through the obtained phase current and phase voltage. As can be seen from fig. 3, the error of the back electromotive force estimated by the two algorithms is gradually reduced, but the initial error estimated by the extended kalman filter algorithm is relatively large, and the error estimated by the adaptive extended kalman filter algorithm is slightly smaller than that of the former; as can be seen from fig. 4, the errors of the motor parameters L estimated by the two algorithms are both small, and the convergence speed is high, but the error estimated by the adaptive extended kalman filter algorithm is smaller; as can be seen from FIG. 5, the R precision estimated by using the adaptive extended Kalman filtering algorithm is greatly improved compared with the traditional extended Kalman filtering method, and the convergence rate is higher. Compared with the prior art, the method has better accuracy in estimating the parameters of the brushless direct current motor, thereby improving the accuracy of the estimation of the back electromotive force of the motor and improving the control accuracy of the motor.

12页详细技术资料下载
上一篇:一种医用注射器针头装配设备
下一篇:一种永磁电机的失磁检测方法、系统及相关组件

网友询问留言

已有0条留言

还没有人留言评论。精彩留言会获得点赞!

精彩留言,会给你点赞!