Motor angular velocity calibration method, motor control method and motor control system
By adopting the motor angular velocity calibration method of DESO and co-frequency extractor in the CMG system, combined with the dynamic sliding mode and non-singular terminal sliding mode control ideas, the problem of difficulty in improving the output signal accuracy of the rotary transformer in the CMG system is solved, and the problem of contradicting the approach speed and vibration in the sliding mode control is achieved, and higher signal accuracy and better dynamic response performance are achieved.
Patent Information
- Application Number
- CN202411842617.8
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-12-13
- Publication Date
- 2025-03-21
- Estimated Expiration
- 2044-12-13
AI Technical Summary
In the prior art, it is difficult to effectively calibrate the accuracy of the output signal of the rotary transformer in the control torque gyro (CMG) system, and there is a problem that the approaching speed and vibration are contradictory in the sliding mode control.
The motor angular velocity calibration method based on discrete diffusion state observer (DESO) and co-frequency extractor are adopted to obtain the initial ideal angular velocity through DESO, and the co-frequency extractor is used to process the angular velocity signal to suppress harmonic components and improve signal accuracy. At the same time, combining the dynamic sliding mode and non-singular terminal sliding mode control ideas, a controller is built to improve the dynamic response performance and vibration problems of the system.
It improves the accuracy of the output signal of the rotary transformer and is suitable for CMG systems, solves the problems of phase hysteresis and limited compensation effects in the control torque gyro frame servo system, and effectively improves the contradiction between approaching speed and jitter in sliding mode control.
Smart Images

Figure CN119675514A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of motor control, and in particular to a motor angular velocity calibration method, a motor control method and a motor control system. Background Art
[0002] The controlled moment gyro (CMG) has the advantages of large output torque, high precision, no consumption of working fluid, and long life. Therefore, it is widely used in the attitude control of large spacecraft such as space stations, space telescopes, and ultra-agile maneuvering satellites. The controlled moment gyro consists of a high-speed rotor system and a frame system. Its basic working principle is to output torque through the high-speed rotation of the high-speed rotor, thereby controlling the attitude of the spacecraft. Since the angular momentum of the gyro is constant, the accuracy of the spacecraft attitude control and the output torque of the gyro are determined by the accuracy of the angular velocity of the frame system.
[0003] The resolver is suitable for CMG control systems that require high measurement accuracy due to its high precision and strong anti-interference performance. The output signal is demodulated and converted into a digital signal by a resolver-to-digital converter (RDC) chip, but due to interference from various factors, the output signal contains errors such as orthogonal error, inductor harmonics, and amplitude imbalance. However, due to the spatial structure of the CMG, it is impossible to compensate with another accurate sensor.
[0004] To avoid repeated disassembly, the prior art uses an online error extraction method for correction and compensation, and a signal reconstruction method to process the noise in the output signal of the resolver. This method proves the feasibility of online correction, but due to the particularity of the CMG frame system, an integrated RDC chip shaft angle decoding system is usually used. Therefore, this method is not suitable for the CMG system.
[0005] Sliding mode control is suitable for CMG control systems because of its insensitivity to external uncertain disturbances and strong robustness, but there is always a contradiction between approaching speed and chattering. Summary of the invention
[0006] The purpose of the present invention is to provide a motor angular velocity calibration method, a motor control method and a motor control system, which improve the accuracy of the output signal of the rotary transformer and improve the problem of the contradiction between approaching speed and jitter in traditional sliding mode control.
[0007] A motor angular velocity calibration method based on DESO and a co-frequency extractor, comprising:
[0008] Obtaining angular position information and angular velocity information output by the resolver;
[0009] Constructing a discrete extended state observer DESO, and obtaining an initial ideal angular velocity based on the discrete extended state observer, the angular position information and the angular velocity information;
[0010] The discrete extended state observer expression is:
[0011]
[0012] Where: u(t) is the initial ideal angular velocity at time t, ω raw (t) is the original angular velocity at time t, z2(t) is the estimated angular velocity error at time t, e(t) is the estimated error of the discrete extended state observer at time t, y(t) is the original angular position at time t, z1(t) is the estimated angular position at time t, z1(t-1) is the estimated angular position at time t-1, z2(t-1) is the estimated angular velocity error at time t-1, h is the integration step, u(t-1) is the initial ideal angular velocity at time t-1, β1 is the first parameter of the discrete extended state observer, e(t-1) is the estimated error of the discrete extended state observer at time t-1, β2 is the second parameter of the discrete extended state observer, m is the number of integration points, and η is the convergence rate coefficient of z2(tm) at time tm;
[0013] The initial ideal angular velocity is processed based on the closed-loop transfer function of the same-frequency extractor to obtain the ideal angular velocity; the expression is:
[0014] ω(t)=u(t)×H(t);
[0015] Where: ω(t) is the ideal angular velocity at time t, H(t) is the transfer function at time t, when u(t) = ω0, H(t) = 1, when u(t) ≠ ω0, ω0 is the fundamental frequency of the initial ideal angular velocity, j is the imaginary unit, and ε is the coefficient of the same frequency extractor.
[0016] The present invention also provides a permanent magnet synchronous motor control method based on the above-mentioned ideal angular velocity, which comprises:
[0017] A mathematical model of a permanent magnet synchronous motor in a dq rotating coordinate system is constructed; the mathematical model expression of the permanent magnet synchronous motor is:
[0018]
[0019] Where: u d is the motor d-axis voltage, i d is the motor d-axis current, u q is the motor q-axis voltage, i q is the motor q-axis current, L d is the stator inductance of the motor d-axis, Lq is the motor q-axis stator inductance, R is the motor stator inductance, p n is the stator resistance of the motor, J is the moment of inertia of the motor, is the permanent magnet flux of the motor, B is the magnetic damping coefficient, t is the time, T e is the electromagnetic torque of the motor, T L is the motor load torque, ω m is the motor speed, obtained based on the ideal angular velocity of claim 1;
[0020] Based on i d =0 to process the permanent magnet synchronous motor mathematical model to obtain a motor processing mathematical model;
[0021] Considering the lumped disturbance F, the state variable model of the permanent magnet synchronous motor is constructed; the expression is:
[0022]
[0023] Where: x1 is the first state variable, x2 is the second state variable, is the first-order derivative of x2, is the first-order derivative of x1,
[0024] A non-singular terminal sliding surface model is constructed based on the state variable model, and the expression is:
[0025]
[0026] Where: ζ is the constructed non-singular terminal sliding surface, x′1=s, is the first derivative of x′1, s=cx1+x2 is the linear sliding surface, c is the parameter of the linear sliding surface s, β is the first sliding parameter, β>0, p is the second parameter of the sliding mode, q is the third parameter of the sliding mode, 1<p / q<2, p and q are positive odd numbers;
[0027] The non-singular terminal sliding surface model is derived to obtain a non-singular terminal sliding surface derivative model; the expression is:
[0028]
[0029] Will Substituting into the non-singular terminal sliding surface derivative model, a dynamic non-singular terminal sliding surface model is obtained;
[0030] Constructing the exponential reaching law of the dynamic non-singular terminal sliding surface model A controller is constructed based on the exponential reaching law and the dynamic non-singular terminal sliding surface model, and the expression is:
[0031]
[0032] Where: is the controller output value, is the motor q-axis input current, is the first coefficient and n is the second coefficient.
[0033] Optionally, the motor processing mathematical model expression is:
[0034]
[0035] Optionally, a state variable model of the permanent magnet synchronous motor is constructed by considering the lumped disturbance F, including:
[0036] Construct the initial state variable model; the expression is:
[0037]
[0038] Where: is the reference speed of the motor;
[0039] The load disturbance, magnetic damping disturbance and permanent magnet flux disturbance are added to the motor processing mathematical model to obtain the motor disturbance mathematical model; the expression is:
[0040]
[0041] Where: is the permanent magnet flux disturbance, ΔT L is the load disturbance, ΔB is the magnetic damping disturbance;
[0042] The load disturbance, magnetic damping disturbance and permanent magnet flux disturbance are equivalent to a lumped disturbance F, and the motor disturbance mathematical model is substituted into the initial state variable model and derived to obtain the state variable model.
[0043] Optionally, an extended state observer is constructed and linearized to obtain a linearized extended state observer; the expression is:
[0044]
[0045] Where: e is the observation error, z1 is y z The observed value, y z =ω m ,δ is the parameter value of Fal filter function, l1=2ω r , ω r is the bandwidth of the control system.
[0046] Optionally, a motor disturbance observation model is constructed; the expression is:
[0047]
[0048] Where: x z1 is the intermediate parameter;
[0049] An extended state observer is constructed based on the motor disturbance observation model and linearized to obtain an initial linearized extended state observer, which is expressed as:
[0050]
[0051] Improving the initial linearized extended state observer based on the Fal filter function to obtain the linearized extended state observer;
[0052] The value of the lumped disturbance F is obtained based on the linearized extended state observer.
[0053] The present invention also provides a permanent magnet synchronous motor control system based on the above-mentioned ideal angular velocity, which comprises:
[0054] The model building module is used to build a mathematical model of the permanent magnet synchronous motor in a dq rotating coordinate system; the mathematical model expression of the permanent magnet synchronous motor is:
[0055]
[0056] Where: u d is the motor d-axis voltage, i d is the motor d-axis current, u q is the motor q-axis voltage, i q is the motor q-axis current, L d is the stator inductance of the motor d-axis, L q is the motor q-axis stator inductance, R is the motor stator inductance, p n is the stator resistance of the motor, J is the moment of inertia of the motor, is the permanent magnet flux of the motor, B is the magnetic damping coefficient, t is the time, T e is the electromagnetic torque of the motor, T L is the motor load torque, ω m is the motor speed, obtained based on the ideal angular velocity of claim 1;
[0057] Model processing module for i-based d =0 to process the permanent magnet synchronous motor mathematical model to obtain a motor processing mathematical model;
[0058] The state variable module is used to construct the state variable model of the permanent magnet synchronous motor considering the lumped disturbance F; the expression is:
[0059]
[0060] Where: x1 is the first state variable, x2 is the second state variable, is the first derivative of x2, is the first-order derivative of x1,
[0061] The sliding surface module is used to construct a non-singular terminal sliding surface model based on the state variable model, and the expression is:
[0062]
[0063] Where: ζ is the constructed non-singular terminal sliding surface, x′1=s, is the first derivative of x′1, s=cx1+x2 is the linear sliding surface, c is the parameter of the linear sliding surface s, β is the first sliding parameter, β>0, p is the second parameter of the sliding mode, q is the third parameter of the sliding mode, 1<p / q<2, p and q are positive odd numbers;
[0064] The derivation module is used to derive the non-singular terminal sliding surface model to obtain a non-singular terminal sliding surface derivative model; the expression is:
[0065]
[0066] Dynamic non-singular terminal sliding surface model module is used to convert Substituting into the non-singular terminal sliding surface derivative model, a dynamic non-singular terminal sliding surface model is obtained;
[0067] A control module for constructing an exponential reaching law of the dynamic non-singular terminal sliding surface model A controller is constructed based on the exponential reaching law and the dynamic non-singular terminal sliding surface model, and the expression is:
[0068]
[0069] Where: is the controller output value, is the motor q-axis input current, is the first coefficient and n is the second coefficient.
[0070] Optionally, the motor processing mathematical model expression is:
[0071]
[0072] Optionally, the state variable module includes:
[0073] The first state variable unit is used to construct the initial state variable model; the expression is:
[0074]
[0075] Where: is the reference speed of the motor;
[0076] The disturbance unit is used to add load disturbance, magnetic damping disturbance and permanent magnet flux disturbance to the motor processing mathematical model to obtain the motor disturbance mathematical model; the expression is:
[0077]
[0078] Where: is the permanent magnet flux disturbance, ΔT L is the load disturbance, ΔB is the magnetic damping disturbance;
[0079] The second state variable unit is used to equate the load disturbance, magnetic damping disturbance and permanent magnet flux disturbance to a lumped disturbance F, and substitute the motor disturbance mathematical model into the initial state variable model and derive it to obtain the state variable model.
[0080] Optionally, a motor disturbance observation model is constructed; the expression is:
[0081]
[0082] Where: x z1 is the intermediate parameter;
[0083] An extended state observer is constructed based on the motor disturbance observation model and linearized to obtain an initial linearized extended state observer, which is expressed as:
[0084]
[0085] The initial linearized extended state observer is improved based on the Fal filter function to obtain the linearized extended state observer; the expression is:
[0086]
[0087] Where: e is the observation error, z1 is y z The observed value, y z =ω m ,δ is the parameter value of Fal filter function, l1=2ω r , ω r is the bandwidth of the control system;
[0088] The value of the lumped disturbance F is obtained based on the linearized extended state observer.
[0089] The effects of the present invention are as follows:
[0090] The motor angular velocity calibration method of the present invention is based on DESO and iso-frequency extractor. The velocity error in the original angular velocity is obtained by discrete extended state observer DESO, so as to obtain more accurate angular velocity information. The angular velocity information is further processed by the iso-frequency extractor to suppress the harmonic components while retaining the fundamental frequency signal, so as to obtain accurate angular velocity information.
[0091] The motor angular velocity calibration method based on DESO and the same frequency extractor can be applied to the CMG system and can extract the rotational speed fundamental frequency under the normal operation of the CMG system, thereby solving the problem of phase lag and limited compensation effect caused by bandwidth limitation and filtering of various physical quantities in the frame servo system of the control moment gyro using the traditional observer method.
[0092] The present invention is based on a permanent magnet synchronous motor control method with an ideal angular velocity. By adopting a control concept combining a dynamic sliding mode with a non-singular terminal sliding mode, a linear sliding mode surface is derived and used as a new variable, and then a new nonlinear sliding mode surface, namely a non-singular terminal sliding mode surface, is constructed, so that the discontinuous term of the control input is placed in the first-order derivative of the control input and then integrated. On the basis of retaining the high dynamic response performance of the traditional terminal sliding mode, the degree of system jitter and controller output jitter is reduced, and the singular phenomenon is avoided.
[0093] The present invention is based on a permanent magnet synchronous motor control method of an ideal angular velocity, and simultaneously takes into account the problems of dynamic response performance and jitter degree of a sliding mode control system, thereby effectively improving the problem of the contradiction between approaching speed and jitter of sliding mode control. BRIEF DESCRIPTION OF THE DRAWINGS
[0094] Figure 1 This is a flow chart of the motor angular velocity calibration method based on DESO and the same frequency extractor of the present invention;
[0095] Figure 2 This is a schematic diagram of the same-frequency extractor disclosed in the present invention;
[0096] Figure 3 This is a schematic diagram of the motor angular velocity calibration method based on DESO and the same frequency extractor of the present invention;
[0097] Figure 4 The schematic diagram of the permanent magnet synchronous motor control method based on the ideal angular velocity of the present invention;
[0098] Figure 5 It is a schematic diagram of the filtering effect of the same frequency extractor of the present invention;
[0099] Figure 6 This is a schematic diagram of the control speed response curve of the present invention;
[0100] Figure 7Schematic diagram of the controller output curve of the present invention. DETAILED DESCRIPTION
[0101] Hereinafter, embodiments of the present invention will be described with reference to the drawings.
[0102] Figure 1 This is a flow chart of the motor angular velocity calibration method based on DESO and the same frequency extractor of the present invention. Figure 3 The schematic diagram of the motor angular velocity calibration method based on DESO and the same frequency extractor of the present invention is shown in FIG. Figure 1 and Figure 3 As shown, the present invention provides a motor angular velocity calibration method based on DESO and a co-frequency extractor, which includes:
[0103] S1, obtaining the angular position information and angular velocity information output by the resolver.
[0104] S2, constructing a discrete extended state observer DESO, and obtaining an initial ideal angular velocity based on the discrete extended state observer, the angular position information and the angular velocity information. Figure 3 In, ω g (t) is the angular velocity after θ(t) difference processing.
[0105] The discrete extended state observer expression is:
[0106]
[0107] Where: u(t) is the initial ideal angular velocity at time t, ω raw (t) is the original angular velocity at time t, z2(t) is the estimated angular velocity error at time t, e(t) is the estimated error of the discrete extended state observer at time t, y(t) is the original angular position at time t, z1(t) is the estimated angular position at time t, z1(t-1) is the estimated angular position at time t-1, z2(t-1) is the estimated angular velocity error at time t-1, h is the integration step size, u(t-1) is the initial ideal angular velocity at time t-1, β1 is the first parameter of the discrete extended state observer, e(t-1) is the estimated error of the discrete extended state observer at time t-1, β2 is the second parameter of the discrete extended state observer, m is the number of integration points, and η is the convergence rate coefficient of z2(tm) at time tm.
[0108] By obtaining more accurate angular velocity information through DESO, the angular velocity fundamental frequency information can be obtained; in practical applications, when using the bandwidth method to configure parameters, the larger the bandwidth, the higher the estimation accuracy, but the greater the impact of noise, and it is difficult to guarantee 100% accuracy, so further processing is required.
[0109] S3, based on the closed-loop transfer function of the same frequency extractor, the initial ideal angular velocity is processed to obtain the ideal angular velocity. The expression is:
[0110] ω(t)=u(t)×H(t);
[0111] Where: ω(t) is the ideal angular velocity at time t, H(t) is the transfer function at time t, when u(t) = ω0, H(t) = 1, when u(t) ≠ ω0, ω0 is the fundamental frequency of the initial ideal angular velocity, j is the imaginary unit, ε is the coefficient of the same-frequency extractor, and the size of ε affects the performance of the same-frequency extractor and needs to be selected according to actual conditions.
[0112] Specifically, the principle of the same frequency extractor is as follows: Figure 2 As shown, the input of the frequency extractor is u(t), and the output is ω(t). Figure 2 In the above example, A0sinω1t is the first reference signal, A0cosω1t is the second reference signal, and V sin (t)1 is the mixed signal of A0sinω1t and u(t), V sin (t)2 is the mixed signal of A0cosω1t and u(t), ε a V sin (t)1 gain factor, ε b V sin (t)2 gain factor, s = α + jφ is a complex frequency domain operator, α is the gain from the time domain to the complex frequency domain, and φ is the phase of the gain from the time domain to the complex frequency domain.
[0113] When u(t)=ω0, the gain of the closed-loop transfer function of the frequency extractor is 1, and the value of the fundamental frequency angular velocity of the initial ideal angular velocity remains unchanged after being processed.
[0114] When u(t)≠ω0, the gain of the closed-loop transfer function of the frequency extractor is less than 1, and the amplitude of the harmonic angular velocity in the initial ideal angular velocity is attenuated to varying degrees after being processed.
[0115] Therefore, after the input initial ideal angular velocity is processed by the same frequency processor, the fundamental frequency angular velocity is output normally, while the noise signals at the other harmonic frequencies are suppressed to varying degrees, achieving the filtering effect and improving the accuracy of the output angular velocity, thereby obtaining the ideal angular velocity. The filtering effect is as follows: Figure 5 shown.
[0116] like Figure 4 As shown, the present invention also provides a permanent magnet synchronous motor control method based on the above-mentioned ideal angular velocity, which includes:
[0117] S10, construct a mathematical model of the permanent magnet synchronous motor in the dq rotating coordinate system. The mathematical model expression of the permanent magnet synchronous motor is:
[0118]
[0119] Where: u d is the motor d-axis voltage, i d is the motor d-axis current, u q is the motor q-axis voltage, i q is the motor q-axis current, L d is the stator inductance of the motor d-axis, L q is the motor q-axis stator inductance, R is the motor stator inductance, p n is the stator resistance of the motor, J is the moment of inertia of the motor, is the permanent magnet flux of the motor, B is the magnetic damping coefficient, t is the time, T e is the electromagnetic torque of the motor, T L is the motor load torque, ω m is the motor speed, obtained based on the ideal angular velocity of claim 1.
[0120] S20, based on i d The permanent magnet synchronous motor mathematical model is processed by the magnetic field oriented control method with =0 to obtain the motor processing mathematical model.
[0121] The motor processing mathematical model expression is:
[0122]
[0123] S30, consider the lumped disturbance F to build the state variable model of the permanent magnet synchronous motor. The expression is:
[0124]
[0125] Where: x1 is the first state variable, x2 is the second state variable, is the first derivative of x2, is the first-order derivative of x1,
[0126] Specifically, S30 includes:
[0127] S301, construct the initial state variable model. The expression is:
[0128]
[0129] Where: is the reference speed of the motor.
[0130] S302, adding load disturbance, magnetic damping disturbance and permanent magnet flux disturbance to the motor processing mathematical model to obtain the motor disturbance mathematical model. The expression is:
[0131]
[0132] Where: is the permanent magnet flux disturbance, ΔT L is the load disturbance, and ΔB is the magnetic damping disturbance.
[0133] S303, the load disturbance, magnetic damping disturbance and permanent magnet flux disturbance are equivalent to a lumped disturbance F, and the motor disturbance mathematical model is substituted into the initial state variable model and derived to obtain the state variable model.
[0134] S40, a non-singular terminal sliding surface model is constructed based on the state variable model, and the expression is:
[0135]
[0136] Where: ζ is the constructed non-singular terminal sliding surface, x′1=s, s=cx1+x2 is the linear sliding surface, c is the parameter of the linear sliding surface s, β is the first sliding parameter, β>0, is the first-order derivative of x′1, p is the second parameter of the sliding mode, q is the third parameter of the sliding mode, 1<p / q<2, p and q are positive odd numbers.
[0137] S50, deriving the non-singular terminal sliding surface model to obtain a non-singular terminal sliding surface derivative model; the expression is:
[0138]
[0139] S60, will Substituting it into the derivative model of the non-singular terminal sliding surface, we get the dynamic non-singular terminal sliding surface model.
[0140] S70, Exponential Reaching Law for Constructing Dynamic Non-singular Terminal Sliding Surface Model The controller is constructed based on the exponential reaching law and the dynamic non-singular terminal sliding surface model. The expression is:
[0141]
[0142] Where: is the controller output value, is the motor q-axis input current, is the first coefficient and n is the second coefficient.
[0143] Specifically, the method for obtaining the lumped disturbance F is as follows:
[0144] The extended state observer is constructed and linearized to obtain the linearized extended state observer LESO. The expression is:
[0145]
[0146] Where: e is the observation error, z1 is y z The observed value, y z =ω m ,δ is the parameter value of Fal filter function, l1=2ω r , ω r is the bandwidth of the control system.
[0147] Specifically, a motor disturbance state variable model is constructed. The expression is:
[0148]
[0149] Where: x z1 is the intermediate parameter.
[0150] The initial extended state observer is constructed based on the motor disturbance observation model, and then linearized to obtain the initial linearized extended state observer. The expression is:
[0151]
[0152] The initial linearized extended state observer is improved based on the Fal filter function to obtain the linearized extended state observer.
[0153] The value of the lumped disturbance F is obtained based on the linearized extended state observer.
[0154] Specifically, a simulation experiment is performed to compare the method of the present invention with the existing method under the condition of adding a 500 Hz sinusoidal noise. The parameters of the dynamic non-singular terminal sliding mode controller of the present invention in the simulation are shown in Table 1.
[0155] Table 1 Parameters of dynamic non-singular terminal sliding mode controller
[0156]
[0157] The speed response curve of the control system is as follows: Figure 6 As shown, the controller output curve is as follows Figure 7 As shown, it can be seen that the method of the present invention retains the high dynamic response performance of the non-singular terminal sliding mode to a certain extent, and its response speed is similar to that of the traditional sliding mode control, with a difference of only 1ms. However, its effect of suppressing chattering is significantly better than that of the non-singular terminal sliding mode, meeting the performance requirements of the CMG control system.
[0158] The present invention also provides a permanent magnet synchronous motor control system based on the above-mentioned ideal angular velocity, which comprises:
[0159] The model building module is used to build the mathematical model of the permanent magnet synchronous motor in the dq rotating coordinate system. The mathematical model expression of the permanent magnet synchronous motor is:
[0160]
[0161] Where: u d is the motor d-axis voltage, i d is the motor d-axis current, u q is the motor q-axis voltage, i q is the motor q-axis current, L d is the stator inductance of the motor d-axis, L q is the motor q-axis stator inductance, R is the motor stator inductance, p n is the stator resistance of the motor, J is the moment of inertia of the motor, is the permanent magnet flux of the motor, B is the magnetic damping coefficient, t is the time, T e is the electromagnetic torque of the motor, T L is the motor load torque, ω m is the motor speed, obtained based on the ideal angular velocity of claim 1.
[0162] Model processing module for i-based d The permanent magnet synchronous motor mathematical model is processed by the magnetic field oriented control method with =0 to obtain the motor processing mathematical model.
[0163] The state variable module is used to construct the state variable model of the permanent magnet synchronous motor considering the lumped disturbance F; the expression is:
[0164]
[0165] Where: x1 is the first state variable, x2 is the second state variable, is the first-order derivative of x2, is the first-order derivative of x1,
[0166] The sliding surface module is used to construct a non-singular terminal sliding surface model based on the state variable model. The expression is:
[0167]
[0168] Where: ζ is the constructed non-singular terminal sliding surface, x′1=s, s=cx1+x2 is the linear sliding surface, c is the parameter of the linear sliding surface s, β is the first sliding parameter, β>0, is the first-order derivative of x′1, p is the second parameter of the sliding mode, q is the third parameter of the sliding mode, 1<p / q<2, p and q are positive odd numbers.
[0169] The derivative module is used to derive the non-singular terminal sliding surface model to obtain the derivative model of the non-singular terminal sliding surface. The expression is:
[0170]
[0171] Dynamic non-singular terminal sliding surface model module is used to convert Substituting it into the derivative model of the non-singular terminal sliding surface, we get the dynamic non-singular terminal sliding surface model.
[0172] Control module for constructing exponential reaching laws for dynamic non-singular terminal sliding surface models A controller is constructed based on the exponential reaching law and the dynamic non-singular terminal sliding surface model.
[0173] The expression is:
[0174]
[0175] Where: is the controller output value, is the motor q-axis input current, is the first coefficient and n is the second coefficient.
[0176] Specifically, the motor processing mathematical model expression is:
[0177]
[0178] Preferably, the state variable module includes:
[0179] The first state variable unit is used to construct the initial state variable model. The expression is:
[0180]
[0181] Where: is the reference speed of the motor.
[0182] The disturbance unit is used to add load disturbance, magnetic damping disturbance and permanent magnet flux disturbance to the motor processing mathematical model to obtain the motor disturbance mathematical model. The expression is:
[0183]
[0184] Where: is the permanent magnet flux disturbance, ΔT L is the load disturbance, and ΔB is the magnetic damping disturbance.
[0185] The second state variable unit is used to equate the load disturbance, magnetic damping disturbance and permanent magnet flux disturbance to a lumped disturbance F, and substitute the motor disturbance mathematical model into the initial state variable model and derive it to obtain the state variable model.
[0186] Specifically, a motor disturbance state variable model is constructed. The expression is:
[0187]
[0188] Where: x z1 is the intermediate parameter.
[0189] The initial extended state observer is constructed based on the motor disturbance observation model, and then linearized to obtain the initial linearized extended state observer. The expression is:
[0190]
[0191] The initial linearized extended state observer is improved based on the Fal filter function to obtain the linearized extended state observer. The expression is:
[0192]
[0193] Where: e is the observation error, z1 is y z The observed value, y z =ω m ,δ is the parameter value of Fal filter function, l1=2ω r , ω r is the bandwidth of the control system.
[0194] The value of the lumped disturbance F is obtained based on the linearized extended state observer.
[0195] The embodiments described above are only descriptions of the preferred implementation modes of the present invention, and are not intended to limit the scope of the present invention. Without departing from the design spirit of the present invention, various modifications and improvements made to the technical solutions of the present invention by ordinary technicians in this field should all fall within the protection scope determined by the claims of the present invention.
Claims
1. A motor angular velocity calibration method based on DESO and frequency extractor, characterized in that: It includes: Obtaining angular position information and angular velocity information output by the resolver; Constructing a discrete extended state observer DESO, and obtaining an initial ideal angular velocity based on the discrete extended state observer, the angular position information and the angular velocity information; The discrete extended state observer expression is: Where: u(t) is the initial ideal angular velocity at time t, ω raw (t) is the original angular velocity at time t, z2(t) is the estimated angular velocity error at time t, e(t) is the estimated error of the discrete extended state observer at time t, y(t) is the original angular position at time t, z1(t) is the estimated angular position at time t, z1(t-1) is the estimated angular position at time t-1, z2(t-1) is the estimated angular velocity error at time t-1, h is the integration step, u(t-1) is the initial ideal angular velocity at time t-1, β1 is the first parameter of the discrete extended state observer, e(t-1) is the estimated error of the discrete extended state observer at time t-1, β2 is the second parameter of the discrete extended state observer, m is the number of integration points, and η is the convergence rate coefficient of z2(tm) at time tm; Processing the initial ideal angular velocity based on a closed-loop transfer function of a frequency-same extractor to obtain an ideal angular velocity; The expression is: ω(t)=u(t)×H(t); Where: ω(t) is the ideal angular velocity at time t, H(t) is the transfer function at time t, when u(t) = ω0, H(t) = 1, when u(t) ≠ ω0, ω0 is the fundamental frequency of the initial ideal angular velocity, j is the imaginary unit, and ε is the coefficient of the same frequency extractor.
2. A permanent magnet synchronous motor control method based on the ideal angular velocity of claim 1, characterized in that: It includes: A mathematical model of a permanent magnet synchronous motor in a dq rotating coordinate system is constructed; the mathematical model expression of the permanent magnet synchronous motor is: Where: u d is the motor d-axis voltage, i d is the motor d-axis current, u q is the motor q-axis voltage, i q is the motor q-axis current, L d is the stator inductance of the motor d-axis, L q is the motor q-axis stator inductance, R is the motor stator inductance, p n is the stator resistance of the motor, J is the moment of inertia of the motor, is the permanent magnet flux of the motor, B is the magnetic damping coefficient, t is the time, T e is the electromagnetic torque of the motor, T L is the motor load torque, ω m is the motor speed, obtained based on the ideal angular velocity of claim 1; Based on i d =0 to process the permanent magnet synchronous motor mathematical model to obtain a motor processing mathematical model; Considering the lumped disturbance F, the state variable model of the permanent magnet synchronous motor is constructed; the expression is: Where: x1 is the first state variable, x2 is the second state variable, is the first derivative of x2, is the first-order derivative of x1, A non-singular terminal sliding surface model is constructed based on the state variable model, and the expression is: Where: ζ is the constructed non-singular terminal sliding surface, x′1=s, s=cx1+x2 is the linear sliding surface, c is the parameter of the linear sliding surface s, β is the first sliding parameter, β>0, is the first-order derivative of x′1, p is the second parameter of the sliding mode, q is the third parameter of the sliding mode, 1<p / q<2, p and q are positive odd numbers; The non-singular terminal sliding surface model is derived to obtain a non-singular terminal sliding surface derivative model; the expression is: Will Substituting into the non-singular terminal sliding surface derivative model, a dynamic non-singular terminal sliding surface model is obtained; Constructing the exponential reaching law of the dynamic non-singular terminal sliding surface model A controller is constructed based on the exponential reaching law and the dynamic non-singular terminal sliding surface model, and the expression is: Where: is the controller output value, is the motor q-axis input current, is the first coefficient and n is the second coefficient.
3. The permanent magnet synchronous motor control method of the ideal angular velocity according to claim 2, characterized in that: The motor processing mathematical model expression is:
4. The permanent magnet synchronous motor control method of the ideal angular velocity according to claim 2, characterized in that: Considering the lumped disturbance F, the state variable model of the permanent magnet synchronous motor is constructed, including: Construct the initial state variable model; the expression is: Where: is the reference speed of the motor; The load disturbance, magnetic damping disturbance and permanent magnet flux disturbance are added to the motor processing mathematical model to obtain the motor disturbance mathematical model; the expression is: Where: is the permanent magnet flux disturbance, ΔT L is the load disturbance, ΔB is the magnetic damping disturbance; The load disturbance, magnetic damping disturbance and permanent magnet flux disturbance are equivalent to a lumped disturbance F, and the motor disturbance mathematical model is substituted into the initial state variable model and derived to obtain the state variable model.
5. The permanent magnet synchronous motor control method of ideal angular velocity according to claim 2, characterized in that: An extended state observer is constructed and linearized to obtain a linearized extended state observer; a lumped disturbance F is obtained based on the linearized extended state observer; The linearized extended state observer expression is: Where: e is the observation error, z1 is y z The observed value, y z =ω m ,δ is the parameter value of Fal filter function, l1=2ω r , ω r is the bandwidth of the control system.
6. The permanent magnet synchronous motor control method of ideal angular velocity according to claim 5, characterized in that: Construct the motor disturbance state variable model; the expression is: Where: x z1 is the intermediate parameter; An initial extended state observer is constructed based on the motor disturbance observation model and linearized to obtain an initial linearized extended state observer, which is expressed as: The initial linearized extended state observer is improved based on the Fal filter function to obtain the linearized extended state observer.
7. A permanent magnet synchronous motor control system based on the ideal angular velocity as claimed in claim 1, characterized in that: It includes: The model building module is used to build a mathematical model of the permanent magnet synchronous motor in a dq rotating coordinate system; the mathematical model expression of the permanent magnet synchronous motor is: Where: u d is the motor d-axis voltage, i d is the motor d-axis current, u q is the motor q-axis voltage, i q is the motor q-axis current, L d is the stator inductance of the motor d-axis, L q is the motor q-axis stator inductance, R is the motor stator inductance, p n is the stator resistance of the motor, J is the moment of inertia of the motor, is the permanent magnet flux of the motor, B is the magnetic damping coefficient, t is the time, T e is the electromagnetic torque of the motor, T L is the motor load torque, ω m is the motor speed, obtained based on the ideal angular velocity of claim 1; Model processing module for i-based d =0 to process the permanent magnet synchronous motor mathematical model to obtain a motor processing mathematical model; The state variable module is used to construct the state variable model of the permanent magnet synchronous motor considering the lumped disturbance F; the expression is: Where: x1 is the first state variable, x2 is the second state variable, is the first derivative of x2, is the first-order derivative of x1, The sliding surface module is used to construct a non-singular terminal sliding surface model based on the state variable model, and the expression is: Where: ζ is the constructed non-singular terminal sliding surface, x′1=s, s=cx1+x2 is the linear sliding surface, c is the parameter of the linear sliding surface s, β is the first sliding parameter, β>0, is the first-order derivative of x′1, p is the second parameter of the sliding mode, q is the third parameter of the sliding mode, 1<p / q<2, p and q are positive odd numbers; The derivation module is used to derive the non-singular terminal sliding surface model to obtain a non-singular terminal sliding surface derivative model; the expression is: Dynamic non-singular terminal sliding surface model module is used to convert Substituting into the non-singular terminal sliding surface derivative model, a dynamic non-singular terminal sliding surface model is obtained; A control module for constructing an exponential reaching law of the dynamic non-singular terminal sliding surface model A controller is constructed based on the exponential reaching law and the dynamic non-singular terminal sliding surface model, and the expression is: Where: is the controller output value, is the motor q-axis input current, is the first coefficient and n is the second coefficient.
8. The permanent magnet synchronous motor control system with ideal angular velocity according to claim 7, characterized in that: The motor processing mathematical model expression is:
9. The permanent magnet synchronous motor control system with ideal angular velocity according to claim 7, characterized in that: The state variable module includes: The first state variable unit is used to construct the initial state variable model; the expression is: Where: is the reference speed of the motor; The disturbance unit is used to add load disturbance, magnetic damping disturbance and permanent magnet flux disturbance to the motor processing mathematical model to obtain the motor disturbance mathematical model; the expression is: Where: is the permanent magnet flux disturbance, ΔT L is the load disturbance, ΔB is the magnetic damping disturbance; The second state variable unit is used to equate the load disturbance, magnetic damping disturbance and permanent magnet flux disturbance to a lumped disturbance F, and substitute the motor disturbance mathematical model into the initial state variable model and derive it to obtain the state variable model.
10. The permanent magnet synchronous motor control system with ideal angular velocity according to claim 2, characterized in that: Construct the motor disturbance state variable model; the expression is: Where: x z1 is the intermediate parameter; An initial extended state observer is constructed based on the motor disturbance observation model and linearized to obtain an initial linearized extended state observer, which is expressed as: The initial linearized extended state observer is improved based on the Fal filter function to obtain the linearized extended state observer; the expression is: Where: e is the observation error, z1 is y z The observed value, y z =ω m ,δ is the parameter value of Fal filter function, l1=2ω r , ω r is the bandwidth of the control system; The value of the lumped disturbance F is obtained based on the linearized extended state observer.
Citation Information
Patent Citations
Self-correcting method of gyro frame rotary transformer shaft angle decoding system
CN113848717A
Permanent magnet synchronous motor position control method based on improved sliding mode control
CN114244214A
PMSM current harmonic suppression system and method using complex coefficient filter
CN117081455A
Servo control strategy and system for simultaneously eliminating counter-electromagnetic force (CEMF) and load torque disturbances
US20190222155A1
Cited By
Permanent magnet synchronous motor rotating speed control method based on composite sliding mode control
CN121966377A
