CN113517832B - Low-voltage servo discrete linear active disturbance rejection control method - Google Patents
Low-voltage servo discrete linear active disturbance rejection control method Download PDFInfo
- Publication number
- CN113517832B CN113517832B CN202110677419.0A CN202110677419A CN113517832B CN 113517832 B CN113517832 B CN 113517832B CN 202110677419 A CN202110677419 A CN 202110677419A CN 113517832 B CN113517832 B CN 113517832B
- Authority
- CN
- China
- Prior art keywords
- observer
- current
- equation
- loop
- matrix
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/0003—Control strategies in general, e.g. linear type, e.g. P, PI, PID, using robust control
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/13—Observer control, e.g. using Luenberger observers or Kalman filters
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/14—Estimation or adaptation of machine parameters, e.g. flux, current or voltage
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/14—Estimation or adaptation of machine parameters, e.g. flux, current or voltage
- H02P21/18—Estimation of position or speed
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/22—Current control, e.g. using a current control loop
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P2205/00—Indexing scheme relating to controlling arrangements characterised by the control loops
- H02P2205/01—Current loop, i.e. comparison of the motor current with a current reference
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P2205/00—Indexing scheme relating to controlling arrangements characterised by the control loops
- H02P2205/07—Speed loop, i.e. comparison of the motor speed with a speed reference
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Control Of Electric Motors In General (AREA)
- Feedback Control In General (AREA)
Abstract
A low-voltage servo discrete linear active disturbance rejection control method comprises the steps of determining the order of a controlled object of a speed ring and a current ring of a low-voltage servo driver according to a current differential equation and a motion equation of a servo motor, determining the order of a linear active disturbance rejection controller according to the order of the controlled object, designing a continuous linear active disturbance rejection controller for the speed ring and the current ring, discretizing the continuous controller by an Euler discretization method, and determining the corresponding relation of each matrix of the continuous controller and the discrete controller; the method for identifying the parameters of the rotary inertia and the inductance of the motor is used for designing a compensation factor of the linear active disturbance rejection controller, and a digital controller of a current loop is subjected to time delay consideration in parameter setting to set corresponding parameters. The discrete mode of the linear active disturbance rejection controller is applied to the low-voltage servo driver, and the stability, the disturbance rejection, the rapidity, the robustness and the like of the permanent magnet synchronous motor control system can be improved by means of a discrete linear active disturbance rejection control algorithm.
Description
Technical Field
The invention relates to the field of low-voltage servo motor control, in particular to a discrete linear active disturbance rejection control method for a low-voltage servo driver.
Background
The low-voltage servo motor has the remarkable advantages of no need of brush phase change, simple structure, high operation precision, low power supply voltage, small volume, light weight, high working efficiency, flexible modification of design appearance and size under the basic design condition and the like. In the coming of the 4.0 times of industry, power devices and permanent magnet materials are developed vigorously, the control precision of a low-voltage servo motor is improved to a great extent, the low-voltage servo motor is slowly and widely applied to the fields of robot control, hydraulic devices, aerospace, medical equipment, ship and naval vessel equipment and the like, and the cost of replacing an electric brush at the later stage is saved because the electric brush is not required to be used for phase change, so that the occupation ratio of the low-voltage brush motor is replaced in a certain field. However, because there is no brush, the controller is required to perform electronic phase change on the motor, the low-voltage servo motor is a complex controlled object with multivariable, strong coupling, nonlinearity and variable parameters, and in order to make the low-voltage servo motor have high working accuracy, strong external interference resistance and better dynamic performance, some specific algorithms must be adopted to control the low-voltage servo motor.
The control strategy of the low-voltage servo motor mainly comprises square wave control and vector control, and the square wave control has the influences of large torque fluctuation, low control precision and the like due to the control scheme of the square wave control. Therefore, vector control is generally used under the high-precision control working condition. The control scheme of the low-voltage servo motor mainly comprises the following steps: current loop (torque control), speed loop control and position loop. A current loop is generally nested in the speed loop and the position loop for control. Control algorithms for three loops have been extensively studied. The control algorithms that are currently in common use: traditional PID control, sliding mode variable structure control, model-based adaptive control, model predictive control, fuzzy control, active disturbance rejection control and the like. In the industrial field, the PID control is widely used by application engineers because the content of the information amount required by the model is small. The active disturbance rejection control is control which is not based on a model and is proposed by researchers at Chinese academy Han Jing, the active disturbance rejection control can be regarded as continuation and development of traditional PID control, the internal parameter disturbance and the external environment disturbance of a system are regarded as the concept of total disturbance together through the concept of an observer, and the total disturbance is observed and compensated through the observer. But since the proposed active disturbance rejection controller is a non-linear controller, the tuning of the non-linear function and the tuning of the controller parameters is not understood by most application engineers. Gao Zhijiang mr proposed in 2003 to transform the concept of bandwidth for a non-linear active disturbance rejection controller into a linear active disturbance rejection controller, and the tuning parameters of the controller and the bandwidth concept are combined to reduce the tuning parameters of the controller to 4 parameters and the bandwidth of the controller and the bandwidth of the observer are connected in a proportional manner. This method can be understood by application engineers and achieves better control than PID.
Disclosure of Invention
In order to overcome the defects of the prior art, the invention provides a low-voltage servo discrete linear active-disturbance-rejection control method, a discrete linear active-disturbance-rejection controller is designed on a current loop and a speed loop to replace the traditional PID control to control a motor, the parameters of the speed loop and the controller of the current loop are adjusted, the parameters obtained by parameter identification are fused into the parameters of the controller to determine the approximate range of a compensation factor, and therefore, the control precision of the discrete linear active-disturbance-rejection controller is improved.
In order to solve the above technical problem, the present invention is implemented as follows:
a low-voltage servo discrete linear active-disturbance-rejection control method, the method comprising the steps of:
step 1) determining the order of a controlled object of a current loop and a speed loop, wherein the determined order is determined by a differential equation of current and a motion equation, and the differential equation of quadrature-direct axis current is as follows:
in the above formula i d 、i q Is a quadrature-direct axis current value, R s Is the motor resistance value, L d 、L q Is a quadrature-direct axis inductance value, omega e For motor speed value, # f Is the flux linkage value of the permanent magnet;
the equation of motion is:
in the above formula n p Is the number of pole pairs, T, of the motor e Is the electromagnetic torque of the machine, T L Is the load torque of the motor, J is the moment of inertia of the motor, L md 、L mq The armature reaction inductor is a quadrature-direct axis armature reaction inductor;
as can be seen from (1.1) to (1.3), the order of the passive object of the current loop and the speed loop is 1, and according to the design rule of the active disturbance rejection controller, the order of the extended observer needs to be increased by 1 on the basis of the order of the controlled object, so the order of the extended observer is 2 orders;
step 2) rewriting differential equation of current loop and motion equation of motor into input plus disturbance form, because it adopts i d The control strategy of =0, so that only the quadrature axis current is analyzed when analyzing the current loop, and the quadrature axis current is not analyzed any more, and the differential equation of the quadrature axis current is rewritten as:
in the above formulaThe total disturbance of the quadrature axis current loop can be regarded as the total disturbance, and the total disturbance comprises resistance, inductance, permanent magnet flux linkage change and external disturbance;
the equation of motion is rewritten as:
in the above formula f ω Total disturbance of the speed loop, caused by internal parameter changes and external load torque changes;
step 3) designing a current loop continuous linear active disturbance rejection controller, firstly analyzing the current loop, inputting the current loop as a cross-axis current reference value, outputting as a cross-axis voltage control value, and recording a state variableThe formula (1.4) is represented as followsThe form of the equation of state:
a linear state observer is designed by utilizing the design principle of Luenberger to observe disturbance quantity and state variables, and the equation of the state observer is as follows:
in the above formula Respectively represent a status variable-> Represents the gain value of the observer, is greater than or equal to>Is observer error, based on the measured value>The current loop linear expansion observer is written as:
And 4) designing a continuous linear active disturbance rejection controller of the speed loop, wherein a linear extended observer of the speed loop is represented as follows:
the state variable matrix z in the above equation ω =[z 1_ω ,z 2_ω ] T Matrix of statesObserver gain matrix L ω =[l 1_ω ,l 2_ω ] T Output matrix C ω =[1,0]Input matrix B ω =[b ω ',0] T ,u c_ω =[u o_ω ,y ω ] T
Step 5) designing a tracking differentiator of the speed loop, wherein the current loop does not need to track the differentiator because the expected current value of the current loop is changed rapidly along with the reference value of the current; because of the inertia effect of the speed ring, if the arrangement of the transition process is carried out without using a tracking differentiator, the speed ring system can generate bad dynamic processes such as overshoot, and a first-order inertia link is adopted as the arrangement of the transition process in the transition process, and the expression of the first-order inertia link is as follows:
meanwhile, the relation between the output and the input through an inertia link is obtained as follows:
step 6) designing a gain matrix of the linear extended observer, connecting the gain of the observer with a bandwidth commonly used in the actual control, and writing a characteristic equation of a system of a formula (1.8) as follows:
expanding the characteristic expression, placing the poles of the characteristic expression at the same position, wherein the position is the bandwidth value of the observer, and obtaining a gain matrix of the observer as follows:
and 7) designing control laws of the speed loop and the current loop continuous linear active disturbance rejection controller, and adopting single P control for a first-order controlled object, wherein the control laws of the current loop and the speed loop are as follows:
u ω =K ω (r ω -y ω ) (1.15)
in the above formulaK ω For controlling the gain of a law, is>r ω Reference signals for the speed loop and the current loop;
step 8) discretizing the continuous linear active disturbance rejection controller, wherein the control law part in the continuous linear active disturbance rejection controller only amplifies the output signal of the linear expansion observer, so that the control law part does not need to carry out discretization treatment, only the continuous linear expansion observer part needs to be discretized, an Euler discretization method is adopted for discretization, the discretization mode of a speed ring is similar to that of a current ring, only the discretization process of the current ring is deduced, and a state variable is subjected to state variable derivationDifferentiation is performed using the following equation:
in the above formulaFor the delay time caused by the current loop digital controller, the above equation is rewritten as the change of the current time compared to the previous time:
substituting the above equation into the state equation of the continuous system to obtain:
wherein I is an identity matrix, and I is an identity matrix,corresponding to the input matrix->The expression is as follows:
is equal to the output matrix in the sequential control->Is a zero matrix, and simultaneously obtains an expression equation of the discrete linear extended observer as follows:
whereinThe characteristic equation is written for a discrete linear extended observer gain matrix similar to a continuous system as follows:
the characteristic roots are placed at the same polar point, and a gain matrix is obtained after expansionComprises the following steps: />
Simultaneously obtaining:
the corresponding input matrix is:
the corresponding output matrix is:
the conversion expressions of the bandwidth of the continuous linear extended observer and the bandwidth of the discrete linear extended observer are as follows:
step 9) discretization of a velocity loop tracking differentiator, wherein a forward Euler method is adopted for discretization of a first-order inertia link, and a reverse Laler identification is carried out on the inertia link to obtain:
obtained by a forward Euler method:
the simultaneous expression is as follows:
step 10) identifying the rotational inertia and the inductance value of the low-voltage servo motor as a determination reference of a compensation factor, and obtaining the rotational inertia value and the inductance value through an identification algorithm according to a formula:
the base numbers of the compensation factors of the current loop and the speed loop are determined, because the anti-interference performance and the dynamic performance of the system can be improved by properly increasing the value of the compensation factor in the linear active-disturbance-rejection controller, the compensation factor is multiplied by a gain factor a to obtain the compensation factor in the actual controller as follows:
b 0_ω '=a ω *b 0_ω (1.36)
step 11) using a steady state diagram mode to control the control law bandwidth omega of the current loop and the speed loop c And observer bandwidth ω o And setting, and reserving enough amplitude margin and phase margin for the two systems.
The invention has the beneficial effects that: the discrete linear active-disturbance-rejection controller is designed on the current ring and the speed ring to replace the traditional PID control to control the motor, the controller parameters of the speed ring and the current ring are subjected to parameter setting, and the parameters obtained through parameter identification are fused into the parameters of the controller to be used for determining the approximate range of the compensation factor, so that the control precision of the discrete linear active-disturbance-rejection controller is improved.
Drawings
Fig. 1 is a control block diagram of a low-voltage servo controller.
Fig. 2 is a control block diagram of a current loop linear active disturbance rejection controller.
Fig. 3 is a controller block diagram of a speed loop linear active disturbance rejection controller.
FIG. 4 is a flow chart of a low-voltage servo discrete linear active disturbance rejection control method.
Detailed Description
The present invention will be described in further detail with reference to the accompanying drawings.
Referring to fig. 1-4, a low-voltage servo discrete linear active-disturbance-rejection control method includes the steps of:
step 1) determining the order of a controlled object of a current loop and a speed loop, wherein the determined order is determined by a differential equation of current and a motion equation, and the differential equation of quadrature-direct axis current is as follows:
in the above formula i d 、i q Is a quadrature-direct axis current value, R s Is the motor resistance value, L d 、L q Is a quadrature-direct axis inductance value, omega e For motor speed value, # f Is the flux linkage value of the permanent magnet;
the equation of motion is:
in the above formula n p Is the number of pole pairs, T, of the motor e Is the electromagnetic torque of the machine, T L Is the load torque of the motor, J is the moment of inertia of the motor, L md 、L mq The armature reaction inductor is a quadrature-direct axis armature reaction inductor;
as can be seen from (1.1) to (1.3), the order of the passive object of the current loop and the speed loop is 1, and according to the design rule of the active disturbance rejection controller, the order of the extended observer needs to be increased by 1 on the basis of the order of the controlled object, so the order of the extended observer is 2 orders;
step 2) the differential equation of the current loop and the motion equation of the motor are rewritten into a form of input plus disturbance, because the adopted form is i d The control strategy of =0, so that only the quadrature axis current is analyzed when analyzing the current loop, and the quadrature axis current is not analyzed any more, and the differential equation of the quadrature axis current is rewritten as:
in the above formulaThe total disturbance of the quadrature axis current loop can be regarded as the total disturbance, and the total disturbance comprises resistance, inductance, permanent magnet flux linkage change and external disturbance;
the equation of motion is rewritten as:
in the above formula f ω Total disturbance of the speed loop, caused by internal parameter changes and external load torque changes;
step 3) designing a current loop continuous linear active disturbance rejection controller, firstly analyzing the current loop, inputting the current loop as a cross-axis current reference value, outputting as a cross-axis voltage control value, and recording a state variableThen equation (1.4) is expressed in the form of the following equation of state:
a linear state observer is designed by utilizing the design principle of Luenberger to observe disturbance quantity and state variables, and the equation of the state observer is as follows:
in the above formula Respectively represent a status variable-> Represents the gain value of the observer, is greater than or equal to>Is observer error, based on the measured value>The current loop linear expansion observer is written as:
And 4) designing a continuous linear active disturbance rejection controller of the speed loop, wherein a linear extended observer of the speed loop is represented as follows:
matrix of state variables z in the above equation ω =[z 1_ω ,z 2_ω ] T Matrix of statesObserver gain matrix L ω =[l 1_ω ,l 2_ω ] T Output matrix C ω =[1,0]Input matrix B ω =[b ω ',0] T ,u c_ω =[u o_ω ,y ω ] T
Step 5) designing a tracking differentiator of the speed loop, wherein the current loop does not need to track the differentiator because the expected current value of the current loop is changed rapidly along with the reference value of the current; because of the inertia effect of the speed ring, if the arrangement of the transition process is carried out without using a tracking differentiator, the speed ring system can generate bad dynamic processes such as overshoot, and a first-order inertia link is adopted as the arrangement of the transition process in the transition process, and the expression of the first-order inertia link is as follows:
meanwhile, obtaining a relation between output and input through an inertia link as follows:
and 6) designing a gain matrix of the linear extended observer, linking the gain of the observer with the bandwidth commonly used in the actual control, and writing a characteristic equation of a system in the formula (1.8) as follows:
expanding the characteristic expression, placing the poles of the characteristic expression at the same position, wherein the position is the bandwidth value of the observer, and obtaining a gain matrix of the observer as follows:
and 7) designing a control law of the speed loop and current loop continuous linear active disturbance rejection controller, and adopting single P control for a first-order controlled object, wherein the control laws of the current loop and the speed loop are as follows:
u ω =K ω (r ω -y ω )(1.51)
in the above formulaK ω For controlling the gain of a law, is>r ω Reference signals for the speed loop and the current loop;
step 8) discretizing the continuous linear active disturbance rejection controller, wherein the control law part in the continuous linear active disturbance rejection controller only amplifies the output signal of the linear extended observer, so the control law part does not need to carry out discretization treatment, only the continuous linear extended observer part needs to be discretized, an Euler discretization method is adopted for discretization, the discretization mode of a speed ring is similar to that of a current ring, only the discretization process of the current ring is deduced, and a state variable is subjected to state variable derivationDifferentiation is performed using the following equation:
in the above formulaFor the delay time caused by the current loop digital controller, the above equation is rewritten as the change of the current time compared to the previous time:
substituting the above equation into the state equation of the continuous system to obtain:
wherein I is a unit matrix of the image data,corresponding to the input matrix->The expression is as follows:
is equal to the output matrix in the sequential control->Is a zero matrix, and simultaneously obtains an expression equation of the discrete linear extended observer as follows:
whereinThe characteristic equation is written for a discrete linear extended observer gain matrix similar to a continuous system as follows:
the characteristic roots are placed at the same polar point, and gain matrixes are obtained after expansionComprises the following steps:
simultaneously obtaining:
the corresponding input matrix is:
the corresponding output matrix is:
the conversion expressions of the bandwidth of the continuous linear expansion observer and the bandwidth of the discrete linear expansion observer are as follows:
step 9) discretization of the velocity loop tracking differentiator, wherein a forward Euler method is adopted for discretization in the same first-order inertia link, and inverse Laler identification is carried out on the inertia link to obtain:
obtained by a forward Euler method:
the simultaneous expression is as follows:
step 10) identifying the rotary inertia and the inductance value of the low-voltage servo motor to serve as a determination reference of a compensation factor, and obtaining the rotary inertia value and the inductance value through an identification algorithm through a formula:
the base numbers of the compensation factors of the current loop and the speed loop are determined, because the anti-interference performance and the dynamic performance of the system can be improved by properly increasing the value of the compensation factor in the linear active-disturbance-rejection controller, the compensation factor is multiplied by a gain factor a to obtain the compensation factor in the actual controller as follows:
b 0_ω '=a ω *b 0_ω (1.72)
step 11) using a steady state diagram mode to control the control law bandwidth omega of the current loop and the speed loop c And observer bandwidth ω o And setting, and reserving enough amplitude margin and phase margin for the two systems.
In the embodiment, the reference input of the speed loop is given through the software of the upper computer, the given input is introduced into a discrete first-order inertia link, the time constant tau in the inertia link is adjusted, and the sampling time is the control period of the speed loop, namely t s =0.001, wherein the larger the value of the time constant, the stronger the suppression capability for overshoot, but at the same time the longer the adjustment time required by the system.
Firstly, a PID controller is used for enabling a low-voltage servo motor to work under the condition of constant speed, at the moment, inductance parameters and rotational inertia parameters of the motor are identified, cardinalities of compensation factors of a speed loop and a current loop are determined according to the identified parameters, and meanwhile, the cardinalities are multiplied by a scale factor to obtain the compensation factors of the controller.
The output value of the operational amplifier circuit is used for sampling the direct-quadrature axis current value of the motor and is used as the input of a discrete linear extension observer, and the output of the observer from a control law is input into a control quantity obtained by a limiting function.
And designing parameters of the discrete linear active disturbance rejection controller. Firstly, considering the transfer function of a linear active disturbance rejection device, converting the linear active disturbance rejection controller into the form of the transfer function through a state equation, simultaneously considering the time delay generated by the time delay caused by a digital controller, converting the time delay into the form of the transfer function, and simultaneously writing the transfer function of a controlled object. And writing a closed-loop transfer function of the whole system, independently writing a closed-loop characteristic equation of the system, writing an iterative program, combining different control law bandwidths and proportional factors between the control laws and the observer bandwidths, substituting the combined values into the characteristic equation, and judging whether a characteristic root of the characteristic equation is positioned on a left half plane or not.
Drawing the obtained control law bandwidth and a scale factor between the control law and the observer bandwidth into a graph, determining a stable region, and obtaining controller parameters meeting requirements in the stable region through a performance evaluation function, wherein the maximum value of the scale factor cannot exceed 10.
The bandwidth of the current loop discrete linear expansion observer is obtained through a formula (1.29), and the bandwidth is substituted into a current loop controller to look up actual working conditions and find an optimal solution.
The low-voltage servo controller generally receives output values from an incremental encoder, a rotary encoder, and an absolute encoder, and processes the signals to determine the real-time speed of the low-voltage servo motor. The linear expansion observer is used as the input of the discrete linear expansion observer of the speed loop, and the input and the current loop adopt the control quantity after amplitude limiting as the input.
The speed ring is set by adopting a setting method, so that the low-voltage servo motor can stably run under the speed ring.
The above examples represent only one embodiment of the present invention and are not to be construed as limiting the scope of the present invention. It should be noted that a person skilled in the art could make several alternative designs without departing from the inventive concept, which falls within the scope of the invention.
Claims (1)
1. A low-voltage servo discrete linear active disturbance rejection control method, comprising the steps of:
step 1) determining the order of a controlled object of a current loop and a speed loop, wherein the determined order is determined by a differential equation of current and a motion equation, and the differential equation of quadrature-direct axis current is as follows:
in the above formula i d 、i q Is a quadrature-direct axis current value, R s Is the motor resistance value, L d 、L q Is a quadrature-direct axis inductance value, omega e For motor speed value, # f Is the flux linkage value of the permanent magnet;
the equation of motion is:
in the above formula n p Is the number of pole pairs, T, of the motor e Is the electromagnetic torque of the machine, T L Is the load torque of the motor, J is the moment of inertia of the motor, L md 、L mq The armature reaction inductor is a quadrature-direct axis armature reaction inductor;
as can be seen from equations (0.1) - (0.3), the order of the passive object of the current loop and the speed loop is 1, and according to the design rule of the active disturbance rejection controller, the order of the extended observer needs to be increased by 1 on the basis of the order of the controlled object, so the order of the extended observer is 2;
step 2) the differential equation of the current loop and the motion equation of the motor are rewritten into a form of input plus disturbance, because the adopted form is i d The control strategy of =0, so that only the quadrature axis current is analyzed when analyzing the current loop, and the quadrature axis current is not analyzed any more, and the differential equation of the quadrature axis current is rewritten as:
in the above formulaThe total disturbance of the quadrature axis current loop can be regarded as the total disturbance, and the total disturbance comprises resistance, inductance, permanent magnet flux linkage change and external disturbance;
the equation of motion is rewritten as:
in the above formula f ω Is the total disturbance of the speed loop, caused by internal parameter changes and external load torque changes;
step 3) designing a current loop continuous linear active disturbance rejection controller, firstly analyzing the current loop, inputting the current loop as a cross-axis current reference value, outputting as a cross-axis voltage control value, and recording a state variableThen equation (0.4) is expressed in the form of the following equation of state:
a linear state observer is designed by utilizing the design principle of Luenberger to observe disturbance quantity and state variables, and the equation of the state observer is as follows:
in the above formula Respectively represent a status variable-> Represents the gain value of the observer, is greater than or equal to>In order to observer error->The current loop linear expansion observer is written as:
Step 4) designing a continuous linear active disturbance rejection controller of a speed loop, wherein a linear extended observer of the speed loop is expressed as:
matrix of state variables z in the above equation ω =[z 1_ω ,z 2_ω ] T Matrix of statesObserver gain matrix L ω =[l 1_ω ,l 2_ω ] T Output matrix C ω =[1,0]Input matrix B ω =[b ω ',0] T ,u c_ω =[u o_ω ,y ω ] T ;
Step 5) designing a tracking differentiator of the speed loop, wherein the current loop does not need to track the differentiator because the expected current value of the current loop is changed rapidly along with the reference value of the current; because of the inertia effect of the speed ring, if the arrangement of the transition process is carried out without using a tracking differentiator, the speed ring system can generate bad dynamic processes such as overshoot, and the arrangement of the transition process adopts a first-order inertia link, and the expression of the first-order inertia link is as follows:
meanwhile, the relation between the output and the input through an inertia link is obtained as follows:
step 6) designing a gain matrix of the linear extended observer, connecting the gain of the observer with a bandwidth commonly used in the actual control, and writing a characteristic equation of a system of a formula (0.8) as follows:
expanding the characteristic expression, placing the poles of the characteristic expression at the same position, wherein the position is the bandwidth value of the observer, and obtaining a gain matrix of the observer as follows:
and 7) designing control laws of the speed loop and the current loop continuous linear active disturbance rejection controller, and adopting single P control for a first-order controlled object, wherein the control laws of the current loop and the speed loop are as follows:
u ω =K ω (r ω -y ω ) (0.15)
in the above formulaK ω For controlling the gain of a law, is>r ω Reference signals for the speed loop and the current loop;
step 8) discretizing the continuous linear active disturbance rejection controller, wherein the control law part in the continuous linear active disturbance rejection controller only amplifies the output signal of the linear extended observer, so the control law part does not need to carry out discretization treatment, only the continuous linear extended observer part needs to be discretized, an Euler discretization method is adopted for discretization, the discretization mode of a speed ring is similar to that of a current ring, only the discretization process of the current ring is deduced, and a state variable is subjected to state variable derivationDifferentiation is performed using the following equation:
in the above formulaFor the delay time caused by the current loop digital controller, the above equation is rewritten as the change of the current time compared to the previous time:
substituting the above equation into the state equation of the continuous system to obtain:
wherein I is an identity matrix, and I is an identity matrix,corresponding to the input matrix->The expression is as follows:
is equal to the output matrix in the sequential control->Is a zero matrix, and simultaneously obtains an expression equation of the discrete linear extended observer as follows:
whereinThe characteristic equation is written for a discrete linear extended observer gain matrix similar to a continuous system as follows:
the characteristic roots are placed at the same polar point, and a gain matrix is obtained after expansionComprises the following steps: />
Simultaneously obtaining:
the corresponding input matrix is:
the corresponding output matrix is:
the conversion expressions of the bandwidth of the continuous linear expansion observer and the bandwidth of the discrete linear expansion observer are as follows:
step 9) discretization of a velocity loop tracking differentiator, wherein a forward Euler method is adopted for discretization of a first-order inertia link, and a reverse Laler identification is carried out on the inertia link to obtain:
obtained by the forward Euler method:
the simultaneous expression is as follows:
step 10) identifying the rotational inertia and the inductance value of the low-voltage servo motor as a determination reference of a compensation factor, and obtaining the rotational inertia value and the inductance value through an identification algorithm according to a formula:
the base numbers of the compensation factors of the current loop and the speed loop are determined, because the anti-interference performance and the dynamic performance of the system can be improved by properly increasing the value of the compensation factor in the linear active-disturbance-rejection controller, the compensation factor is multiplied by a gain factor a to obtain the compensation factor in the actual controller as follows:
b 0_ω '=a ω *b 0_ω (0.36)
step 11) using a steady state diagram mode to control the control law bandwidth omega of the current loop and the speed loop c Sum observer bandwidth ω o And setting, and reserving enough amplitude margin and phase margin for the two systems.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110677419.0A CN113517832B (en) | 2021-06-16 | 2021-06-16 | Low-voltage servo discrete linear active disturbance rejection control method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110677419.0A CN113517832B (en) | 2021-06-16 | 2021-06-16 | Low-voltage servo discrete linear active disturbance rejection control method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113517832A CN113517832A (en) | 2021-10-19 |
CN113517832B true CN113517832B (en) | 2023-04-07 |
Family
ID=78065920
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110677419.0A Active CN113517832B (en) | 2021-06-16 | 2021-06-16 | Low-voltage servo discrete linear active disturbance rejection control method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113517832B (en) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114428457B (en) * | 2021-12-15 | 2023-09-05 | 东南大学 | Robust active disturbance rejection control method for delay-containing system |
CN114265441A (en) * | 2021-12-29 | 2022-04-01 | 中车大连电力牵引研发中心有限公司 | Improved self-reactive control speed controller based on time delay and hysteresis compensation |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107592048A (en) * | 2017-10-12 | 2018-01-16 | 重庆航天职业技术学院 | The adaptive chaos control method of fractional order brushless DC motor system |
JP6289917B2 (en) * | 2014-01-21 | 2018-03-07 | 住友重機械工業株式会社 | Injection molding machine |
CN112398397A (en) * | 2020-11-27 | 2021-02-23 | 浙江工业大学 | Linear active disturbance rejection permanent magnet synchronous motor control method based on model assistance |
CN112782977A (en) * | 2020-12-23 | 2021-05-11 | 中国科学院宁波材料技术与工程研究所慈溪生物医学工程研究所 | Motor compliance control method based on BP neural network and extended observer |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH06289917A (en) * | 1993-03-30 | 1994-10-18 | Fanuc Ltd | Servo motor control method by estimated disturbance load torque |
JPH07327382A (en) * | 1994-05-30 | 1995-12-12 | Fanuc Ltd | Control system for ac motor |
-
2021
- 2021-06-16 CN CN202110677419.0A patent/CN113517832B/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6289917B2 (en) * | 2014-01-21 | 2018-03-07 | 住友重機械工業株式会社 | Injection molding machine |
CN107592048A (en) * | 2017-10-12 | 2018-01-16 | 重庆航天职业技术学院 | The adaptive chaos control method of fractional order brushless DC motor system |
CN112398397A (en) * | 2020-11-27 | 2021-02-23 | 浙江工业大学 | Linear active disturbance rejection permanent magnet synchronous motor control method based on model assistance |
CN112782977A (en) * | 2020-12-23 | 2021-05-11 | 中国科学院宁波材料技术与工程研究所慈溪生物医学工程研究所 | Motor compliance control method based on BP neural network and extended observer |
Non-Patent Citations (1)
Title |
---|
永磁同步电机自抗扰控制调速***;唐彬彬 等;《电机与控制应用》;20200310;第47卷(第3期);第12-16页 * |
Also Published As
Publication number | Publication date |
---|---|
CN113517832A (en) | 2021-10-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Gutierrez et al. | Implementation of a neural network tracking controller for a single flexible link: comparison with PD and PID controllers | |
CN113517832B (en) | Low-voltage servo discrete linear active disturbance rejection control method | |
CN108228975B (en) | Motor servo system parameter identification method and backlash elimination control method | |
CN106483844B (en) | The implementation method of electrohydraulic servo system adaptive location controller based on non linear robust | |
CN104242769A (en) | Permanent magnet synchronous motor speed composite control method based on continuous terminal slip form technology | |
Lin et al. | Adaptive fuzzy-neural-network control for a DSP-based permanent magnet linear synchronous motor servo drive | |
CN102497156A (en) | Neural-network self-correcting control method of permanent magnet synchronous motor speed loop | |
Zain et al. | Hybrid learning control schemes with input shaping of a flexible manipulator system | |
CN113325805B (en) | Active disturbance rejection controller and design method thereof | |
CN110649845B (en) | Photoelectric turntable position tracking control method based on robust generalized predictive control | |
CN108459497A (en) | A kind of steady control method for taking aim at servo-drive system based on ADRC and NLPID | |
CN108365787A (en) | A kind of Permanent-magnet Synchronous-motor Speed Servo System and its design method based on internal model control | |
CN112039394A (en) | PMSM servo control system based on fuzzy active disturbance rejection | |
Zhao et al. | Neuroadaptive dynamic surface control for induction motors stochastic system based on reduced-order observer | |
Wang et al. | An improved predictive functional control with minimum-order observer for speed control of permanent magnet synchronous motor | |
CN113283090B (en) | Friction compensation method for electric servo system of airplane steering engine based on bee colony algorithm | |
CN113992098A (en) | Method and system for improving steady-state performance of permanent magnet synchronous motor | |
CN114294461B (en) | Construction method of control system of intelligent valve electric actuating mechanism | |
Schroder et al. | Neural-net based observers for sensorless drives | |
Wang et al. | A high performance permanent magnet synchronous motor servo system using predictive functional control and Kalman filter | |
CN115051601A (en) | Disturbance compensation and tracking control method for variable-speed rotating direct-current motor servo system | |
Li et al. | Design of model-free position controller for PMSLM based on hyperlocal model | |
CN112152538A (en) | Inverse model control method of permanent magnet synchronous motor | |
Teghirad et al. | Robust friction compensator for harmonic drive transmission | |
Wu et al. | Simulation Analysis of Dynamic Characteristics of AC Motor Based on BP Neural Network Algorithm |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |