A robust motor control method based on an unknown dynamic estimator
By adopting a robust motor control method based on an unknown dynamic estimator and a symbolic integral controller, the problem of numerous motor debugging parameters is solved, and the tracking performance and robustness of the motor are improved.
Patent Information
- Application Number
- CN202611177953.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2026-08-05
- Publication Date
- 2026-11-17
AI Technical Summary
Existing motor control methods have too many parameters when dealing with unknown dynamic characteristics, making debugging difficult and affecting motor tracking performance.
A robust control method based on an unknown dynamic estimator is adopted. By constructing an unknown dynamic auxiliary variable and a symbolic integral controller, the unknown dynamic characteristics are compensated and the tracking performance is improved.
While ensuring high tracking performance, the number of debugging parameters has been reduced, the parameter debugging process has been simplified, and the robustness and tracking performance of motor control have been improved.
Smart Images

Figure CN123122333A_ABST
Abstract
Description
Technical Field
[0001] This invention belongs to the field of servo control, specifically relating to a robust motor control method based on an unknown dynamic estimator. Background Technology
[0002] As the actuators for flight attitude control in aircraft, the motor's tracking performance directly impacts the aircraft's attitude control performance. Motor control methods are the core of achieving high-performance command tracking. With the increasing demands on motor tracking performance from various aircraft, the impact of various unknown dynamic characteristics of the motor, such as friction, backlash, and external disturbances, on tracking performance is becoming increasingly prominent. Currently, unknown dynamic characteristics are generally handled using adaptive control or neural network control methods. However, existing methods suffer from problems such as excessive parameters and difficulties in debugging. Summary of the Invention
[0003] (a) Technical problems to be solved The technical problem to be solved by this invention is to provide a robust motor control method based on an unknown dynamic estimator, which has high tracking performance while requiring fewer parameters to be adjusted.
[0004] (II) Technical Solution To address the aforementioned technical problems, this invention provides a robust motor control method based on an unknown dynamic estimator, comprising the following steps: S1: Establish the motor model and friction force model; S2: Construct unknown dynamic auxiliary variables; S3: Reconstruct the motor model in step S1 into a state-space form; S4: Perform first-order filtering on the speed signal; S5: Construct an unknown dynamic estimator and track command signals; S6: Construct tracking error; S7: Construct two auxiliary variables and build a symbolic integral controller based on the auxiliary variables; S8: Calculate the control quantity.
[0005] S1 specifically includes the following steps: S11: Establish the motor model; The motor model in S11 is described by a second-order differential equation, the specific expression of which is as follows: in, For rotational inertia, The damping coefficient is... To control the quantity, The angle of rotation of the motor. and These are the acceleration and velocity of the motor's rotation, respectively. For friction, It is a collection of external disturbances and uncertainties; S12: Establish a friction force model; The friction force model in S2 is described by the following formula: in, : : : : : These are coefficients in the friction model, all of which are positive constants. It is the hyperbolic tangent function.
[0006] The unknown dynamic auxiliary variable in S2 is described by the following formula: in, The constructed unknown dynamic auxiliary variable represents the set of all disturbances and uncertainties in the model.
[0007] In step S3, the motor model from step S1 is reconstructed to obtain the model in the following state-space form: in , represents the angle of rotation of the motor. for The derivative of is the angular velocity of the motor rotation, expressed as . express, for The derivative of represents the angular acceleration of the motor during rotation.
[0008] angular velocity in S4 and control quantity Perform first-order filtering according to the following formula: in, For a first-order transfer function, These are the positive coefficients in the transfer function. For the Laplace operator, For speed signal The signal generated after filtering This is the signal generated after filtering the control quantity u.
[0009] S5 specifically includes the following steps: S51: Construct the unknown dynamic estimator as follows: in, The external disturbance is calculated using an unknown dynamic estimator; S52: Construct the trace command signal and denote it as .
[0010] S6 specifically includes the following steps: S61: Let the tracking error be... Calculate according to the following formula: S62: Calculate tracking error The differential is denoted as .
[0011] S7 specifically includes the following steps: S71: Construct two auxiliary variables as follows: in, , These are the auxiliary variables that were constructed. and A positive constant; S72: Construct the symbolic integral controller as follows: in, A positive constant. A positive constant. Represents time 0 Integral at time step, Represents the differential symbol.
[0012] The control quantity in S8 is calculated according to the following formula. ; .
[0013] A servo motor is equipped with a motor execution program, which calculates a control quantity u when triggered by a processor.
[0014] (III) Beneficial Effects Compared with the prior art, the present invention has the following beneficial effects: 1) This invention introduces an unknown dynamic estimator to compensate for various unknown dynamic characteristics in the motor, which can improve the control performance of the motor.
[0015] 2) The motor control method provided by this invention requires fewer parameters to be adjusted while ensuring high tracking performance, which greatly reduces the difficulty of parameter adjustment. Attached Figure Description
[0016] Figure 1 Here is a block diagram of a robust motor control method based on an unknown dynamic estimator; Figure 2 This is a flowchart of a robust motor control method based on an unknown dynamic estimator. Detailed Implementation
[0017] To make the objectives, contents, and advantages of the present invention clearer, the specific embodiments of the present invention will be described in further detail below with reference to the accompanying drawings and examples.
[0018] Example 1 This embodiment provides a robust motor control method based on an unknown dynamic estimator, including the following steps: S1: Establish the motor model and friction force model; S2: Construct unknown dynamic auxiliary variables; S3: Reconstruct the motor model in step S1 into a state-space form; S4: Perform first-order filtering on the speed signal; S5: Construct an unknown dynamic estimator and track command signals; S6: Construct tracking error; S7: Construct two auxiliary variables and build a symbolic integral controller based on the auxiliary variables; S8: Calculate the control quantity.
[0019] S1 specifically includes the following steps: S11: Establish the motor model; The motor model in S11 is described by a second-order differential equation, the specific expression of which is as follows: in, For rotational inertia, The damping coefficient is... To control the quantity, The angle of rotation of the motor. and These are the acceleration and velocity of the motor's rotation, respectively. For friction, It is a collection of external disturbances and uncertainties; S12: Establish a friction force model; The friction force model in S2 is described by the following formula: in, : : : : : These are coefficients in the friction model, all of which are positive constants. It is the hyperbolic tangent function.
[0020] The unknown dynamic auxiliary variable in S2 is described by the following formula: in, The constructed unknown dynamic auxiliary variable represents the set of all disturbances and uncertainties in the model.
[0021] In step S3, the motor model from step S1 is reconstructed to obtain the model in the following state-space form: in , represents the angle of rotation of the motor. for The derivative of is the angular velocity of the motor rotation, expressed as . express, for The derivative of represents the angular acceleration of the motor during rotation.
[0022] angular velocity in S4 and control quantity Perform first-order filtering according to the following formula: in, For a first-order transfer function, These are the positive coefficients in the transfer function. For the Laplace operator, For speed signal The signal generated after filtering This is the signal generated after filtering the control quantity u.
[0023] S5 specifically includes the following steps: S51: Construct the unknown dynamic estimator as follows: in, The external disturbance is calculated using an unknown dynamic estimator; S52: Construct the trace command signal and denote it as .
[0024] S6 specifically includes the following steps: S61: Let the tracking error be... Calculate according to the following formula: S62: Calculate tracking error The differential is denoted as .
[0025] S7 specifically includes the following steps: S71: Construct two auxiliary variables as follows: in, , These are the auxiliary variables that were constructed. and A positive constant; S72: Construct the symbolic integral controller as follows: in, A positive constant. A positive constant. Represents time 0 Integral at time step, Represents the differential symbol.
[0026] The control quantity in S8 is calculated according to the following formula. ; .
[0027] A servo motor is equipped with a motor execution program, which calculates a control quantity u when triggered by a processor.
[0028] Example 2 like Figures 1-2 As shown, the controller of the method provided by this invention mainly comprises two parts: an unknown dynamic estimator and a symbolic integral controller. The output of the unknown dynamic estimator is an estimate of all unknown dynamic characteristics in the system. The impact of all unknown dynamic characteristics on tracking performance is ultimately reflected in the disturbance force. If the disturbance force can be estimated and compensated for through control input, the tracking performance of the motor system can be improved. The symbolic integral controller consists of a proportional-derivative feedback term and a symbolic integral term. The proportional-derivative feedback term stabilizes the feedback system and provides a certain degree of robustness. The symbolic integral term compensates for factors that the unknown dynamic estimator cannot compensate for, thereby further improving the tracking performance.
[0029] The specific steps are as follows: First, a second-order differential equation model of the motor system is established, which consists of acceleration terms, velocity terms, control terms, friction terms, and external disturbance terms. Furthermore, a friction force model is established, and the established friction force model is substituted into the established motor system model; Furthermore, construct unknown dynamic auxiliary variables. Various disturbances and other factors existing in the motor system are included in an auxiliary variable. In the middle. Based on the constructed auxiliary variables In subsequent steps, an unknown dynamic estimator is built for... Make an estimate.
[0030] Furthermore, the established motor model is reconstructed, transforming it from a second-order differential equation into a system of differential equations consisting of two first-order differential equations. Furthermore, regarding the speed signal and control quantity The process is performed using a first-order low-pass filter.
[0031] Furthermore, utilizing speed signals and the speed signal after first-order low-pass filtering and control quantity Constructing an unknown dynamic estimator is as follows: Furthermore, construct the instruction signals that need to be tracked; Furthermore, construct the tracking error. Further, calculate the tracking error. The differential; Furthermore, a symbolic integral robust controller is constructed; Next, the control quantity is calculated. This control quantity consists of two parts: the output of the unknown dynamic estimator and the output of the symbolic integral robust controller.
[0032] The above description is only a preferred embodiment of the present invention. It should be noted that for those skilled in the art, several improvements and modifications can be made without departing from the technical principles of the present invention, and these improvements and modifications should also be considered within the scope of protection of the present invention.
Claims
1. A robust control method for an electric machine based on an unknown dynamic estimator, characterized in that, Includes the following steps: S1: Establish the motor model and friction force model; S2: Construct unknown dynamic auxiliary variables; S3: Reconstruct the motor model in step S1 into a state-space form; S4: Perform first-order filtering on the speed signal; S5: Construct an unknown dynamic estimator and track command signals; S6: Construct tracking error; S7: Construct two auxiliary variables and build a symbolic integral controller based on the auxiliary variables; S8: Calculate the control quantity.
2. The robust control method of an electric motor based on an unknown dynamic estimator as claimed in claim 1, characterized in that, S1 specifically includes the following steps: S11: Establish the motor model; The motor model in S11 is described by a second-order differential equation, the specific expression of which is as follows: wherein, is the moment of inertia, is the damping coefficient, is the control quantity, is the angle of rotation of the motor, and are the acceleration and speed of rotation of the motor, respectively, is the friction, is the set of external disturbances and uncertainties; S12: Establish a friction force model; The friction force model in S2 is described by the following formula: wherein : : : : : is a coefficient in the friction model, all positive constants, is a hyperbolic tangent function.
3. The robust control method of an electric motor based on an unknown dynamic estimator as claimed in claim 2, characterized in that, The unknown dynamic auxiliary variable in S2 is described by the following formula: where, is the constructed unknown dynamic auxiliary variable, representing the set of all disturbances and uncertainties in the model.
4. The robust motor control method based on an unknown dynamic estimator according to claim 3, characterized in that, In step S3, the motor model from step S1 is reconstructed to obtain the model in the following state-space form: in , represents the angle of rotation of the motor. for The derivative of is the angular velocity of the motor rotation, expressed as . express, for The derivative of represents the angular acceleration of the motor during rotation.
5. The robust motor control method based on an unknown dynamic estimator as described in claim 4, characterized in that, the diagonal velocity in S4 and the control quantity is filtered in a first order filter according to in, For a first-order transfer function, These are the positive coefficients in the transfer function. For the Laplace operator, For speed signal The signal generated after filtering This is the signal generated after filtering the control quantity u.
6. The method of claim 5, wherein the unknown dynamic estimator-based robust control of the motor is based on a model of the motor. S5 specifically includes the following steps: S51: Construct the unknown dynamic estimator as follows: wherein, is the external disturbance calculated by the unknown dynamic estimator; S52: Construct a tracking instruction signal, and mark it as .
7. The method of claim 6, wherein the unknown dynamic estimator-based robust control of the motor is based on a model of the motor. S6 specifically includes the following steps: S61: record the tracking error as , calculated as follows: S62: Calculate tracking error of the derivative of the error, denoted by .
8. The method of claim 7, wherein the unknown dynamic estimator-based robust control of electric machines is characterized by, S7 specifically includes the following steps: S71: Construct two auxiliary variables as follows: wherein , are the constructed auxiliary variables, and are positive constants; S72: Construct the symbolic integral controller as follows: in, A positive constant. A positive constant. Represents time 0 Integral at time step, Represents the differential symbol.
9. The method of claim 8, wherein the unknown dynamic estimator-based robust control of electric machines is characterized by, The control amount in S8 is calculated according to the following formula ; 。 10. A servo motor, equipped with a motor execution program, characterized in that, When the execution program is triggered by the processor, it implements the steps of the method as described in claim 9 to complete the calculation of the control quantity u.
