Adaptive AC servo motor current control method and system

Abstract

The present invention discloses an adaptive AC servo motor current control method and system, which includes the steps of: obtaining an original three-phase AC motor current; inputting the original three-phase AC motor current into a current vector transformation module to generate first target data; inputting the first target data into a current control loop and simultaneously time-differentiating the first target data to generate second target data; and inputting the second target data and the output of the current control loop into an incremental inverse dynamics control module at the same time. Inputting the output of the incremental inverse dynamics control module into a current vector inverse transformation module. According to the present invention, the motor model required for setting the parameters of the controller is not required, thereby solving the technical problems in the prior art that the motor model identification, especially the online model identification, greatly increases the system complexity, and the model identification cannot ensure that the accurate model and model parameters can be obtained, and the fuzzy control, sliding mode control, control based on neural network, and model reference adaptive control cannot ensure the stability of the algorithm and stable operation under the load interference environment of any operating condition.

Description

[Technical field]

[0001] The present invention relates to the field of motor control, and more particularly to a method and system for adaptive AC servo motor current control. [Background technology]

[0002] With the development of intelligent technology, intelligent equipment is increasingly used in people's lives, work and learning, and the use of intelligent technology improves people's quality of life and improves learning and work efficiency. In the field of motor control, the motor system is inherently a nonlinear, time-varying and uncertain system, and the design of the control system needs to use a nonlinear adaptive control algorithm.

[0003] At present, the algorithm of all motor servo control systems uses the traditional PID control algorithm. The PID control algorithm is a control algorithm based on a linear system. When using the PID algorithm to control a nonlinear servo motor, how to set the proportional, integral and differential parameters of the PID is problematic. Because the motor system has nonlinearity, time variation and uncertainty, it is necessary to identify the nonlinear model or linearized model of the motor offline or online. The obtained motor model is used to set the PID parameters in real time or stepwise. The parameters of the traditional PID algorithm are constant throughout the control process. In practical applications, the entire controlled system cannot be predicted in advance, so the fixed PID parameters cannot achieve the optimal control effect of the system. Although the use of model identification can achieve a relatively good control accuracy, model identification, especially online model identification, greatly increases the complexity of the system, and model identification cannot ensure that accurate models and model parameters can always be obtained, making such control systems difficult to be certified. Similarly, other adaptive or intelligent algorithms such as fuzzy control, sliding mode control, neural network-based control, model reference adaptive control, etc. also have problems in that they cannot ensure the stability of the algorithm and stable operation under load interference environments under any operating conditions. Currently, no effective solutions have been proposed for the above problems. Summary of the Invention [Problem to be solved by the invention]

[0004] The embodiments of the present invention provide an adaptive AC servo motor current control method and system, which at least solves the technical problems in the prior art, that is, motor model identification, especially online model identification, greatly increases the system complexity, and model identification cannot ensure that accurate model and model parameters can be obtained, and fuzzy control, sliding mode control, control based on neural network, and model reference adaptive control cannot ensure algorithm stability and stable operation under load interference environment under any operating conditions. [Means for solving the problem]

[0005] According to one aspect of an embodiment of the present invention, there is provided an adaptive AC servo motor current control method, which includes:

[0006] 1. A method for adaptive AC servo motor current control, comprising: obtaining the original current; inputting the original current into a current vector conversion module to generate first target data; inputting the first target data into a current control loop and simultaneously time-differentiating the first target data to generate second target data;

[0007] The method further comprises the steps of simultaneously inputting the second target data and an output of the current control loop to an incremental inverse dynamics control module, and inputting an output of the incremental inverse dynamics control module to the current vector inverse transformation module. Furthermore, the original current is the original three-phase AC motor current. Furthermore, the expression of the incremental inverse dynamics control module is JPEG0007657361000001.jpg53167,

[0008] Where, Δu d and Δu q are the control increments of the d and q axes, and v d and v q is the virtual control variable during inverse dynamics control, JPEG0007657361000002.jpg24132 is the current i at the sampling point d and i q is the time derivative of u d Tou q are the current sampled values ​​of the d-axis and q-axis control outputs, and u d0 , u q0 are the previous sampled values ​​of the d-axis and q-axis control outputs, respectively, and L d is the d-axis inductance, and L q is the q-axis inductance. Furthermore, the AC servo motor control further includes a rotation speed control loop and a rotation angle position control loop.

[0009] A second aspect of the present invention provides an adaptive AC servo motor current control system, comprising: a sampling module, a current vector conversion module, a current control module, and an incremental inverse dynamics module; The sampling module captures the original current, The current vector transformation module inputs the original current into the current vector transformation module to generate first target data; The current control module inputs the first target data into a current control loop and simultaneously performs time differentiation on the first target data to generate second target data;

[0010] The incremental inverse dynamics module simultaneously inputs the second target data and the output of the current control loop to the incremental inverse dynamics control module, and inputs the output of the incremental inverse dynamics control module to the current vector inverse transformation module.

[0011] The present invention further discloses a non-volatile storage medium, the non-volatile storage medium including a program stored therein, the program, when executed, controlling an apparatus in which the non-volatile storage medium is disposed to execute a method according to any one of the above.

[0012] Furthermore, the present invention further discloses an electronic device, comprising a processor and a memory, wherein computer readable instructions are stored in the memory, and wherein the processor is adapted to execute the computer readable instructions, and when the computer readable instructions are executed, the method according to any one of the above is performed.

[0013] According to another aspect of an embodiment of the present invention, there is further provided a non-volatile storage medium, the non-volatile storage medium including a program stored therein, the program, when executed, controlling an apparatus in which the non-volatile storage medium is disposed to perform an adaptive AC servo motor current control method.

[0014] According to another aspect of an embodiment of the present invention, there is further provided an electronic device, comprising a processor and a memory, wherein computer readable instructions are stored in the memory, and the processor is adapted to execute the computer readable instructions, and when the computer readable instructions are executed, an adaptive AC servo motor current control method is performed.

[0015] In the embodiments of the present invention, by replacing the required motor system model with the time derivative of current, the system model in inverse dynamics control is no longer needed, thereby resolving the technical problems in the prior art that motor model identification, especially online model identification, significantly increases the system complexity and cannot ensure that accurate model and model parameters can be obtained, and that fuzzy control, sliding mode control, control based on neural network, and model reference adaptive control cannot ensure algorithm stability and stable operation under load interference environment under any operating conditions. [Brief description of the drawings]

[0016] The drawings described herein are used to provide a further understanding of the present invention and constitute a part of this application, and the exemplary embodiments of the present invention and their explanations are used to interpret the present invention and are not intended to unduly limit the present invention. [Figure 1]2 is a flowchart of an adaptive AC servo motor current control method according to an embodiment of the present invention. [Diagram 2] FIG. 2 is a structural block diagram of an adaptive AC servo motor current control system according to an embodiment of the present invention; [Diagram 3] FIG. 1 is a block diagram showing the principle of conventional AC servo motor current control. [Figure 4] 1 is a block diagram showing the principle of adaptive current vector control according to an embodiment of the present invention; DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0017] In order to allow those skilled in the art to better understand the solution of the present invention, the technical solution in the embodiments of the present invention will be described clearly and completely below with reference to the drawings in the embodiments of the present invention. It is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. Based on the embodiments of the present invention, all other embodiments that those skilled in the art can obtain without creative labor belong to the protection scope of the present invention.

[0018] As should be explained, the terms "first", "second", and the like in the present specification, claims, and drawings are used to distinguish between similar objects and are not used to describe a particular sequence or order. It is to be understood that the terms used in this specification, claims, and drawings are interchangeable where appropriate, such that the embodiments of the present invention described herein can be practiced in sequences other than those shown or described herein. Also, the terms "comprise", "have" and any variations thereof are intended to cover non-exclusive inclusions, e.g., a process, method, system, product, or apparatus that includes a series of steps or units is not limited to those steps or units explicitly shown, but may include other steps or units that are not explicitly shown or inherent to those processes, methods, products, or apparatus.

[0019] According to an embodiment of the present invention, a method embodiment of an adaptive AC servo motor current control method is provided, and it should be noted that the steps illustrated in the flowcharts of the drawings may be performed in a computer system, such as a set of computer executable instructions, and that although a logical order is shown in the flowchart, in some cases the steps shown or described may be performed in an order different from that shown here.

[0020] FIG. 1 is a flow chart of an adaptive AC servo motor current control method according to an embodiment of the present invention. As shown in FIG. 1, the method includes: Step S100 of obtaining an original current, which is a three-phase AC motor current; Step S200: inputting the original three-phase AC motor current into a current vector conversion module to generate first target data; A step S300 of inputting the first target data into a current control loop and simultaneously generating second target data by time-differentiating the first target data;

[0021] The method includes step S400 of simultaneously inputting the second target data and the output of the current control loop into an incremental inverse dynamics control module, and inputting the output of the incremental inverse dynamics control module into a current vector inverse transformation module.

[0022] FIG. 2 is a structural block diagram of an adaptive AC servo motor current control system according to an embodiment of the present invention. As shown in FIG. 2, the system includes: an original current acquisition module, a current control module, a current time derivative module, a current control module, and an incremental inverse dynamics module;

[0023] The original current acquisition module acquires the original three-phase AC motor current, The current control module inputs the original three-phase AC motor current into a current vector conversion module to generate first target data; The current time differentiation module differentiates the first target data with respect to time to generate second target data;

[0024] The current control module compares the first target data with the first target data to be determined, and inputs the result into the current control module; Specifically, the current control module has proportional, integral and differential functions;

[0025] The incremental inverse dynamics module simultaneously inputs the second target data and the output of the current control module to the incremental inverse dynamics control module, and inputs the output of the incremental inverse dynamics control module to the current vector inverse transformation module.

[0026] Alternatively, the system includes a sampling module, a current vector conversion module, a current control module, and an incremental inverse dynamics module; The sampling module captures the original current, The current vector transformation module inputs the original current into the current vector transformation module to generate first target data; The current control module inputs the first target data into a current control loop and simultaneously performs time differentiation on the first target data to generate second target data;

[0027] The incremental inverse dynamics module simultaneously inputs the second target data and the output of the current control loop to the incremental inverse dynamics control module, and inputs the output of the incremental inverse dynamics control module to the current vector inverse transformation module.

[0028] The current vector conversion module and the current vector inverse conversion module are based on the current vector control theory, and convert AC current to DC current as easily as DC current. First, AC current is converted to DC current (current vector conversion module) to realize control in the DC current environment, and then DC current is converted to AC current (current vector inverse conversion module) to control the AC motor (see Figure 3). The current vector conversion module includes Clarke transformation and Park transformation (see Figure 3). The current vector inverse conversion module includes Park inverse transformation, space vector bandwidth modulation, and Clarke inverse transformation (three-phase inverter) (see Figure 3). The expression of the incremental inverse dynamics control module is as follows: JPEG0007657361000003.jpg53167,

[0029] Where, Δu d and Δu q are the control increments of the d and q axes, and v d and v q is the virtual control variable during inverse dynamics control, JPEG0007657361000004.jpg24132 is the current i at the sampling point d and i q is the time derivative of u d Tou q are the current sampled values ​​of the d-axis and q-axis control outputs, and u d0 , u q0 are the previous sampled values ​​of the d-axis and q-axis control outputs, respectively, and L d is the d-axis inductance, and L q is the q-axis inductance.

[0030] Specifically, as shown in FIG. 4, FIG. 4 is a principle block diagram of the adaptive current vector control according to an embodiment of the present invention. The mathematical models in the above-mentioned adaptive AC servo motor current control system of the embodiment of the present invention include a current model, a speed model and a position model, and the above three mathematical models are as follows: Current Model:

[0031] JPEG0007657361000005.jpg15170

[0032] JPEG0007657361000006.jpg15170 Speed ​​model:

[0033] JPEG0007657361000007.jpg14170 Position model:

[0034] JPEG0007657361000008.jpg14170

[0035] In the above formulas (1) to (4), the variables and parameters are defined as follows: d , i q are the d-axis and q-axis currents, L d is the d-axis inductance, L q is the q-axis inductance, ω m is the angular velocity of the rotor, p is the number of magnetic poles, T L is the unknown load torque input, B is the unknown resistance coefficient, J is the moment of inertia, R is the unknown equivalent impedance, θ is the rotor angle of the motor, ψ m is the magnetic flux of the permanent magnet, u d Tou q are the d-axis and q-axis control inputs.

[0036] As a matter of explanation, a permanent magnet synchronous motor, abbreviated as PMSM, refers to a synchronous motor in which the rotor uses permanent magnets instead of windings. Permanent magnet synchronous motors are divided into radial, axial or transverse types according to the magnetic flux method, and are determined by the arrangement of elements, and the efficiency, volume, weight and operating speed of various permanent magnet synchronous motors are different. The operating principle of a permanent magnet synchronous motor is the same as that of an electrically excited synchronous motor, but it replaces the excitation of the latter's field winding with magnetic flux from a permanent magnet, making the motor structure simpler. A PMSM is a synchronous motor that generates a synchronous rotating magnetic field by being excited by a permanent magnet, and the permanent magnet generates a rotating magnetic field as a rotor, and the three-phase stator winding induces three-phase symmetrical current by armature reaction under the action of the rotating magnetic field. At this time, the kinetic energy of the rotor is converted into electrical energy and the PMSM is used as a generator. In addition, when three-phase symmetrical current is introduced to the stator side, since the spatial positions of the three-phase stators are 120 apart, the three-phase stator current generates a rotating magnetic field in space, and the rotor moves due to the action of electromagnetic force in the rotating magnetic field. At this time, the electrical energy is converted into kinetic energy and the PMSM is used as a motor.

[0037] Unknown parameters and inputs (B,R,T L), the current model and the speed model are nonlinear and uncertain, and the PID control based on the linear system cannot ensure high performance. PID is an abbreviation of Proportional, Integral, and Differential. As the name suggests, the PID control algorithm is a control algorithm that combines three stages of proportional, integral, and differential into one. It is the most mature and most widely applied control algorithm in continuous systems. This control algorithm appeared in the 1930s and 1940s, and can be applied when the controlled object model is not clearly understood. Practical operation experience and theoretical analysis show that such control rules can achieve relatively satisfactory results when controlling many industrial processes. The essence of PID control is to perform calculations according to the proportional, integral, and differential function relationships based on the input deviation value, and use the calculation results to control the output. In addition, in PID control, the closed-loop control is a control method that calibrates based on the output feedback of the controlled object, which performs correction according to a constant or standard when the deviation between the actual and planned values ​​is measured. For example, when controlling the rotation speed of a motor, a sensor must be present to measure the rotation speed and the results must be fed back to the control circuit. When talking about closed-loop control algorithms, the simplest of them all is the PID. PID is an abbreviation for Proportion, Integral, and Differential coefficient, and represents three control algorithms. By combining these three algorithms, it is possible to effectively correct the deviation of the controlled object and achieve a stable state.

[0038] The embodiment of the present invention adopts the Gascade inverse dynamics control principle, which eliminates the need for nonlinear dynamics and kinematic models required for inverse dynamics control to obtain a complete linearization of the system. The specific implementation steps of the embodiment are as follows: first, Equation 1 and Equation 2 are used to timely sample to obtain the inverse dynamics control.

[0039] JPEG0007657361000009.jpg16170

[0040] JPEG0007657361000010.jpg15170

[0041] v in equations (5) and (6) d and v q is the virtual control variable during inverse dynamics control, JPEG0007657361000011.jpg24132 is the current i at the sampling point d and i q is the time derivative of u d Tou q are the current sampled values ​​of the d-axis and q-axis control outputs, and u d0 , u q0 are the previous sampled values ​​of the d-axis and q-axis control outputs, respectively, and i q0 and i d0 are the previous sampling values ​​of d-axis and q-axis currents. All servo motors can obtain incremental inverse dynamics current control under high-speed sampling (10 kHz) conditions.

[0042] Regarding the current vector conversion control according to the embodiment of the present invention, i.e., the control theory and method for a high-performance permanent magnet synchronous motor, for example, in a coordinate system M, T rotating at a synchronous angular speed ω1, if the M axis always faces the same direction as the rotor flux linkage vector, the torque of the asynchronous motor is determined by the stator current component i_M1 on the M axis, and the rotor flux linkage of the asynchronous motor is determined by the stator current component i_T1 on the T axis, and by controlling i_M1 and i_T1 respectively, complete non-interference between the control of torque and flux linkage is realized. JPEG0007657361000012.jpg31170

[0043] This result is the d-axis and q-axis current i d and i q Measure the time derivative of the current It is shown that the control algorithm obtained by calculating 24132 avoids the complex and uncertain (R) current model. The current derivative replaces the model and plays the role of controller adaptation in the inverse dynamics controller. The incremental control Δu d and Δu q By applying the above, the current system is completely linearized, stationary and decoupled, and Δu d and Δu q The inverse dynamics virtual control can adopt PID control with fixed parameters.

[0044] JPEG0007657361000014.jpg16170

[0045] JPEG0007657361000015.jpg17170Since the relative degrees of equations (1) and (2) are both 1, equations (9) and (10) can be simplified to PI control.

[0046] JPEG0007657361000016.jpg29170

[0047] However, K Pd , K Id and K Dd is the PID control coefficient for the d axis, and K Pq , K Iq and K Dq is the PID control coefficient for the q axis, and i dd and i qd are the control expectation values ​​of the d-axis and q-axis, given by the rotation speed control loop.

[0048] The embodiment of the present invention has the following features: 1. No adaptive control of the motor model is required. 2. It is a nonlinear control. 3. The control system is not sensitive to uncertain system parameters. 4. The control system is not sensitive to uncertain external interference. 5. The control system ensures closed-loop stability and high-performance control under any realistic interference load conditions. 6. The control algorithm is simple and easy to implement.

[0049] The above embodiment solves the technical problems in the prior art, that is, motor model identification, especially online model identification, significantly increases the complexity of the system, and model identification cannot ensure that accurate model and model parameters can be obtained, and fuzzy control, sliding mode control, control based on neural network, and model reference adaptive control cannot ensure algorithm stability and stable operation under load interference environment under any operating conditions. The numbers of the above embodiments of the present invention are merely for illustrative purposes and do not represent the superiority or inferiority of the embodiments.

[0050] In the above embodiments of the present invention, emphasis is placed on the description of each embodiment, and for parts not described in detail in one embodiment, reference can be made to the relevant descriptions of other embodiments.

[0051] It should be understood that in some embodiments provided by the present application, the technical contents disclosed can be realized in other ways. The above described device embodiments are only exemplary, for example, the division of the units is merely a division of logic functions, and there may be other division methods in actual implementation, for example, multiple units or assemblies may be combined or integrated into another system, or some features may be ignored or not implemented. In addition, the shown or discussed mutual couplings or direct couplings or communication connections may be indirect couplings or communication connections through some interfaces, units or modules, and may be electrical or other forms.

[0052] The units described as separate elements may or may not be physically separate. The elements shown as units may or may not be physical units, i.e., they may be located in the same place or distributed among multiple units. Some or all of the units may be selected according to actual needs to achieve the objectives of the technical means of the present embodiment.

[0053] In addition, each functional unit in each embodiment of the present application may be integrated into one processing unit, each unit may exist as a physically separate entity, or two or more units may be integrated into one unit. The integrated units may be realized in the form of hardware or software functional units.

[0054] The integrated unit may be realized in the form of a software functional unit and stored in a computer-readable storage medium when sold or used as an independent product. With this understanding, the technical solution of the present invention, in essence, or the part that has contributed to the prior art, or all or a part of the technical solution, may be embodied in the form of a software product, and such a computer software product is stored in a storage medium and includes some instructions for causing a computer device (such as a personal computer, a server, or a network device) to execute all or a part of the steps of the method according to each embodiment of the present invention. The above storage medium includes various media capable of storing program code, such as a USB memory, a read-only memory (ROM), a random access memory (RAM), a mobile disk, a magnetic disk, or an optical disk.

[0055] It should be noted that the above content is merely a preferred embodiment of the present invention, and a person skilled in the art may make various improvements and modifications without departing from the principles of the present invention, and these improvements and modifications should also be considered as within the scope of protection of the present invention.

Claims

1. 1. A method for adaptive AC servo motor current control, comprising: obtaining the original current; inputting the original current into a current vector conversion module to generate first target data; inputting the first target data into a current control loop and simultaneously generating second target data by time-differentiating the first target data; inputting the second target data and an output of the current control loop into an incremental inverse dynamics control module simultaneously, and inputting the output of the incremental inverse dynamics control module into a current vector inverse transformation module.

2. 2. The method of claim 1, wherein the original current is an original three-phase AC motor current.

3. The expression of the incremental inverse dynamics control module is as follows: and where Δu ｄ and Δu ｑ are the control increments of the d and q axes, and v ｄ and ｑ is the virtual control variable during inverse dynamics control, is the current at the sampling point i ｄ and i ｑ is the time derivative of u ｄ Tou ｑ are the current sampled values ​​of the d-axis and q-axis control outputs, and u ｄ０ , u ｑ０ are the previous sampled values ​​of the d-axis and q-axis control outputs, respectively, and L ｄ is the d-axis inductance, and L ｑ 3. The method of claim 2, wherein: is the q-axis inductance.

4. 4. The method according to claim 3, wherein the AC servo motor current control further includes a rotation speed control loop and a rotation angle position control loop.

5. An adaptive AC servo motor current control system, comprising: a sampling module, a current vector conversion module, a current control module, and an incremental inverse dynamics module; The sampling module captures the original current, The current vector conversion module inputs the original current into the current vector conversion module to generate first target data; The current control module inputs the first target data into the current control loop and simultaneously performs time differentiation on the first target data to generate second target data; The incremental inverse dynamics control module simultaneously inputs the second target data and an output of the current control loop to an incremental inverse dynamics control module, and inputs an output of the incremental inverse dynamics control module to a current vector inverse transformation module.

6. A non-volatile storage medium, the non-volatile storage medium including a program stored therein, the program, when executed, controlling an apparatus in which the non-volatile storage medium is placed to execute a method according to any one of claims 1 to 5.

7. An electronic device comprising a processor and a memory, wherein computer readable instructions are stored in the memory, the processor is adapted to execute the computer readable instructions, and when the computer readable instructions are executed, the electronic device performs a method according to any one of claims 1 to 5.

Images