Design method of linear motor state feedback controller and state feedback controller

By designing a linear motor state feedback controller, using preset performance functions and PMLSM dynamic model, the difficulty of tracking error quantization and nonlinear disturbance processing of traditional controllers under complex operating conditions is solved, and the effective high-precision motion control is achieved Responsive and robust.

CN118920936APending Publication Date: 2024-11-08HEBEI UNIV OF TECH
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202410981380.5
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-22
Publication Date
2024-11-08

AI Technical Summary

Technical Problem

Traditional linear motor state feedback controllers are difficult to deal with tracking error quantization and nonlinear perturbations in complex working conditions, resulting in insufficient response speed and robustness, which cannot meet the needs of industrial high-precision motion control.

Method used

A method of linear motor state feedback controller is designed. By obtaining the status data output by the feedback module, calculating error variables, and constructing a preset performance control module and a nonlinear control module based on the preset performance function, using the PMLSM dynamic model. Establish a second-order state space equation, calculate the virtual control rate, and design a nonlinear control module to overcome the shortcomings of traditional controllers.

Benefits of technology

It realizes the reduction of error overshoot in a limited time, ensures the controllability and robustness of tracking errors, improves dynamic response and convergence performance, and meets the high-precision motion control requirements under complex operating conditions.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118920936A_ABST
    Figure CN118920936A_ABST
Patent Text Reader

Abstract

The invention discloses a design method of a linear motor state feedback controller and the state feedback controller, and relates to the technical field of motor control design. The method comprises the following steps: acquiring first state data and second state data output by a linear motor feedback module, calculating to obtain a first state error variable, and defining a second state error variable based on the second state data; constraining the first state error variable through a preset performance function to construct a preset performance control module of the state feedback controller; performing error conversion on the first state error variable based on equality constraints and a conversion error function to obtain a first conversion error variable; and based on the first conversion error variable and the second state error variable, constructing a nonlinear control module of the state feedback controller by using a PMLSM kinetic model so as to design and obtain the state feedback controller. Through the design method, the required state feedback controller suitable for more complex working conditions can be obtained.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present disclosure generally relates to the field of motor control technology, and in particular to a design method for a linear motor state feedback controller and a state feedback controller. Background Art

[0002] Permanent magnet synchronous linear motors are widely used in automation equipment, CNC machine tools, medical equipment, elevators, rail transportation and other fields due to their advantages of high efficiency, high power density, fast dynamic response and precise positioning. High-speed and high-precision motion platforms commonly used in industry can achieve fast and accurate positioning and movement, which helps to improve the production efficiency and production speed of production lines. The development of some emerging application fields is also promoting the advancement of precision motion control technology.

[0003] The widespread application of precision machining has led to increasing requirements for servo control of linear motors in industry. In the design process of linear motor state feedback controller, there are problems such as inaccurate model parameters, difficulty in modeling and compensating for nonlinear friction, cogging force and end effect during motion. At the same time, traditional control methods are difficult to handle strong nonlinear disturbances and do not have the function of quantitatively limiting following errors. As a result, performance indicators such as following error and response speed in the control process often cannot meet actual needs. Therefore, a state feedback controller with better performance is needed.

[0004] Advanced control theory is a control theory based on state space. It generally has better control effects than conventional control, can improve process control quality, and solve more complex control problems. Currently, commonly used state feedback controllers include sliding film controllers, backstepping controllers, adaptive controllers, etc. Traditional backstepping controllers are simple to design and have good dynamic response when dealing with systems below the second order. However, it is difficult for this controller to quantify the tracking error and achieve convergence within a limited time. Therefore, it is necessary to propose a design method for a line motor state feedback controller to meet the needs of more complex working conditions. Summary of the invention

[0005] In view of the above-mentioned defects or deficiencies in the prior art, it is desirable to provide a design method for a linear motor state feedback controller and a state feedback controller.

[0006] In a first aspect, the present application provides a design method for a linear motor state feedback controller, the method comprising the following steps:

[0007] Acquire first state data and second state data output by a linear motor feedback module, calculate a first state error variable, and define a second state error variable based on the second state data;

[0008] Constraining the first state error variable by a preset performance function to construct a preset performance control module of the state feedback controller;

[0009] Performing error conversion on the first state error variable based on a conversion error function to obtain a first conversion error variable;

[0010] Based on the first conversion error variable and the second state error variable, a nonlinear control module of the state feedback controller is constructed using a PMLSM dynamics model to design the state feedback controller.

[0011] According to the technical solution provided by the present application, the first state data and the second state data output by the linear motor feedback module are obtained, a first state error variable is calculated, and a second state error variable is defined based on the second state data, specifically including:

[0012] Controlling the linear motor to run according to a preset trajectory, and acquiring the first state data and the second state data;

[0013] The first state error variable is calculated based on the first state data and the standard data corresponding to the preset trajectory, and the second state error variable is defined based on the second state data;

[0014] According to the technical solution provided by the present application, the first state error variable is constrained by a preset performance function to construct a preset performance control module of the state feedback controller, which specifically includes:

[0015] Setting an error range for the first state error variable and the preset performance function;

[0016] Performing data processing based on the error range and the preset performance function to obtain the conversion error function;

[0017] The preset performance control module is designed based on the conversion error function.

[0018] According to the technical solution provided by the present application, based on the first conversion error variable and the second state error variable, a nonlinear control module of the state feedback controller is constructed using the PMLSM dynamic model, specifically including:

[0019] Establishing the second-order dynamic equation of the linear motor and converting it into a second-order state space equation;

[0020] Calculating a first-level virtual control rate according to the first conversion error variable, the second state error variable and the second-order state space equation;

[0021] Based on the first-level virtual control rate and the preset stability condition, a second-level virtual control rate is calculated;

[0022] The nonlinear control module is designed with the second-level virtual control rate.

[0023] According to the technical solution provided by the present application, the inequality constraint corresponding to the error range is as follows:

[0024]

[0025] - δ ρ(t) represents the lower bound of the error; It is represented as the upper bound of error; e(t) is represented as the state error variable;

[0026] Performing data processing based on the error range and the preset performance function to obtain the conversion error function specifically includes:

[0027] The error range is converted into an equality constraint form and normalized to obtain the converted error function.

[0028] According to the technical solution provided in the present application, the established second-order dynamic equation of the linear motor is the second-order dynamic equation of the linear motor including nonlinear friction disturbance;

[0029] The second-order kinetic equation is as follows:

[0030]

[0031] Among them, x1 is the displacement, x2 is the velocity, and are the derivative functions of x1 and x2 respectively, u is the virtual control quantity, F f is other friction force, K f is the thrust constant and B is the viscous friction coefficient.

[0032] In a second aspect, the present application provides a linear motor state feedback controller, wherein the state feedback controller applies the above-mentioned linear motor state feedback controller design method;

[0033] The state feedback controller at least includes: the preset performance control module and the nonlinear control module; the state feedback controller is connected to the linear motor through a current loop and a modulation drive module.

[0034] According to the technical solution provided by the present application, the current loop includes a signal processing controller and a PI controller;

[0035] The current loop takes the control amount of the q-axis current of the linear motor as input, outputs the q-axis voltage control amount through the signal processing controller, and limits the q-axis voltage control amount;

[0036] The PI controller is used to output the d-axis voltage control amount of the linear motor;

[0037] The q-axis voltage control amount and the d-axis voltage control amount output inverter switching signals through the modulation drive module, thereby obtaining the three-phase voltage required for the servo operation of the linear motor.

[0038] In summary, the technical solution specifically discloses a design method of a linear motor state feedback controller and a state feedback controller. The design method includes: obtaining the first state data and the second state data output by the linear motor feedback module, calculating the first state error variable, and defining the second state error variable based on the second state data; constraining the first state error variable by a preset performance function to construct a preset performance control module of the state feedback controller; performing error conversion on the first state error variable based on the conversion error function to obtain a first conversion error variable; based on the first conversion error variable and the second state error variable, using the PMLSM dynamic model to construct a nonlinear control module of the state feedback controller to design a state feedback controller.

[0039] The existing traditional backstepping controller has a simple design and good dynamic response when processing systems below the second order, but it is difficult for the controller to quantify the tracking error and achieve convergence within a finite time. The present application first presets a performance function to constrain the actual tracking error and obtains a preset performance control module; at the same time, the corresponding error conversion is performed through the preset performance control module, and finally a nonlinear control module is constructed with the converted error to overcome the defects of traditional linear motors that cannot quantify the tracking error and have poor robustness to nonlinear interference. BRIEF DESCRIPTION OF THE DRAWINGS

[0040] Other features, objects and advantages of the present application will become more apparent by reading the detailed description of non-limiting embodiments made with reference to the following drawings:

[0041] Figure 1 Schematic diagram of the design method flow of the linear motor state feedback controller.

[0042] Figure 2 This is an expanded flow chart of step S100 in the design method of a linear motor state feedback controller.

[0043] Figure 3 This is an expanded flow chart of step S200 in the design method of the linear motor state feedback controller.

[0044] Figure 4 This is an expanded flow chart of step S202 in the design method of the linear motor state feedback controller.

[0045] Figure 5 This is an expanded flow chart of step S400 in the design method of a linear motor state feedback controller.

[0046] Figure 6 The performance comparison between the preset performance function of the linear motor state feedback controller and the preset performance function of the general form is shown.

[0047] Figure 7 This is the control principle block diagram of the linear motor state feedback controller.

[0048] Figure 8 This is the control principle block diagram of the traditional backstepping controller of PMLSM.

[0049] Fig. 9 This is the control principle block diagram of the PMLSM dual closed-loop PI controller.

[0050] Fig.10 This is a comparison chart of the simulation effects of linear motor displacement error when using three types of controllers.

[0051] Fig.11 This is a control program structure diagram of an example of the present invention applied in a motion control platform;

[0052] Fig.12 The position, velocity and acceleration images of the T-type excitation signal used in the simulation and experiment of the embodiment of the present invention;

[0053] Fig.13 The comparison diagram of the displacement error experimental effect of the linear motor when the control method (PPBC) of the present invention, the back-stepping control method (BSC) and the PI double closed-loop control method are adopted respectively; DETAILED DESCRIPTION

[0054] The present application is further described in detail below in conjunction with the accompanying drawings and embodiments. It is to be understood that the specific embodiments described herein are only used to explain the relevant invention, rather than to limit the invention. It is also necessary to explain that, for ease of description, only the parts related to the invention are shown in the accompanying drawings.

[0055] It should be noted that, in the absence of conflict, the embodiments and features in the embodiments of the present application can be combined with each other. The present application will be described in detail below with reference to the accompanying drawings and in combination with the embodiments.

[0056] Example 1

[0057] In order to make the technical solution of the embodiment of the present application clearer and easier to understand, the application background of the embodiment of the present application is introduced below.

[0058] The widespread application of precision machining has led to increasing requirements for servo control of linear motors in industry. In the design process of linear motor state feedback controller, there are problems such as inaccurate model parameters, difficulty in modeling and compensating for nonlinear friction, cogging force and end effect during motion. At the same time, traditional control methods are difficult to handle strong nonlinear disturbances and do not have the function of quantitatively limiting following errors. As a result, performance indicators such as following error and response speed in the control process often cannot meet actual needs. Therefore, a state feedback controller with better performance is needed.

[0059] Commonly used state feedback controllers include sliding film controllers, backstepping controllers, adaptive controllers, etc. Traditional backstepping controllers are simple to design and have good dynamic response when dealing with systems below the second order. However, it is difficult for this controller to quantify the tracking error and achieve convergence within a limited time.

[0060] In view of this, an embodiment of the present application proposes a design method for a linear motor state feedback controller, which can ensure that the displacement following error of the linear motor meets the preset performance constraints during the driving process, effectively reduce the error overshoot, and can converge within a limited time, and has a certain robustness in the presence of nonlinear interference. It overcomes the defects of traditional linear motors that they cannot quantize the tracking error and have poor robustness to nonlinear interference, and ensures good dynamic response and convergence while making the tracking error controllable.

[0061] Please refer to Figure 1 and Figure 2 The schematic diagram of the design method of the linear motor state feedback controller provided in this embodiment and the expanded flowchart of step S100 are shown, and the method includes the following steps:

[0062] S100, acquiring first state data and second state data output by a linear motor feedback module, calculating a first state error variable, and defining a second state error variable based on the second state data;

[0063] Specifically, the first state data and the second state data may respectively refer to the position value and the speed value at each moment when the linear motor is driven;

[0064] Among them, the linear motor feedback module includes a position sensor and a current sensor. The position sensor can directly collect the actual position value, and the actual speed value can be obtained by differentiating the position sensor with a unit system step.

[0065] The first state error variable and the second state error variable are respectively used to refer to the error between a given position standard value and the first state data and the error between a given speed standard value and the second state data, which can also be called following error, or further defined as position following error and speed following error.

[0066] Furthermore, in some preferred embodiments, step S100 is expanded to include the following steps:

[0067] S101, controlling the linear motor to run according to a preset trajectory, and obtaining first state data and second state data;

[0068] In actual application, the preset trajectory selected here is the T-type motion trajectory. By inputting the selected preset trajectory into the servo control system of the linear motor, the linear motor can be controlled to run according to the preset trajectory. At this time, the linear motor feedback module can output the first state data and the second state data generated by the linear motor under the T-type motion trajectory.

[0069] It should be explained that this motion trajectory (T-type motion trajectory) is a commonly used motion form in linear motor servo systems. It is a time-optimal curve that can achieve smooth switching of speeds in different acceleration and deceleration stages.

[0070] S102: Calculate a first state error variable based on the first state data and standard data corresponding to a preset trajectory, and define a second state error variable based on the second state data.

[0071] By calculating the difference between the standard data corresponding to the preset trajectory and the obtained first state data, the first state error variable can be obtained and the second state error variable can be defined.

[0072] Here is an example, for example, the value x is obtained from the standard data d , and the first state data obtained at time t is x, and the corresponding first state error variable here is x d The difference between x and x can be recorded as e1. The second state error variable can be defined as the difference between the standard data and the second state data, which can be recorded as e2. In the embodiment of the present application, the standard data corresponding to the second state data can be obtained by other modules. Specifically, with respect to the second state error variable, the standard data α1 corresponding to the second state variable can be obtained by the nonlinear control module. The second state error variable is defined as the difference between the second state variable and its standard variable, that is, e2=α1-v.

[0073] like Figure 3 As shown, S200, constraining the first state error variable by a preset performance function to construct a preset performance control module of the state feedback controller;

[0074] The main function of the preset performance control module in the state feedback controller is to limit the position error. Therefore, when designing the preset performance control module, it is necessary to limit the position error according to the process requirements to improve the control effect of the state feedback controller.

[0075] Furthermore, in some preferred embodiments, step S200 is expanded to include the following steps:

[0076] S201, setting an error range corresponding to a first state error variable and a preset performance function;

[0077] First, it is necessary to constrain the first-state error variable according to the process requirements and set a specific constraint range; the error range needs to be based on the system's expected convergence speed and overshoot size, design the parameters of the preset performance function, and then determine the preset envelope boundary. In this way, the error range is obtained according to the preset envelope boundary, which can make the first-state error variable change within the constraint boundary of the error range.

[0078] Specifically, in practical applications, the inequality constraint corresponding to the error range is as follows:

[0079]

[0080] - δ ρ(t) represents the lower bound of the error; It is expressed as the upper bound of error; e(t) represents the state error variable;

[0081] like Figure 6 As shown, the preset performance function is designed as follows:

[0082]

[0083] Where ρ(t) is the preset performance function; a0, a1, a2 are the parameters to be designed; ρ0 is the initial value of the function, ρ ∞ is the infinite value of the function, and T0 is the stabilization time.

[0084] Furthermore, a0, a1, and a2 can be designed by the following formula (4):

[0085]

[0086] S202, performing data processing based on the error range and the preset performance function to obtain a conversion error function;

[0087] After designing the upper and lower bounds of the error range inequality constraint according to actual needs and designing the preset performance function ρ(t), the original error needs to be transformed into a conversion error that has a bijective relationship with the original error, and then the quantitative control of the following error is realized, such as Figure 6 As shown, the preset performance function set in the embodiment of the present application is Figure 6 By comparing the improved preset function in , it can be seen that the improved preset function can achieve the convergence of the following error within a finite time, thereby enhancing the controllability of the following error.

[0088] like Figure 4 As shown, specifically, step S202 further includes the following steps:

[0089] S2021. Convert the error range into an equation constraint form and perform normalization processing to obtain a converted error function.

[0090] Convert the inequality constraint formula (1) corresponding to the error range into the equality constraint e i (t), the error range under the equality constraint is normalized and the normalized error S(ε i ) is converted into an error ε on R i , and finally obtain the equality constraint e shown in the following formula (5): i (t) and the conversion error ε i .

[0091]

[0092] Among them, ε i It is expressed as the transformation error, which has a smooth, strictly monotonically increasing transformation bijective relationship with the original error e(t); the original error here can also be understood as the calculated state error variable, and the transformed error ε(t)∈(-∞,+∞), that is, the nonlinear system after using the transformed error is unconstrained.

[0093] S203, obtaining a preset performance control module by using the conversion error function and the equality constraint design.

[0094] Based on the conversion error ε in formula (5) i It has the characteristics of smooth, strictly monotonically increasing and inverse transformation. In practical applications, the conversion error function is as follows:

[0095]

[0096] The nonlinear system after using the conversion error is a homeomorphic mapping with the original nonlinear system. Therefore, the final preset performance control module essentially guarantees the conversion error ε iThe absolute value of |ε is bounded. i |≤k, the original error e(t) inequality constraint can be guaranteed to hold.

[0097] S300, performing error conversion on the first state error variable based on a conversion error function to obtain a first conversion error variable;

[0098] Based on the above formula (6), the first conversion error variable can be obtained;

[0099] Specifically, let the first state error variable be e1=x d -x;

[0100] Then, the first conversion error variable obtained based on formula (6) is as follows:

[0101]

[0102] Among them, based on The first conversion error variable ε1 is derived to obtain the following formula (8):

[0103]

[0104] in,

[0105] like Figure 5 As shown, S400, based on the first conversion error variable and the second state error variable, a nonlinear control module of a state feedback controller is constructed using a PMLSM dynamic model to design a state feedback controller.

[0106] The main function of the nonlinear control module in the state feedback controller is to make the motor run stably according to the preset trajectory. Generally, the parameter design of the nonlinear control module is related to the expected convergence speed of the motor system, and the parameter design of the preset performance control module is related to the limit of the following error. Therefore, the following is the design method of the backstepping controller for the nonlinear control module, that is, iteratively designing multiple state equations so that the state quantities converge and finally obtain the virtual control rate of the system.

[0107] S401, establishing a second-order dynamic equation of the linear motor and converting it into a second-order state space equation;

[0108] First, the second-order dynamic equation of the linear motor including nonlinear friction disturbance is established and converted into a second-order state space equation. The second-order state space equation is as follows (9):

[0109]

[0110] Among them, x1 represents the displacement, x2 represents the velocity, and They are respectively represented as the derivative functions of x1 and x2; u is represented as the virtual control quantity, F f Expressed as other friction force, K f It is expressed as thrust constant and B is expressed as viscous friction coefficient;

[0111] At the same time, a represents the virtual control rate coefficient, and f1 represents the nonlinear disturbance, which is convenient for subsequent calculations.

[0112] S402, calculating a first-level virtual control rate according to the first conversion error variable, the second state error variable and the second-order state space equation;

[0113] Next, based on the first conversion error variable ε1 and the second state error variable e2 obtained by the above formulas (7) and (8), the first-order Lyapunov function and its derivative are constructed, as shown in the following formula (10):

[0114]

[0115] Among them, k1 is the parameter to be designed;

[0116] Furthermore, according to the stability condition, the first-order Lyapunov function is made positive definite, and its derivative function is made negative definite, and the first-order virtual control rate α1 (speed control rate) is obtained; at the same time, the first-order virtual control rate α1 is the column formula for calculating the standard data corresponding to the second state variable. Next, refer to the following formula (11), at this time, the asymptotic convergence of the system error is:

[0117]

[0118] S403, calculating a second level virtual control rate based on the first level virtual control rate and a preset stability condition;

[0119] After calculating the first-level virtual control rate, the second-level Lyapunov function and its derivative equation are designed as follows:

[0120]

[0121] Combining the stability condition and the first-level virtual control rate, the virtual control rate of the q-axis current of the controller linear motor is finally obtained as follows (13):

[0122]

[0123] S404, obtaining a nonlinear control module by virtual control frequency design.

[0124] Finally, the nonlinear control module of the state feedback controller can be obtained based on the obtained virtual control frequency as the core.

[0125] Accordingly, the present application first designs a preset performance control module according to the first state error variable actually obtained, and thereby improves and obtains a preset performance function that can constrain the actual error. Secondly, a nonlinear control module is designed based on the first conversion error variable and the second state error variable to ensure the stability of the control system, thereby obtaining the final state feedback controller.

[0126] Example 2

[0127] Based on the design method of a linear motor state feedback controller in the above embodiment 1, this embodiment proposes a linear motor state feedback controller, and the feedback controller applies the above design method;

[0128] The state feedback controller at least comprises: a preset performance control module and a nonlinear control module; the state feedback controller is connected to the linear motor through a current loop and a modulation drive module.

[0129] First of all, the core idea of ​​the state feedback controller is to feed back the state variables of the system (usually position, speed, etc.) to the control input, and adjust the input current or voltage of the motor through the information of these state variables, so as to control the operation of the linear motor. For example, the control input is calculated based on the difference between the desired output (such as position or speed) and the actual state.

[0130] The current loop is a fast control loop that can quickly adjust the current of the linear motor according to the instructions of the state feedback controller. The signal processing controller and PID controller of the current loop can make it respond quickly to the instruction changes and reduce the error between the actual value of the current and the set value.

[0131] The modulation drive module usually uses pulse width modulation (PWM) technology to control the motor driver. The PWM signal can adjust the magnitude and direction of the current in the motor coil.

[0132] In a preferred embodiment, the current loop includes a signal processing controller and a PI controller;

[0133] The current loop takes the q-axis current control quantity of the linear motor as input, outputs the q-axis voltage control quantity through the signal processing controller, and limits the q-axis voltage control quantity;

[0134] The PI controller is used to output the d-axis voltage control quantity of the linear motor;

[0135] The q-axis voltage control quantity and the d-axis voltage control quantity output the inverter switching signal through the modulation drive module, thereby obtaining the three-phase voltage required for the linear motor servo operation.

[0136] Specifically, the signal processing controller can calculate the q-axis voltage control amount based on the q-axis current control amount so as to achieve the required q-axis current. At the same time, due to the physical limitations of the voltage and current of the linear motor, the q-axis voltage control amount needs to be limited to prevent the linear motor from exceeding its maximum operating voltage.

[0137] The PI controller is responsible for outputting the d-axis voltage control quantity. It adjusts the voltage control quantity based on the error of the q-axis current (that is, the difference between the actual value and the reference value). Finally, the modulation drive module outputs the inverter switching signal to obtain the three-phase voltage required for the linear motor servo operation.

[0138] In the embodiment of the present application, the preset performance control module takes the error e1 corresponding to the position state variable x1 of the system as input, takes the first conversion error variable ε1 as output, and limits the displacement error actually generated during the operation through the setting parameters of the preset performance function, so that the error tends to be infinitely stable at a certain set time. The nonlinear control module takes the first conversion error variable ε1 and the error e2 corresponding to the state variable x2 of the system as input, and outputs the control amount of the q-axis current The current loop controller uses the PI control method to control the control quantity and feedback amount i q The current error Δi is obtained by subtracting, and the q-axis voltage control quantity U is obtained through the PI controller. q , set the value The control quantity U of the d-axis voltage is obtained by the PI controller d .

[0139] Example 3

[0140] In order to further illustrate the specific effect of the linear motor state feedback controller obtained based on the design method of Example 1, a verification description is performed in the form of software simulation, and the specific contents and steps of the verification are as follows:

[0141] In the simulation software, the driving models of the PMLSM using the method shown in Example 1, the traditional backstepping control design method (BSC) and the double closed-loop PI control method are respectively built, and the reference preset trajectory is set as a T-wave motion trajectory. The motion process divides the entire reciprocating motion into a uniform acceleration segment, a uniform speed segment and a uniform deceleration segment;

[0142] (2) According to Figure 7 The design method of the principle block diagram and embodiment 1 builds a PMLSM state feedback controller (PPBC) driving model through a virtual control rate;

[0143] The state feedback controller uses the T-shaped trajectory as the reference position input, and converts the state error obtained by comparing it with the actual position to obtain the conversion error. The state feedback controller outputs the q-axis reference current value, and uses i d =0 control method, through current loop regulation and pulse modulation, obtains the three-phase current required for driving the motor, and finally makes the conversion error in the motor operation process asymptotically stable. There is a bijective relationship between the conversion error and the position error, and the asymptotic stability of the position error is achieved.

[0144] (2) According to Figure 8 Build the PMLSM traditional backstepping controller (BSC) drive model according to the principle block diagram;

[0145] Compared with the present application, the traditional backstepping controller driving model cancels the error conversion part, takes the T-type trajectory as the reference input, and compares it with the actual position to obtain the state error. The backstepping controller outputs the q-axis reference current and adopts i d =0 control method, through current loop regulation and pulse modulation, obtains the three-phase current required to drive the motor to run, so that the position error in the motor operation process is asymptotically stable.

[0146] (3) According to Fig. 9 Build the PMLSM dual closed-loop PI controller drive model according to the principle block diagram;

[0147] The dual closed-loop PI controller driving model takes the T-shaped trajectory as the reference input, sets the position loop, speed loop and current loop PI controllers, and outputs the speed reference value, q-axis current reference value and q-axis voltage reference value respectively. d =0 control method, after pulse modulation, obtains the three-phase current required to drive the motor to run, so that the actual position of the motor during operation follows the reference trajectory.

[0148] In the models of the three simulation methods, the modules are built according to the stribeck friction model as nonlinear disturbances and participate in the construction of the motor model to compare the robustness of the linear motor motion system driven by the three methods in the presence of nonlinear disturbances. The friction model is composed of static friction, stribeck friction and viscous friction, and its function expression is shown in the following formula (14):

[0149]

[0150] Among them, F c is the Coulomb friction force, F s is the maximum static friction, K v is the viscous friction coefficient, F e To apply external force, v s is the stribeck velocity, sgn is the sign function, and ζ is the empirical parameter.

[0151] It should be noted that the nonlinear disturbance involved in the software simulation part is not limited to the stribeck model of this embodiment, and can be designed within a reasonable range according to the actual disturbance type to which the linear motor is subjected. For example, the linear motor may also be affected by end effects and cogging forces during operation, and can be designed according to relevant mathematical models.

[0152] Fig.10 The steady-state error change curves of the PMLSM driven by the controllers designed by the three methods during the motion process are shown. Obviously, the steady-state error of the PMLSM motion system driven by the dual closed-loop PI controller is relatively large when moving under the specified reference trajectory. The PMLSM motion system using the traditional backstepping control method has a significantly reduced following error during the motion process, but its robustness against nonlinear interference is limited, and the following error range cannot be quantified and controlled. The PMLSM motion system corresponding to the state feedback controller obtained by the design method of Example 1 has a more obvious reduction in the steady-state error during the motion process, and it changes significantly less over time, meeting the set preset performance constraints.

[0153] Example 4

[0154] This embodiment provides a linear motor nonlinear servo control method based on a high-speed and high-precision motion platform, aiming to provide a specific application means of a design method of a linear motor state feedback controller, the main components of which are a linear motor, a servo driver and a motion controller;

[0155] This embodiment uses the Power PMAC motion controller, which is a general-purpose embedded computer with a hard real-time operating system that can run standard C applications. It has a built-in software application for specialized motion and machine control, and can run dedicated controller hard real-time tasks in a real-time Linux environment through host computer software phase finding, open-loop testing and online tuning;

[0156] It should be noted that when designing the controller program, it is necessary to understand the theoretical derivation and the unit conversion relationship in the control platform so that timely adjustments can be made in the program. In this motion control platform, the current loop is pre-configured in the driver and generally does not require parameter adjustment. Other control parts implement functions in the motion control card and are the main program design part.

[0157] The program design is mainly carried out according to the virtual control rate of Example 1. The program can be divided into two parts: a nonlinear control module and a preset performance control module. The preset performance control module is mainly responsible for error conversion, which converts the inequality constraint of the error into an equality constraint, and then obtains the conversion error;

[0158] The nonlinear control module is mainly designed by equations (11) and (13), and the preset performance control module is mainly designed by equations (1) and (7). The program input is the set motion trajectory and the actual position measured by the grating encoder. The actual speed is obtained by differentiating the actual position with the system step size. The nonlinear control module is mainly responsible for receiving the displacement feedback from the system and outputting the reference current. The reference current passes through the current loop of the driver to drive the linear motor to operate.

[0159] Specifically, the linear motor nonlinear servo control method has the following features:

[0160] Step 1: Reset the controller to build and download the program file and configure the related linear motor for the program file;

[0161] Step 2: Perform phase-finding operation of the linear motor, conduct an open-loop test, and determine whether the phase-finding is successful based on the result;

[0162] Step 3: Set the linear motor motion trajectory and run the servo program;

[0163] Step 4: Observe the linear motor's motion speed and displacement error curves.

[0164] In particular, it is also possible to use relevant simulation software to build a nonlinear control system and perform C-language-based program transcoding, which can save program design time and steps.

[0165] Example 5

[0166] like Fig.11 As shown, in order to further illustrate the practical application effect of the present invention, this embodiment will use the motion control platform of Example 3 for experimental comparison, and further illustrate the superiority of the control method performance of the present invention. Therefore, the comparison method includes the following steps:

[0167] On a permanent magnet linear motor servo motion platform, motor drive experiments were carried out using the control method of the state feedback controller obtained by the design method shown in Example 1, the traditional backstepping control method, and the double closed-loop PI control method. The parameters of the permanent magnet synchronous linear motor used are as follows: mover mass M = 1.1 Kg, electromagnetic thrust constant = 28.6 N / A, permanent magnet flux φ = 0.194 wb, winding phase resistance R = 4.33 ohm, inductance L = 13.1 mH, and the control program structure is as follows: Fig.11 As shown, the state feedback controller is constructed by formula (13);

[0168] In particular, the reference displacement trajectory is designed as a T-shaped motion trajectory. The entire round-trip motion process of the motion trajectory can be divided into uniform acceleration [0, t1][t1, t5], uniform speed segment [t1, t2][t4, t5] and uniform deceleration segment [t2, t4]. Its position, velocity and acceleration curves are shown in Fig.12 As shown in the figure, the acceleration during acceleration and deceleration is set to 5.38m / s, so that the motor runs at a relatively high speed, and the steady-state error effect is compared at this time;

[0169] Fig.13 The following are the tracking error variation curves during the motion of the linear motor under the three control methods. The maximum displacement error of the dual closed-loop PI control method is 202.64 μm, the maximum displacement error of the BSC control method is 70.18 μm, and the maximum displacement error of the PPBC control method is 52.04 μm. Obviously, under the influence of nonlinear disturbance, the PMLSM driven by the dual closed-loop PI controller has the largest steady-state error during the motion process, and the steady-state error of the PMLSM driven by the traditional backstepping controller is significantly reduced. The steady-state error of the state feedback controller obtained in Example 1 is further reduced, the robustness is good, and the tracking error can be considered to be controlled within a certain range.

[0170] Combined with the comparison of the simulation results of Example 2 and the comparison of the experimental results of Example 5, it can be proved that the state feedback controller designed under the method shown in Example 1 has superior control performance. Compared with other control examples given in some embodiments, the state feedback controller designed with nonlinear control as the background of the present invention can still have a certain robustness under the influence of nonlinear disturbances, and can quantize and limit the following error, and make it converge within a limited time, which can meet certain complex working conditions.

[0171] The above description is only a preferred embodiment of the present application and an explanation of the technical principles used. Those skilled in the art should understand that the scope of the invention involved in the present application is not limited to the technical solution formed by a specific combination of the above technical features, but should also cover other technical solutions formed by any combination of the above technical features or their equivalent features without departing from the inventive concept. For example, the above features are replaced with (but not limited to) technical features with similar functions disclosed in the present application.

Claims

1. A design method for a linear motor state feedback controller, characterized in that: The method comprises the following steps: Acquire first state data and second state data output by a linear motor feedback module, calculate a first state error variable, and define a second state error variable based on the second state data; Constraining the first state error variable by a preset performance function to construct a preset performance control module of the state feedback controller; Performing error conversion on the first state error variable based on a conversion error function to obtain a first conversion error variable; Based on the first conversion error variable and the second state error variable, a nonlinear control module of the state feedback controller is constructed using a PMLSM dynamics model to design the state feedback controller.

2. The design method of the linear motor state feedback controller according to claim 1, characterized in that: Acquiring first state data and second state data output by a linear motor feedback module, calculating a first state error variable, and defining a second state error variable based on the second state data, specifically includes: Controlling the linear motor to run according to a preset trajectory, and acquiring the first state data and the second state data; The first state error variable is calculated based on the first state data and the standard data corresponding to the preset trajectory, and the second state error variable is defined based on the second state data.

3. The design method of the linear motor state feedback controller according to claim 2, characterized in that: The first state error variable is constrained by a preset performance function to construct a preset performance control module of the state feedback controller, specifically including: Setting an error range corresponding to the first state error variable and the preset performance function; Performing data processing based on the error range and the preset performance function to obtain the equality constraint and the conversion error function; The preset performance control module is designed based on the equation constraint and the conversion error function.

4. The design method of the linear motor state feedback controller according to claim 3 is characterized in that: Based on the first conversion error variable and the second state error variable, a nonlinear control module of the state feedback controller is constructed using the PMLSM dynamic model, specifically including: Establishing the second-order dynamic equation of the linear motor and converting it into a second-order state space equation; According to the first conversion error variable, the second state error variable and the second-order state space equation, a first-order virtual control rate is calculated according to the Lyapunov stability condition; Based on the first-level virtual control rate and the Lyapunov stability condition, a second-level virtual control rate is calculated; The nonlinear control module is designed with the second-level virtual control rate.

5. The design method of the linear motor state feedback controller according to claim 4, characterized in that: The inequality constraint corresponding to the error range is as follows: -δρ(t) represents the lower bound of the error; It is represented as the upper bound of error; e(t) is represented as the state error variable; Performing data processing based on the error range and the preset performance function to obtain the conversion error function specifically includes: The error range is converted into an equality constraint form and normalized to obtain the converted error function.

6. The design method of the linear motor state feedback controller according to claim 5, characterized in that: The second-order dynamic equation of the linear motor established is the second-order dynamic equation of the linear motor including nonlinear friction disturbance; The second-order kinetic equation is as follows: Among them, x1 is the displacement, x2 is the velocity, and are the derivative functions of x1 and x2 respectively, u is the virtual control quantity, F f is other friction force, K f is the thrust constant and B is the viscous friction coefficient.

7. A linear motor state feedback controller, characterized in that: The state feedback controller is applied with the design method of the linear motor state feedback controller according to any one of claims 1 to 6 above; The state feedback controller at least includes: the preset performance control module and the nonlinear control module; the state feedback controller is connected to the linear motor through a current loop and a modulation drive module.

8. A linear motor state feedback controller according to claim 7, characterized in that: The current loop includes a signal processing controller and a PI controller; The current loop takes the control amount of the q-axis current of the linear motor as input, outputs the q-axis voltage control amount through the signal processing controller, and limits the q-axis voltage control amount; The PI controller is used to output the d-axis voltage control amount of the linear motor; The q-axis voltage control amount and the d-axis voltage control amount output inverter switching signals through the modulation drive module, thereby obtaining the three-phase voltage required for the servo operation of the linear motor.