Full-speed-domain position-sensorless control method of permanent magnet linear motor for emission
By adopting linear secondary regulator and Kalman filtering adaptive position-free sensor control method in motor control, the problems of high cost and poor reliability of mechanical sensors are solved, and closed-loop control of position-free sensors in the motor full-speed domain is realized, improving Observation accuracy and anti-interference ability.
Patent Information
- Application Number
- CN202410859752.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-06-28
- Publication Date
- 2024-11-12
- Estimated Expiration
- 2044-06-28
AI Technical Summary
In the prior art, mechanical position sensors increase system design costs and have poor reliability under complex operating conditions. Traditional positionless control algorithms are complex and robust, making it difficult to achieve closed-loop control of positionless sensors in the motor full-speed domain.
Adaptive positionless sensor control method based on linear secondary regulator and Kalman filtering is adopted. The I/F open loop is controlled in the low speed domain, the adaptive LQR-KF observer is controlled in the medium and high speed domain, and the position open loop is controlled in the manufacturing process. In the dynamic stage, the motor full-speed field has no position sensor closed-loop control.
The motor full-speed domain position sensorless control model is simplified, the position observation accuracy and anti-interference ability are improved, and the reliable, stable operation and rapid braking of the electromagnetic transmitter motor are achieved.
Smart Images

Figure CN118944510A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of motor control, and in particular to a full-speed range position sensorless control method for a permanent magnet linear motor for launch. Background Art
[0002] Electromagnetic launch technology has significant advantages such as high launch kinetic energy, high launch frequency, and fast start-up time, and has broad application prospects in both military and civilian fields. Considering factors such as efficiency, power density, and thrust pulsation, electromagnetic launch systems generally use permanent magnet synchronous linear motors as core actuators. Since linear motors may collide with both ends during linear reciprocating motion, mechanical position sensors are mostly used in engineering to obtain the position signal of the launch motor rotor for closed-loop control. However, mechanical position sensors not only increase the system design cost, but also the complex application conditions of high acceleration and strong vibration shock of electromagnetic launch motors will reduce the accuracy of the sensor, thereby reducing the reliability of the system. Therefore, it is of great engineering value to design a reliable and high-precision position sensorless control method to achieve full-speed positionless closed-loop control of the launch motor.
[0003] At present, the motor position sensorless technology is generally divided into two categories: zero low-speed domain position sensorless control technology and medium- and high-speed domain position sensorless control technology. Among them, the high-frequency signal injection method can not only realize the initial position identification of the mover, but also show excellent mover position observation performance in the low-speed range. Therefore, this method is widely used in the motor zero low-speed position sensorless control. Under the premise of knowing the initial position, the motor can be started and operated at low speed directly through open-loop control. The main methods are: voltage-frequency ratio V / F control and flow-frequency ratio I / F control. The open-loop control strategy is simple in principle and low in cost, and can be applied to motor systems with low requirements for starting performance. For medium- and high-speed domain position sensorless control, position control technology based on closed-loop observation algorithm has received more attention, such as model reference adaptive system (MRAS), sliding mode observer (SMO), extended Kalman filter (EKF), etc.
[0004] For the research on the full-speed sensorless control method of the motor, the full-range position observation of the motor from starting to braking can be realized through the composite control algorithm. The composite control algorithm can ensure the stable operation of the full-speed sensorless control of the motor, but the additional switching control increases the complexity of the system while ensuring the smooth switching of the algorithm. In order to simplify the full-speed sensorless control model of the motor and reduce the problem of observed position oscillation caused by frequent switching of different control algorithms, some scholars have carried out research on a unified control model to realize the position observation of the motor from low speed to medium and high speed, but this simplified model is still in the theoretical exploration stage and lacks engineering application experience. Summary of the invention
[0005] The purpose of the present invention is to overcome the shortcomings of the prior art. In view of the problems that mechanical sensors bring additional costs to the system and have poor reliability under complex working conditions, and the traditional position-free control algorithm is complex to implement and has poor robustness, an adaptive position sensorless control method based on linear quadratic regulator and Kalman filter (LQR-KF) is proposed to more accurately and simply track and control the motor position in real time.
[0006] In order to achieve the above object, the technical solution adopted by the present invention is: a method for controlling a permanent magnet linear motor for launch in full speed range without position sensor, characterized in that it comprises the following steps:
[0007] Step 1: Taking the launch dual three-phase permanent magnet linear synchronous motor (DTP-PMLSM) as the control object, the control model of DTP-PMLSM in the three-phase stationary coordinate system is established, and the control model of DTP-PMLSM in the VSD coordinate system is established through the vector space decoupling (VSD) coordinate transformation method;
[0008] Step 2: Using the I / F open-loop control strategy, when the actuator acceleration command a meets the conditions, complete the DTP-PMLSM static start and low-speed open-loop operation;
[0009] Step 3: When the DTP-PMLSM runs to the predetermined speed, it switches to the adaptive position-free closed-loop control strategy and realizes the position and speed estimation of the motor through the adaptive LQR-KF observer to ensure that the motor system runs reliably and stably to the highest transmission speed;
[0010] Step 4: When the DTP-PMLSM runs to the highest transmission speed, it quickly enters the deceleration state and adopts the position open-loop and current closed-loop control strategy to ensure that the motor brakes quickly and stably;
[0011] Step 5: Build (using Matlab / Simulink software) the adaptive positionless control model of DTP-PMLSM and analyze the effectiveness of the control method through simulation.
[0012] Furthermore, the control model of DTP-PMLSM in the three-phase stationary coordinate system established in step 1 is:
[0013]
[0014] In the above formula, u 6s =[u a u b u c u u u v u w ] T is the stator phase voltage, the subscripts a, b, c, u, v, w are the stator winding numbers, is the resistance coefficient matrix, R 6s =diag[R s R s R s R s R s R s ],R s is the resistance i 6s =[i a i b i c i u i v i w ] T is the stator phase current, is the stator flux per phase, L 6s is the inductance matrix, θ e is the electrical angle;
[0015] Furthermore, in the step 1, a control model of DTP-PMLSM in a VSD coordinate system is established by using a vector space decoupling (VSD) coordinate transformation method. The vector space decoupling (VSD) coordinate transformation method is used to map each variable of DTP-PMLSM to three mutually orthogonal subspaces, namely, dq subspace, xy subspace and zero-sequence subspace; the mathematical model of DTP-PMLSM in the VSD coordinate system is:
[0016]
[0017] In the above formula, u d 、u q 、u x 、u y is the stator voltage in the dq subspace and the xy subspace, i d ,i q ,i x ,i y is the stator voltage in the dq subspace and the xy subspace, Ld , L q is the inductance of the dq subspace, L x , L y is the leakage inductance, R s is the stator resistance, ω e is the electrical angular velocity, is the permanent magnet flux.
[0018] The motor torque equation is:
[0019]
[0020] Among them, F e The electromagnetic force output by the motor; τ e is the motor pole pitch.
[0021] The mechanical motion equation of the motor is:
[0022]
[0023] Among them, F f is the disturbance amount when the motor is running, M is the total mass, v e is the motor running speed, satisfying v e =ω e τ e / π.
[0024] Furthermore, the specific method of step 2 is: in the I / F open-loop control system, the q-axis current is given, the motor starts and runs; given the frequency, the corresponding electrical angular velocity instruction can be obtained, and the virtual mover position information is obtained by integrating it; the given mover acceleration instruction a must satisfy:
[0025]
[0026] Among them, I qref is the starting q-axis current, F fmax is the maximum external disturbance force of the motor.
[0027] Furthermore, in the step three, the adaptive LQR-KF observer includes two parts: a current state LQR-KF estimation model based on a linear quadratic regulator LQR and a Kalman filter KF, and a speed adaptive parameter.
[0028] The LQR-KF estimation model construction method is as follows:
[0029] 1) The KF-based observation system considering random noise can be expressed as:
[0030]
[0031] Wherein, the superscript '^' represents the estimated value of the variable, K is the feedback matrix related to the output error in the KF observer, A, B and C are the system matrix, input matrix and output matrix of the observation system respectively;
[0032] For the KF algorithm, the goal of optimal state observation can be achieved by minimizing the expectation of the observation error. By derivation, the expectation of the estimated error e(t) can be expressed as follows:
[0033]
[0034] Among them, Ψ and Γ are the covariance matrices of system noise η and measurement noise λ respectively, β is the integral variable, and η and λ satisfy:
[0035]
[0036] Where δ is the Dirac function.
[0037] It is known that the goal of the KF observer is to minimize the expected error, thereby ensuring the optimal estimation performance of the observer;
[0038] Furthermore, since it is relatively complex to directly solve the expected error, K is equivalently calculated by the LQR algorithm to minimize the expected error. The minimization of the expected error adopts the equivalent calculation method of the LQR algorithm, and the specific method is:
[0039] 2) According to the LQR theory, for a feedback control u m =Lx m The closed-loop system can be expressed as:
[0040] dx m / dt=(A m +B m L)x m
[0041] Where L is the system feedback gain matrix, x m represents the system state variable, A m , B m are the system matrix and input matrix respectively;
[0042] Assume that at time τ, we are looking for an optimal control law u m (t), so that the cost function J is minimized, and J can be calculated as:
[0043]
[0044] In the formula, Q and R represent the state variables x and m And input u m The weight of is a diagonal matrix;
[0045] 3) Compare the equation of the cost function J in LQR with the expected error of the KF algorithm E[e(t)e(t) T ], based on the principle of duality, we can get the following equivalent formula:
[0046]
[0047] Therefore, solving L through the LQR algorithm can be equivalent to solving K in the KF algorithm.
[0048] Furthermore, in step 3, the adaptive LQR-KF observer also includes a speed adaptive parameter,
[0049] The speed adaptive parameters in the adaptive LQR-KF observer are designed according to Popov superstability theory. According to Popov superstability theory, the necessary and sufficient conditions for the asymptotic stability of a standard nonlinear time-varying feedback system are:
[0050] 1) The transfer matrix of the linear forward path must be a strictly positive real matrix;
[0051] 2) The nonlinear feedback channel satisfies the Popov integral inequality.
[0052] Based on Popov's hyperstability theory, the speed adaptive law is designed in the form of proportional integral:
[0053]
[0054] Among them, k p , k i is the adaptive gain, is the estimated value of the motor electrical angular velocity. Since the motor under study is a surface-mounted motor, L s It is numerically equal to the dq-axis inductance.
[0055] Furthermore, the adaptive position-free control model of DTP-PMLSM in step 5 is composed as follows:
[0056] 1) LQR-KF current observation model
[0057]
[0058] Among them, u dl 、u ql satisfy:
[0059]
[0060] In the formula, θ e It is the electrical angle, which is necessary to ensure the observability and controllability of the observation system.
[0061] 2) Speed Adaptive Model
[0062] The input of the position-free control model is the current, voltage and motor parameters in the dq subspace, and the output is the observed values of motor speed and displacement.
[0063] Furthermore, when the dual three-phase permanent magnet linear synchronous motor is decelerated, a position open-loop and current closed-loop braking control strategy is adopted, a reverse braking electromagnetic force is set, and a current closed-loop q-axis reference value is calculated to ensure that the motor is stably decelerated to zero within a limited distance.
[0064] The beneficial effects and features of the present invention are:
[0065] (1) The present invention proposes a method for controlling a permanent magnet linear motor for launch in full speed domain without position sensor, and proposes a method for controlling a permanent magnet linear motor for launch in full speed domain without position sensor. When the motor runs in the zero-low speed domain, I / F open-loop control is adopted; when the motor runs in the medium-high speed domain, an adaptive observer based on the linear quadratic regulator LQR and the Kalman filter KF algorithm is proposed; during the motor braking stage, the reverse electromagnetic force position open-loop control is adopted, thereby realizing the closed-loop control of the electromagnetic launch motor in full speed domain without position sensor.
[0066] (2) The full-speed domain position sensorless control method of the permanent magnet linear motor for launch of the present invention adopts the LQR optimal control theory and the KF optimal observation idea, and designs the speed adaptation rate according to the stability theorem, and dynamically adjusts the adaptive module to adapt to the changes in external interference. Compared with the prior art, the full-speed domain position sensorless control method of the present invention not only ensures the estimation accuracy of the position observer, but also enables the observation system to have a certain anti-interference ability, providing guidance for the position sensorless closed-loop control of the electromagnetic launch motor. BRIEF DESCRIPTION OF THE DRAWINGS
[0067] Figure 1 This is a topological diagram of a transmitting motor in a preferred embodiment of the present invention;
[0068] Figure 2 This is a block diagram of a position sensorless closed-loop control of a transmitting motor in full speed range according to a preferred embodiment of the present invention;
[0069] Figure 3 This is a block diagram of the I / F open-loop control principle of a preferred embodiment of the present invention (wherein, (a) the motor forward starting stage; (b) the motor forward running stage);
[0070] Figure 4 It is a control block diagram of an adaptive position observer in a preferred embodiment of the present invention;
[0071] Figure 5It is the full-speed range operating speed observation curve and observation error curve of the transmitting motor of the preferred embodiment of the present invention (including: (a) I / F open-loop starting speed waveform; (b) adaptive position sensorless control speed waveform; (c) reverse electromagnetic force braking stage speed waveform; (d) full-speed range speed waveform; (e) full-speed range position waveform). DETAILED DESCRIPTION
[0072] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0073] Please refer to Figure 1 , Figure 2 The embodiment of the present invention relates to a method for controlling a permanent magnet linear motor for launch in full speed range without position sensor, comprising the following steps:
[0074] Step 1: Taking the launch dual three-phase permanent magnet linear synchronous motor (DTP-PMLSM) as the control object, derive the DTP-PMLSM mathematical model and build a closed-loop control system for the motor system;
[0075] Step 2: Use the I / F open-loop control strategy to complete the DTP-PMLSM static start and low-speed open-loop operation;
[0076] Step 3: When the DTP-PMLSM runs to the predetermined speed, it switches to the adaptive position-free closed-loop control strategy, and realizes the position and speed estimation of the motor through the adaptive LQR-KF observer to ensure that the motor system runs reliably and stably to the highest transmission speed;
[0077] Step 4: When DTP-PMLSM reaches the highest transmission speed, it quickly enters the deceleration state and adopts the position open-loop and current closed-loop control strategy to ensure rapid and stable braking of the motor;
[0078] Step 5: Build (e.g., through Matlab / Simulink software) a full-speed range position sensorless closed-loop control model for the transmitter motor, and analyze the effectiveness of the control method through simulation.
[0079] The mathematical model of the DTP-PMLSM in the three-phase stationary coordinate system is as follows:
[0080]
[0081] In the above formula, u 6s =[u a u b uc u u u v u w ] T is the stator phase voltage, the subscripts a, b, c, u, v, w are the stator winding numbers, is the resistance coefficient matrix, R 6s =diag[R s R s R s R s R s R s ],R s is the resistance i 6s =[i a i b i c i u i v i w ] T is the stator phase current, is the stator flux per phase, L 6s is the inductance matrix, θ e The electrical angle.
[0082] Based on the above, the vector space decoupling (VSD) coordinate transformation method is adopted. VSD is to convert the six-phase current from abc to dq, xy, 0, and map each variable of DTP-PMLSM to three mutually orthogonal subspaces, namely dq subspace, xy subspace and zero-sequence subspace. Therefore, the mathematical model of DTP-PMLSM in the VSD coordinate system is:
[0083]
[0084] In the above formula, u d 、u q 、u x 、u y is the stator voltage in the dq subspace and the xy subspace, i d ,i q ,i x ,i y is the stator voltage in the dq subspace and the xy subspace, L d , L q is the inductance of the dq subspace, L x , L y is the leakage inductance, R s is the stator resistance, ω e is the electrical angular velocity.
[0085] The motor torque equation is:
[0086]
[0087] Among them, F e The electromagnetic force output by the motor; τ e For the pole distance.
[0088] The mechanical motion equation of the motor is:
[0089]
[0090] Among them, F f is the disturbance amount when the motor is running, M is the total mass, v e is the motor speed, satisfying v e =ω e τ e / π.
[0091] The I / F open-loop control is a speed open-loop and current closed-loop control method. By giving a certain current amplitude and combining the thrust power angle self-balancing principle, it has a certain load-carrying capacity and load disturbance resistance in the low-speed area.
[0092] Under open-loop control, the motor outputs the maximum electromagnetic thrust F emax for:
[0093]
[0094] In the system, the q-axis current is given for motor starting and running; the corresponding electrical angular velocity command is obtained for the given frequency, and the virtual mover position information is obtained by integrating it. The design of the given mover acceleration command a must meet the following requirements:
[0095]
[0096] Among them, I qref is the starting q-axis current, F fmax is the maximum external disturbance force of the motor.
[0097] The adaptive position-free closed-loop control mainly includes two parts: a current state estimation model based on a linear quadratic regulator LQR and a Kalman filter KF and a speed adaptive parameter. The LQR-KF estimation model is constructed as follows:
[0098] 1) The KF-based observer considering random noise can be expressed as:
[0099]
[0100] Wherein, the superscript '^' represents the estimated value of the variable, K is the feedback matrix related to the output error in the KF observer, and A, B and C are the system matrix, input matrix and output matrix of the observation system respectively.
[0101] For the KF algorithm, the goal of optimal state observation can be achieved by minimizing the expectation of the observation error. By derivation, the expectation of the estimated error e(t) can be expressed as follows:
[0102]
[0103] Among them, Ψ and Γ are the covariance matrices of system noise η and measurement noise λ respectively, β is the integral variable, and η and λ satisfy:
[0104]
[0105] Where δ is the Dirac function.
[0106] It is known that the goal of the KF observer is to minimize the expected error, thereby ensuring the optimal estimation performance of the observer. Since it is relatively complex to directly solve the expected error, K is equivalently calculated through the LQR algorithm to minimize the expected error.
[0107] 2) According to the LQR theory, for a feedback control u m =Lx m The closed-loop system can be expressed as:
[0108] dx m / dt=(A m +B m L)x m
[0109] Where L is the system feedback gain matrix, x m represents the system state variable, A m , B m are the system matrix and the input matrix respectively.
[0110] Assume that at time τ, we are looking for an optimal control law u m (t), so that the cost function J is minimized, and J can be calculated as:
[0111]
[0112] In the formula, Q and R represent the state variables x and m And input u m The weights of , which is a diagonal matrix.
[0113] 3) Compare the equation of the cost function J in LQR with the expected error of the KF algorithm E[e(t)e(t) T ], based on the principle of duality, we can get the following equivalent formula:
[0114]
[0115] Therefore, solving L through the LQR algorithm can be equivalent to solving K in the KF algorithm.
[0116] The speed adaptive parameters in the adaptive LQR-KF observer are designed according to Popov superstability theory. According to Popov superstability theory, the necessary and sufficient conditions for the asymptotic stability of a standard nonlinear time-varying feedback system are:
[0117] 1) The transfer matrix of the linear forward path must be a strictly positive real matrix;
[0118] 2) The nonlinear feedback channel satisfies the Popov integral inequality.
[0119] For the first condition of Popov's hyperstability theory, based on the positive real lemma, we select C = P = I and obtain the transfer function G of the linear forward path as:
[0120] G=-(P(A s +K)+(A s +K) T P)
[0121] Among them, I is the unit matrix, C is the linear compensation matrix, P is the positive definite matrix, A s is the state matrix of the system, and K is the feedback gain matrix, which is used to implement feedback control.
[0122] For the quadratic condition of Popov's hyperstability theory, the adaptive law of the nonlinear feedback path satisfies the Popov integral inequality:
[0123]
[0124] is any positive number, η(0,t 0 ) represents Popov integral inequality, and y is the output of the nonlinear feedback channel.
[0125] in,
[0126]
[0127] Then, the speed adaptive law is designed as proportional integral form:
[0128]
[0129] Among them, k p , k i is the adaptive gain, is the estimated value of the motor electrical angular velocity. Since the motor under study is a surface-mounted motor, L s It is numerically equal to the dq-axis inductance.
[0130] Finally, the adaptive position-free control model of DTP-PMLSM is composed as follows:
[0131] 1) LQR-KF current observation model
[0132]
[0133] Among them, u dl 、u ql satisfy:
[0134]
[0135] In the formula, θ e It is the electrical angle, which is necessary to ensure the observability and controllability of the observation system.
[0136] 2) Speed Adaptive Law
[0137] The input of the position-free control model is the current, voltage and motor parameters in the dq subspace, and the output is the observed values of motor speed and displacement.
[0138] The topological structure of the transmitting motor in the specific embodiment of the present invention is as follows: Figure 1 As shown in the figure, it is a long primary bilateral permanent magnet linear synchronous motor with a double-layer Halbach structure. The primary winding includes a C-type six-phase winding and a support frame, in which the winding can effectively reduce high-order harmonics and improve the motor's limit capacity. The secondary system consists of a radially magnetized permanent magnet array with alternating N-pole and S-pole and its frame. The air gap magnetic field of the permanent magnet array presents a flat-top waveform with minimal harmonic distortion, which can provide the sinusoidal air gap magnetic field necessary to maintain the normal operation of the motor.
[0139] like Figure 2 As shown in the figure, a block diagram of the position-free control principle of a dual three-phase permanent magnet linear synchronous motor is provided. The linear motor control principle mainly includes the following aspects:
[0140] (1) When the motor is in the zero-speed starting stage, the motor adopts the I / F starting control strategy of position open loop and current closed loop. By giving the q-axis current and setting the motor starting frequency at the same time, the motor is guaranteed to start stably and at low speed.
[0141] In order to improve the control performance of the motor, the current inner loop adopts the vector control algorithm under the VSD coordinate transformation. The current inner loop mainly includes the dq subspace closed-loop regulator and the xy harmonic subspace closed-loop regulator. In order to ensure that the motor has the minimum stator copper loss when outputting the same electromagnetic torque, the xy harmonic subspace given value is set to zero. When the VSD transformation method is used, the variable obtained in the xy subspace is an AC quantity. Due to the gain and bandwidth limitations of the conventional PI regulator, it is impossible to achieve zero-static error regulation of the AC quantity, so the control result obtained is not optimal. In order to solve the above problems, the current inner loop adopts proportional resonant PR control to obtain better control performance.
[0142] (2) After the motor starts stably, it switches to the medium and high speed adaptive position-free closed-loop control strategy. The closed-loop system adopts dual-loop control, mainly including the current inner loop and the position outer loop. The input of the outer loop control is the motor reference speed V ref , reference position X ref And the motor observed speed and position signals output by the adaptive LQR-KF observer. The q-axis current i output by the outer loop qref As the reference input of the current inner loop, the current inner loop input also includes the d-axis current reference value i dref and the xy axis current reference value i xy,ref .
[0143] The adaptive LQR-KF positionless control module takes the measured motor current and control voltage as input and outputs the observed speed v ehat and the observed position x ehat Used for motor closed-loop control. The observed position signal is transformed into an angle through coefficient conversion, which is used for coordinate transformation of motor control.
[0144] (3) When the motor accelerates to the maximum launch speed and enters the deceleration braking stage, a position open-loop and current closed-loop braking control strategy is adopted. By inputting a braking electromagnetic force in the opposite direction of the motor's movement, the q-axis reference current of the current inner loop is calculated to ensure that the motor brakes quickly and stably within a short distance.
[0145] (4) In addition, for the inverter control strategy, the voltage output by the motor control is used as the input of the inverter, and the six-phase voltage of the dual three-phase motor is obtained through the space vector modulation SVPWM algorithm. The advantages of the SVPWM algorithm are as follows: SVPWM has a relatively high degree of harmonic optimization, better harmonic elimination effect than SPWM, easy implementation, and can improve voltage utilization; the SVPWM algorithm improves the DC voltage utilization of the voltage source inverter and the dynamic response speed of the motor, while reducing the torque pulsation of the motor; it is more suitable for digital control systems.
[0146] Figure 3The diagram is the I / F open-loop control principle diagram. The q-axis current is used to position the rotor. In order to make the electromagnetic torque output at the initial moment of startup start from 0, the open-loop drag angle starts from 270°. Figure 3 As shown in (a), the dq axis is marked with v to indicate I qref The virtual coordinate system d v -q v , d v -q v The coordinate system lags behind the actual dq coordinate system by 90°, and the electromagnetic thrust is 0 at this time. Figure 3 (a), δ = 0, θ L =π / 2.
[0147] The angle between the virtual synchronous coordinate system q-axis and the actual coordinate system d-axis is defined as δ:
[0148]
[0149] Set the motor electrical angular velocity to increase from 0 to a certain stable value, d v -q v The coordinate system rotates with the given electrical angular velocity, making δ>0, thus generating electromagnetic thrust, such as Figure 3 (b) as shown. Figure 3 (b), d v -q v The coordinate system lags behind the actual dq coordinate system θ L , and the hysteresis angle θ L The size depends on I qref The projection on the actual dq coordinate system satisfies: i t =I qref cosθ L .
[0150] D v -q v I in the coordinate system qref Projecting into the actual dq coordinate system, the electromagnetic thrust of the motor in IF control can be obtained:
[0151]
[0152] When δ=π / 2, the PMLSM output electromagnetic force is the largest, but the motor is in a critical stable state. Once a small disturbance causes θ L <0, which will cause the motor to lose step.
[0153] Figure 4 The figure shows the control block diagram of the adaptive position observer. As can be seen from the figure, the adaptive position observer consists of two parts: the current observation model based on LQR-KF and the speed adaptation model.
[0154] Figure 5 The simulation results of the motor full-speed range position sensorless control are given. In the simulation, the following settings are set: when t = 0s-2.6s, the motor adopts the I / F open-loop control strategy, and the motor slowly accelerates from a stationary state to a constant speed of 0.06m / s according to a given speed. Figure 5 (a) When t = 2.6s-2.875s, the motor switches from I / F open-loop control to adaptive positionless closed-loop control, and the motor accelerates, with a maximum acceleration of 20m / s 2 The motor accelerates to 5m / s in 0.275s. The simulation waveform is as follows Figure 5 As shown in (b), when t>2.875s, the motor control system switches to reverse electromagnetic force braking control, and the reverse acceleration is -110m / s 2 , until the motor speed drops to 0, the control system is powered off, such as Figure 5 (c). In addition, Figure 5 (d) Figure 5 (e) shows the speed waveform and position waveform of the motor in the full speed range. Figure 5 It can be seen from the simulation results that the method proposed in the present invention realizes the closed-loop control of the transmitting motor without position sensor in the full speed range.
[0155] The embodiment of the present invention uses a dual three-phase permanent magnet linear synchronous motor (DTP-PMLSM) as an electromagnetic transmitting motor. First, the motor is started and operated at a low speed through I / F open-loop control; secondly, the control strategy is switched from the I / F algorithm to the position sensorless algorithm, and a designed adaptive position observer based on a linear quadratic regulator and a Kalman filter (LQR-KF) is used to realize the position sensorless closed-loop control of the motor. Under this control, the motor runs to the set maximum speed; finally, it is switched to position open-loop control during the motor deceleration stage, and a reverse braking force is applied through the current inner loop to ensure rapid and smooth braking of the motor. Compared with the prior art, this full-speed domain positionless control method adopts position open-loop control when the motor is started and braked, which can ensure the rapid start and stop of the motor while simplifying the algorithm. In the medium and high-speed operation area of the motor, the system state estimation model is derived to achieve the optimal state estimation of the transmitting motor. At the same time, an adaptive module is designed to dynamically realize the speed estimation of the transmitting motor. The adaptive module is dynamically adjusted to cope with changes in external interference, thereby ensuring the anti-disturbance ability of the algorithm.
[0156] It will be easily understood by those skilled in the art that the above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. Any modifications, equivalent substitutions and improvements made within the spirit and principles of the present invention should be included in the protection scope of the present invention.
Claims
1. A method for controlling a permanent magnet linear motor for launch in full speed range without position sensor, characterized in that: The steps include: Step 1: Taking the dual three-phase permanent magnet linear synchronous motor DTP-PMLSM for launch as the control object, establish the control model of DTP-PMLSM in the three-phase stationary coordinate system, and establish the control model of DTP-PMLSM in the VSD coordinate system through the vector space decoupling VSD coordinate transformation method; Step 2: Using the I / F open-loop control strategy, when the actuator acceleration command a meets the conditions, complete the DTP-PMLSM static start and low-speed open-loop operation; Step 3: When the DTP-PMLSM runs to the predetermined speed, it switches to the adaptive position-free closed-loop control strategy and realizes the position and speed estimation of the motor through the adaptive LQR-KF observer to ensure that the motor system runs reliably and stably to the highest transmission speed; Step 4: When the DTP-PMLSM runs to the highest transmission speed, it quickly enters the deceleration state and adopts the position open-loop and current closed-loop control strategy to ensure that the motor brakes quickly and stably; Step 5: Build an adaptive positionless control model of DTP-PMLSM and analyze the effectiveness of the control method through simulation.
2. The method for controlling a permanent magnet linear motor for launch in full speed range without position sensor according to claim 1, characterized in that: The control model of DTP-PMLSM established in the three-phase stationary coordinate system in step 1 is: In the above formula, u 6s =[u a u b u c u u u v u w ] T is the stator phase voltage, the subscripts a, b, c, u, v, w are the stator winding numbers, is the resistance coefficient matrix, R 6s =diag[R s R s R s R s R s R s ],R s is the resistance i 6s =[i a i b i c i u i v i w ] T is the stator phase current, is the stator flux per phase, L 6s is the inductance matrix, θ e The electrical angle.
3. The method for controlling a permanent magnet linear motor for launch in full speed range without position sensor according to claim 1, characterized in that: In the step 1, the method for establishing the control model of DTP-PMLSM in the VSD coordinate system by using the vector space decoupling (VSD) coordinate transformation method is as follows: using the vector space decoupling (VSD) coordinate transformation method, each variable of DTP-PMLSM is respectively mapped to three mutually orthogonal subspaces, namely, the dq subspace, the xy subspace and the zero-sequence subspace; the mathematical model of DTP-PMLSM in the VSD coordinate system is: In the above formula, u d 、u q 、u x 、u y is the stator voltage in the dq subspace and the xy subspace, i d ,i q ,i x ,i y is the stator voltage in the dq subspace and the xy subspace, L d , L q is the inductance of the dq subspace, L x , L y is the leakage inductance, R s is the stator resistance, ω e is the electrical angular velocity, is the permanent magnet flux. The motor torque equation is: Among them, F e is the electromagnetic force output by the motor; τ e is the motor pole pitch. The mechanical motion equation of the motor is: Among them, F f is the disturbance amount when the motor is running, M is the total mass, v e is the motor running speed, satisfying v e =ω e τ e / π.
4. The method for controlling a permanent magnet linear motor for launch in full speed range without position sensor according to claim 3, characterized in that: The specific method of step 2 is: in the I / F open-loop control system, the q-axis current is given, the motor starts and runs; given the frequency, the corresponding electrical angular velocity instruction can be obtained, and the virtual mover position information is obtained by integrating it; the given mover acceleration instruction a must satisfy: Among them, I qref is the starting q-axis current, F fmax is the maximum external disturbance force of the motor.
5. The method for controlling a permanent magnet linear motor for launch in full speed range without position sensor according to claim 3, characterized in that: In the step 3, the adaptive LQR-KF observer includes a current state LQR-KF estimation model based on a linear quadratic regulator LQR and a Kalman filter KF; The LQR-KF estimation model construction method is as follows: 1) The KF-based observation system considering random noise can be expressed as: Wherein, the superscript '^' represents the estimated value of the variable, K is the feedback matrix related to the output error in the KF observer, A, B and C are the system matrix, input matrix and output matrix of the observation system respectively; For the KF algorithm, the goal of optimal state observation can be achieved by minimizing the expectation of the observation error. By derivation, the expectation of the estimated error e(t) can be expressed as follows: Among them, Ψ and Γ are the covariance matrices of system noise η and measurement noise λ respectively, β is the integral variable, and η and λ satisfy: Where δ is the Dirac function. The goal of the KF observer is to minimize the expected error.
6. The method for controlling a permanent magnet linear motor for launch in full speed range without position sensor according to claim 5, characterized in that: The minimization error is expected to adopt the LQR algorithm equivalent calculation method, the specific method is: From the LQR theory, we know that for a feedback control u m =Lx m The closed-loop system can be expressed as: dx m / dt=(A m +B m L)x m Where L is the system feedback gain matrix, x m represents the system state variable, A m , B m are the system matrix and input matrix respectively; Assume that at time τ, we are looking for an optimal control law u m (t), so that the cost function J is minimized, and J can be calculated as: In the formula, Q and R represent the state variables x and m And input u m The weight of is a diagonal matrix; 3) Compare the equation of the cost function J in LQR with the expected error of the KF algorithm E[e(t)e(t) T ], based on the principle of duality, we can get the following equivalent formula: Therefore, solving L through the LQR algorithm can be equivalent to solving K in the KF algorithm.
7. The method for controlling a permanent magnet linear motor for launch in full speed range without position sensor according to claim 5, characterized in that: In step 3, the adaptive LQR-KF observer also includes a speed adaptive parameter, The speed adaptive parameters in the adaptive LQR-KF observer are designed according to Popov superstability theory. According to Popov superstability theory, the necessary and sufficient conditions for the asymptotic stability of a standard nonlinear time-varying feedback system are: 1) The transfer matrix of the linear forward path must be a strictly positive real matrix; 2) The nonlinear feedback channel satisfies the Popov integral inequality. Based on Popov's hyperstability theory, the speed adaptive law is designed in the form of proportional integral: Among them, k p , k i is the adaptive gain, is the estimated value of the motor electrical angular velocity. The superscript '^' indicates the estimated value of the variable. Since the motor under study is a surface-mounted motor, L s It is numerically equal to the dq-axis inductance.
8. The method for controlling a permanent magnet linear motor for launch in full speed range without position sensor according to claim 7, characterized in that: The adaptive position-free control model of DTP-PMLSM in step 5 is composed as follows: 1) LQR-KF current observation model Among them, u dl 、u ql satisfy: In the formula, θ e is the electrical angle, which is necessary to ensure the observability and controllability of the observation system; 2) Speed Adaptive Model The input of the position-free control model is the current, voltage and motor parameters in the dq subspace, and the output is the observed values of motor speed and displacement.
9. The method for controlling a permanent magnet linear motor for launch in full speed range without position sensor according to any one of claims 1 to 8, characterized in that: When the dual three-phase permanent magnet linear synchronous motor is decelerated, a position open-loop and current closed-loop braking control strategy is adopted. The reverse braking electromagnetic force is set and the current closed-loop q-axis reference value is calculated to ensure that the motor can be stably decelerated to zero within a limited distance.
Citation Information
Patent Citations
Control method for multi-harmonic current cooperative injection of dual three-phase permanent magnet synchronous motor
CN110739896A
Full-speed-domain position-sensorless vector control method of surface-mounted permanent magnet synchronous motor
CN116073724A
Minimum copper loss fault-tolerant control system and method for zero-phase-shift dual three-phase permanent magnet motor
CN117254742A
Double three-phase permanent magnet synchronous motor one-phase winding open-phase fault-tolerant control method and system
CN118157547A
