Linear motor position dual-loop control system

By adopting a position-current dual-loop control structure in the linear motor position control system, the speed loop is eliminated. The inertial delay and quantization error problems introduced by the speed loop are solved by using the series control of a proportional integrator, a phase lead-lag compensator, and a low-pass filter. This improves the dynamic response speed and trajectory tracking accuracy, making it suitable for high-precision applications.

CN123122335APending Publication Date: 2026-11-17GREE ELECTRIC APPLIANCE INC OF ZHUHAI
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202611266303.7
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2026-08-20
Publication Date
2026-11-17

AI Technical Summary

Technical Problem

The existing three-loop nested control structure of permanent magnet synchronous linear motors suffers from slow dynamic response and low position tracking accuracy due to the large inertial delay and speed quantization error introduced by the speed loop, making it difficult to meet the control performance requirements of high-precision applications.

Method used

A position-current dual-loop control structure is adopted, eliminating the speed loop. A position controller consisting of a proportional integrator, a phase lead-lag compensator, and a low-pass filter connected in series, combined with a feedback transformation module and a coordinate transformation module, is used to construct a linear motor position dual-loop control system, achieving high-precision position and current linkage control.

Benefits of technology

It significantly improves the system's dynamic response speed and trajectory tracking accuracy, simplifies the control structure, is easy to implement in engineering, and is suitable for high-precision linear servo applications.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN123122335A_ABST
    Figure CN123122335A_ABST
Patent Text Reader

Abstract

This invention discloses a dual-loop position control system for a linear motor. The system includes a position controller, a current controller, a feedback transformation module, a coordinate transformation module, a modulation module, an inverter, and a linear motor with an encoder. The output of the position controller is connected to the inverter sequentially via the current controller, the coordinate transformation module, and the modulation module. The position controller includes a proportional-integral (PI) converter, a phase lead-lag compensator, and a low-pass filter connected in series. These components are used to sequentially perform proportional-integral, phase lead-lag compensation, and low-pass filtering on the position error before outputting a current setpoint. The feedback transformation module converts the three-phase current into a current feedback value and feeds it back to the current controller. This invention combines a PI converter, a phase lead-lag compensator, and a low-pass filter in series compensation on the basis of a dual-loop position and current control structure, ensuring system stability while improving the system's dynamic response speed and position tracking accuracy.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This invention relates to the field of motor control technology, and in particular to a dual-loop control system for the position of a linear motor. Background Technology

[0002] Currently, linear servo systems composed of permanent magnet synchronous linear motors possess the characteristics of high speed, high precision, and direct drive, and are widely used in precision manufacturing fields such as high-end CNC machine tools and high-precision welding robots. However, unlike traditional rotary motors driven by transmission mechanisms such as lead screws, the direct drive method of linear motors results in the absence of a buffer between the motor and the worktable. Therefore, external disturbances such as load disturbances and parameter perturbations directly affect the linear motor body, causing fluctuations in speed and electromagnetic torque, which in turn affects the trajectory tracking accuracy and dynamic frequency response performance of position control, making it difficult to meet the stringent control performance requirements of high-precision applications.

[0003] Currently, position servo control of permanent magnet synchronous linear motors typically employs a nested three-loop control structure of position, speed, and current. While this structure can achieve basic position control functions, it still has significant shortcomings in applications requiring extremely high trajectory tracking accuracy (such as high-precision CNC machine tools): First, the introduction of the speed loop adds a significant inertial delay to the system, limiting its dynamic response speed; second, due to limitations in encoder accuracy and speed measurement methods, the quantization error of the speed directly affects the final trajectory tracking accuracy of the system. Therefore, the traditional three-loop architecture struggles to simultaneously meet the dual requirements of dynamic response speed and steady-state tracking accuracy.

[0004] Therefore, how to eliminate the negative impact of the speed loop on the position response performance while ensuring system stability, and improve the dynamic response speed and trajectory tracking accuracy of the linear motor position dual-loop control system, is a technical problem that urgently needs to be solved in this field. Summary of the Invention

[0005] This invention provides a dual-loop position control system for linear motors, aiming to solve the technical problem that the existing three-loop nested control structure for permanent magnet synchronous linear motors suffers from slow dynamic response and low position tracking accuracy due to the large inertial delay and speed quantization error introduced by the speed loop.

[0006] In a first aspect, embodiments of the present invention provide a dual-loop position control system for a linear motor, comprising: a position controller, a current controller, a feedback transformation module, a coordinate transformation module, a modulation module, an inverter, and a linear motor with an encoder; the output terminal of the position controller is connected to the input terminal of the current controller, and the output terminal of the current controller is sequentially connected to the coordinate transformation module, the modulation module, and the inverter; the encoder is connected to the input terminal of the position controller and is used to acquire the actual position of the linear motor and feed it back to the position controller; the position controller is used to receive the position error between a given position command and the actual position. The position controller outputs a current setpoint based on the position error. It includes a proportional-integral converter, a phase-lead / lag compensator, and a low-pass filter connected in series, used sequentially to perform proportional-integral calculations, phase-lead / lag compensation calculations, and low-pass filtering on the position error. The feedback conversion module is connected to the inverter output and the current controller input, converting the three-phase current output by the inverter into a current feedback value and feeding it back to the current controller. The current controller outputs a voltage command based on the current setpoint and the current feedback value, and the modulation module modulates a switching configuration signal based on the voltage command to drive the inverter operation.

[0007] In the linear motor position dual-loop control system provided in this embodiment of the invention, the current controller includes a first current controller and a second current controller; the current setpoint includes a q-axis current setpoint and a d-axis current setpoint, the current feedback includes a q-axis current feedback and a d-axis current feedback, and the voltage command includes a q-axis voltage command and a d-axis voltage command; the first current controller is used to receive the q-axis current setpoint and the q-axis current feedback, and output the q-axis voltage command; the second current controller is used to receive the d-axis current setpoint and the d-axis current feedback, and output the d-axis voltage command; both the q-axis voltage command and the d-axis voltage command are input to the coordinate transformation module, and after being processed by the modulation module, drive the inverter to operate.

[0008] In the linear motor position dual-loop control system provided in this embodiment of the invention, the feedback transformation module includes a first transformation unit and a second transformation unit; the input terminal of the first transformation unit is connected to the output terminal of the inverter, and is used to transform the three-phase current output by the inverter from a three-phase stationary coordinate system to a two-phase stationary coordinate system; the input terminal of the second transformation unit is connected to the output terminal of the first transformation unit, and is used to transform the current in the two-phase stationary coordinate system to a two-phase rotating coordinate system to obtain the q-axis current feedback value and the d-axis current feedback value.

[0009] In the linear motor position dual-loop control system provided in this embodiment of the invention, the given value of the d-axis current is zero.

[0010] In the linear motor position dual-loop control system provided in this embodiment of the invention, the transfer function expression of the position controller is: in, Let be the transfer function of the proportional-integral converter. Let be the transfer function of the phase lead-lag compensator. Let be the transfer function of the low-pass filter.

[0011] In the linear motor position dual-loop control system provided in this embodiment of the invention, the transfer function expression of the proportional-integral converter is: Where, k pi τ is the gain coefficient of the proportional-integral converter, and τ is the zero-point time constant of the proportional-integral converter.

[0012] In the linear motor position dual-loop control system provided in this embodiment of the invention, the transfer function expression of the phase lead-lag compensator is: Wherein, τ1 is the zero-point time constant of the phase lead-lag compensator, and τ2 is the pole-point time constant of the phase lead-lag compensator.

[0013] In the linear motor position dual-loop control system provided in this embodiment of the invention, the low-pass filter is a second-order low-pass filter, and the transfer function expression of the low-pass filter is: Where w1 is the low-pass corner frequency of the low-pass filter. is the low-pass damping ratio of the low-pass filter.

[0014] In the linear motor position dual-loop control system provided in this embodiment of the invention, the open-loop transfer function expression of the linear motor position dual-loop control system is: Among them, K f Let M be the thrust coefficient of the linear motor, and M be the equivalent mass coefficient of the linear motor.

[0015] In the linear motor position dual-loop control system provided in this embodiment of the invention, the parameters of the position controller are tuned based on the open-loop shear frequency and mid-frequency bandwidth of the linear motor position dual-loop control system.

[0016] The linear motor position dual-loop control system provided in this invention adopts a position-current dual-loop control structure, eliminating the speed loop and removing the influence of speed measurement noise and delay on position response. The position controller consists of a proportional-integral converter, a phase lead-lag compensator, and a low-pass filter connected in series. While ensuring system stability, it effectively increases the open-loop cutoff frequency of the position loop, significantly enhancing dynamic response performance. The system effectively reduces steady-state and dynamic errors in sinusoidal trajectory tracking and step positioning through the mid-frequency phase margin provided by the phase lead-lag compensator. Simultaneously, the low-pass filter attenuates high-frequency noise, ensuring signal smoothness and further improving position tracking accuracy. This control scheme has a simple structure, convenient frequency domain parameter tuning, requires no complex iterations or nonlinear calculations, is easy to implement in engineering, and is suitable for high-precision linear servo applications with high requirements for trajectory tracking accuracy and dynamic response. Attached Figure Description

[0017] To more clearly illustrate the technical solutions of the embodiments of the present invention, the drawings used in the following description of the embodiments will be briefly introduced. Obviously, the drawings described below are some embodiments of the present invention. For those skilled in the art, other drawings can be obtained based on these drawings without creative effort.

[0018] Figure 1 This is a system schematic diagram of a linear motor position dual-loop control system provided in an embodiment of the present invention. Figure 2 This is a block diagram of the internal structure of a position controller provided in an embodiment of the present invention; Figure 3 Bode plot of the linear motor position dual-loop control system provided in the embodiment of the present invention.

[0019] Figure label: 10. Position controller; 11. Proportional-integral converter; 12. Phase lead-lag compensator; 13. Low-pass filter; 20. Current controller; 21. First current controller; 22. Second current controller; 30. Feedback conversion module; 31. First conversion unit; 32. Second conversion unit; 40. Coordinate transformation module; 50. Modulation module; 60. Inverter; 70. Linear motor; 701. Encoder. Detailed Implementation

[0020] The technical solutions of the embodiments of the present invention will be clearly and completely described below with reference to the accompanying drawings. Obviously, the described embodiments are only some, not all, of the embodiments of the present invention. Based on the embodiments of the present invention, all other embodiments obtained by those skilled in the art without creative effort are within the scope of protection of the present invention.

[0021] It should be understood that, when used in this specification and the appended claims, the terms "comprising" and "including" indicate the presence of the described features, integrals, steps, operations, elements and / or components, but do not exclude the presence or addition of one or more other features, integrals, steps, operations, elements, components and / or collections thereof.

[0022] It should also be understood that the terminology used in this specification is for the purpose of describing particular embodiments only and is not intended to limit the invention. As used in this specification and the appended claims, the singular forms “a,” “an,” and “the” are intended to include the plural forms unless the context clearly indicates otherwise.

[0023] It should also be further understood that the term "and / or" as used in this specification and the appended claims refers to any combination of one or more of the associated listed items and all possible combinations, and includes such combinations.

[0024] As used in this specification and the appended claims, the term "if" may be interpreted, depending on the context, as "when," "once," "in response to determination," or "in response to detection." Similarly, the phrase "if determined" or "if [described condition or event] is detected" may be interpreted, depending on the context, as "once determined," "in response to determination," "once [described condition or event] is detected," or "in response to detection of [described condition or event]."

[0025] To facilitate understanding of the present invention, the linear motor position dual-loop control system provided in the embodiments of the present invention will first be described. Please refer to... Figure 1 and Figure 2This invention provides a dual-loop position control system for a linear motor. The system includes: a position controller 10, a current controller 20, a feedback transformation module 30, a coordinate transformation module 40, a modulation module 50, an inverter 60, and a linear motor 70 with an encoder 701. The output of the position controller 10 is connected to the input of the current controller 20, and the output of the current controller 20 is sequentially connected to the coordinate transformation module 40, the modulation module 50, and the inverter 60. The encoder 701 is connected to the input of the position controller 10 and is used to acquire the actual position of the linear motor 70 and feed it back to the position controller 10. The position controller 10 is used to receive the position error between a given position command and the actual position, and output a current setpoint value according to the position error. The position controller 10 includes proportional-integral converters 11 connected in series. A phase lead-lag compensator 12 and a low-pass filter 13 are used sequentially to perform proportional-integral calculation, phase lead-lag compensation calculation, and low-pass filtering on the position error. The feedback conversion module 30 is connected to the output terminal of the inverter 60 and the input terminal of the current controller 20, and is used to convert the three-phase current output by the inverter 60 into a current feedback value and feed it back to the current controller 20. The current controller 20 outputs a voltage command according to the current setpoint and the current feedback value, and the modulation module 50 modulates a switching configuration signal according to the voltage command to drive the inverter 60 to operate.

[0026] In specific implementation, see Figure 1 This linear motor position dual-loop control system eliminates the speed loop and adopts a dual-loop control structure consisting of a position outer loop and a current inner loop. The system mainly consists of a position controller 10, a current controller 20, a feedback transformation module 30, a coordinate transformation module 40, a modulation module 50, an inverter 60, and a linear motor 70 with an encoder 701. The position controller 10, as the core of the outer loop of the entire servo system, receives the given position command θ from the upper control system. ref Simultaneously, it receives the actual position θ1, which is acquired and fed back in real time by the encoder 701 on the linear motor 70. The encoder 701 is a linear encoder ruler used to achieve high-precision position feedback. The position controller 10 uses a built-in comparison module to compare the given position command θ. refThe position error, reflecting the current tracking state of the system, is obtained by performing a difference calculation between the position error and the actual position θ1. This position error is then sequentially fed into a proportional-integral (PI) converter 11, a phase lead-lag compensator 12, and a low-pass filter 13 connected in series within the position controller 10. The PI converter 11 effectively eliminates the steady-state position error during long-term system operation through proportional gain and integration. The phase lead-lag compensator 12 actively compensates for the inherent phase lag characteristic of the linear motor 70, a typical dual-integral control object, by introducing specific zeros and poles, providing sufficient phase margin near the system's open-loop cutoff frequency and significantly widening the effective bandwidth of the position loop. The low-pass filter 13, located at the end of the link, filters out high-frequency noise superimposed during the transmission of the position error signal, enhancing the system's ability to suppress high-frequency interference and ensuring the smoothness of the current setpoint sent to the current controller 20. After the series processing of these three stages, the position controller 10 outputs the required current setpoint, which serves as the command input for the inner loop.

[0027] The current controller 20, as the inner core of the servo system, receives the current setpoint from the position controller 10 at its input. Simultaneously, the feedback transformation module 30, located on the system feedback path, continuously monitors and processes the three-phase current output from the inverter 60, converting it into a current feedback value recognizable by the current controller 20 and sending it to its input. The current controller 20 compares the deviation between the current setpoint and the current feedback value, and outputs a corresponding voltage command through its internal calculation logic. This voltage command is then sent downstream to the coordinate transformation module 40, which converts the voltage command into a voltage component u in a two-phase stationary coordinate system suitable for the input of the modulation module 50, based on the system's coordinate system mapping. α * and u β *. Modulation module 50 receives the voltage component u α *、u β Finally, a set of high-frequency switching configuration signals S is generated through the internal space vector pulse width modulation (SVPWM) operation logic. a S b S c (i.e., PWM wave), and outputs this configuration signal to inverter 60. Inverter 60 then processes the switching configuration signal S. a S b S c The internal power switching transistors (such as IGBTs or MOSFETs) are turned on and off, thereby generating the required three-phase drive currents ia, ib, and ic in the stator windings of the linear motor 70, driving the mover of the linear motor 70 to move in a linear direction.

[0028] The feedback conversion module 30 is connected to the output of the inverter 60 and the input of the current controller 20, and it mainly undertakes the inner loop feedback function in the entire dual-loop system. In actual operation, the three-phase currents ia, ib, and ic output by the inverter 60 are acquired and conditioned by the feedback conversion module 30. Through internal coordinate transformation calculations, the three-phase currents are converted into the current feedback values ​​and fed back to the input of the current controller 20, thereby forming a complete current closed-loop control. The position controller 10 and the current controller 20 cooperate to form a dual-loop control structure with a position outer loop and a current inner loop connected in series: the outer loop generates current commands through position error correction, and the inner loop quickly tracks the current commands through current deviation, realizing high-precision position and current linkage control of the linear motor 70.

[0029] By employing a dual-loop control structure consisting of an outer position loop and an inner current loop, and using a linear control link in the outer position loop consisting of a proportional-integral converter 11, a phase lead-lag compensator 12, and a low-pass filter 13 connected in series, the large inertial delay and velocity quantization error problems introduced by the velocity loop in traditional three-loop control structures are avoided. The introduction of the phase lead-lag compensator 12 allows the system to effectively widen the bandwidth of the position loop without sacrificing stability, while the low-pass filter 13 provides good high-frequency noise suppression while maintaining high dynamic response characteristics. This control structure is simple, and parameters can be quickly tuned based on the frequency domain, making it highly valuable for industrial engineering applications, especially suitable for high-precision linear servo applications requiring high trajectory tracking accuracy and dynamic response.

[0030] In one embodiment, reference is made to Figure 1 The current controller 20 includes a first current controller 21 and a second current controller 22; the current setpoint includes a q-axis current setpoint and a d-axis current setpoint, the current feedback includes a q-axis current feedback and a d-axis current feedback, and the voltage command includes a q-axis voltage command and a d-axis voltage command; the first current controller 21 is used to receive the q-axis current setpoint and the q-axis current feedback, and output the q-axis voltage command; the second current controller 22 is used to receive the d-axis current setpoint and the d-axis current feedback, and output the d-axis voltage command; both the q-axis voltage command and the d-axis voltage command are input to the coordinate transformation module 40, and after being processed by the modulation module 50, drive the inverter 60 to operate.

[0031] In practice, the current controller 20 is not a single-channel controller, but rather consists of two independent channels: a first current controller 21 and a second current controller 22. Under the vector control framework, the stator current of the permanent magnet synchronous linear motor 70 is decomposed into mutually orthogonal q-axis and d-axis components. The q-axis component is responsible for generating the electromagnetic thrust required for the linear motion of the motor and is the core of torque control; the d-axis component is used to adjust the internal magnetic field strength of the motor, which is typically controlled to zero in conventional field-oriented control. Therefore, the position controller 10 adjusts the position according to the given position command θ. ref The position error output current setpoint between the encoder 701 and the actual position θ1 is shunted into the q-axis current setpoint i. qref and d-axis current setpoint i dref The current is fed into the corresponding first current controller 21 and second current controller 22 respectively.

[0032] Feedback conversion module 30 decomposes the three-phase current output by inverter 60 into mutually orthogonal q-axis current feedback values ​​i. q and d-axis current feedback value i d The current is then fed into the corresponding first current controller 21 and second current controller 22, respectively. The input terminal of the first current controller 21 receives the q-axis current setpoint i. qref With q-axis current feedback value i q The deviation signal between the two is obtained through internal comparison calculation, and after proportional-integral operation, the q-axis voltage command u is output. q *; The input terminal of the second current controller 22 receives the d-axis current setpoint i dref With d-axis current feedback value i d Similarly, after proportional-integral calculation, the output d-axis voltage command u is performed. d *. q-axis voltage command u q * and d-axis voltage command u d Together they constitute the complete output of the current controller 20, and both are simultaneously sent to the downstream coordinate transformation module 40.

[0033] Coordinate transformation module 40 receives q-axis voltage command u q * and d-axis voltage command u d Finally, based on the current rotor position information of the motor, a coordinate transformation calculation is performed to convert the voltage commands in the two rotating coordinate systems into voltage components u in the two-phase stationary coordinate system. α * and u β * Then, it is input into the modulation module 50. The modulation module 50 converts the two voltage components into a high-frequency switching configuration signal S using algorithms such as space vector modulation. a S b S cThe inverter 60 outputs three-phase drive current, thereby achieving coordinated and precise control of the two current loops of the q-axis and d-axis.

[0034] By dividing the current controller 20 into two independent channels, the first current controller 21 and the second current controller 22, and independently regulating the q-axis current and d-axis current respectively, the system can accurately control the electromagnetic thrust and excitation state of the motor, effectively improving the dynamic response speed and current tracking accuracy of the linear motor position dual-loop control system.

[0035] Furthermore, referring to Figure 1 The feedback transformation module 30 includes a first transformation unit 31 and a second transformation unit 32. The input terminal of the first transformation unit 31 is connected to the output terminal of the inverter 60, and is used to transform the three-phase current output by the inverter 60 from a three-phase stationary coordinate system to a two-phase stationary coordinate system. The input terminal of the second transformation unit 32 is connected to the output terminal of the first transformation unit 31, and is used to transform the current in the two-phase stationary coordinate system to a two-phase rotating coordinate system to obtain the q-axis current feedback value and the d-axis current feedback value.

[0036] In practical implementation, the feedback conversion module 30 is a key component in the inner current feedback path. Its core function is to convert the three-phase physical current output by the inverter 60 into a current feedback value in a rotating coordinate system suitable for processing by the current controller 20. The feedback conversion module 30 is composed of a first conversion unit 31 and a second conversion unit 32 connected in series, forming a clear cascade relationship in the signal processing sequence. The first conversion unit 31 is the Clark conversion unit, whose input terminal is connected to the output terminal of the inverter 60, receiving the three-phase current (i.e., i...) output by the inverter 60. a i b i c The first transformation unit 31 converts the current in the three-phase stationary coordinate system into the current in the two-phase stationary coordinate system (i.e., α-axis current and β-axis current) through algebraic operations based on the phase relationship between the three-phase currents, thus completing the initial dimensionality reduction transformation from three-phase to two-phase.

[0037] The second transformation unit 32 is the Park transformation unit. Its input is connected to the output of the first transformation unit 31, receiving the current in the two-phase stationary coordinate system output by the first transformation unit 31. The second transformation unit 32 also receives rotor position angle information from the encoder 701 or the position sensor, and uses this position angle information to perform a rotational transformation on the current in the two-phase stationary coordinate system, mapping it to the dq coordinate system that rotates synchronously with the rotor magnetic field. After transformation by the second transformation unit 32, the current in the two-phase stationary coordinate system is decomposed into mutually orthogonal q-axis current feedback values ​​i. q and d-axis current feedback value id Among them, the q-axis current feedback value i q Characterizing the torque current component used to generate electromagnetic thrust, the d-axis current feedback value i d Characterizes the excitation current component used to regulate the magnetic field of the motor.

[0038] The output of the second conversion unit 32 is connected to the inputs of the first current controller 21 and the second current controller 22 in the current controller 20, respectively, to convert the decoupled q-axis current feedback value i q and d-axis current feedback value i d The signals are fed into the corresponding current controller 20 channels to provide accurate and real-time feedback signals for the closed-loop regulation of the current controller 20. Through the cascaded processing of the first conversion unit 31 and the second conversion unit 32, the feedback conversion module 30 realizes the complete transformation from physical three-phase current to the q-axis and d-axis current feedback values ​​in the rotating coordinate system, providing the necessary data foundation for the precise control of the inner current loop.

[0039] By setting the feedback conversion module 30 as the first conversion unit 31 and the second conversion unit 32 connected in series, the precise conversion of the three-phase current output by the inverter 60 to the current feedback value in the rotating coordinate system is realized, enabling the current controller 20 to adjust independently based on the decoupled q-axis and d-axis current feedback values, thereby effectively improving the control accuracy and dynamic response speed of the inner current loop.

[0040] In one embodiment, the d-axis current setpoint is zero.

[0041] In specific implementation, in the vector control strategy of the permanent magnet synchronous linear motor 70, the d-axis current setpoint i dref The system is set to zero, employing a field-oriented control strategy. This involves controlling the excitation component of the stator current to zero, thus converting the entire stator current into the torque component that generates electromagnetic thrust. Specifically, the q-axis current setpoint i qref The position controller 10 generates and outputs the value based on the position error, while the d-axis current setpoint i dref The zero value is then directly assigned. The second current controller 22 receives this zero value as its given input and feeds back the d-axis current value i. d Compared to zero, the actual d-axis current i is adjusted through closed-loop control. d Always track zero setpoint. By setting the d-axis current setpoint to zero, the additional copper loss and magnetic circuit saturation caused by the excitation current are avoided, allowing the stator current to be converted into electromagnetic thrust with optimal efficiency, thereby maximizing the output of the linear motor's thrust.

[0042] By setting the d-axis current setpoint to zero, the permanent magnet synchronous linear motor 70 operates in a field-oriented control state, with all stator current used to generate the thrust required for linear motion. This achieves minimum current control while ensuring thrust control accuracy, effectively improving the system's energy efficiency and thrust density.

[0043] In one embodiment, the transfer function expression of the position controller 10 is: in, The transfer function of the proportional-integral unit 11 is... The transfer function of the phase lead-lag compensator 12 is given by [reference to transfer function]. The transfer function of the low-pass filter 13 is given.

[0044] In specific implementation, the overall transfer function of the position controller 10 The transfer function of proportional integrator 11 The transfer function of phase lead-lag compensator 12 and the transfer function of low-pass filter 13 The three components are multiplied in series. This product relationship indicates that the position error signal is processed in series through the above three stages. Used to perform proportional-integral operations on position errors to eliminate steady-state position errors in the system; Used for phase compensation of position error signals, improving the phase margin of the system by introducing specific zeros and poles; Used for low-pass filtering of the processed signal to suppress high-frequency noise components. The overall transfer function after the three components are connected in series. This determines the final response characteristics of the position controller 10 to position errors. Through the cooperation of the above-mentioned series structure, the position controller 10 can simultaneously achieve multiple control objectives such as low-frequency gain enhancement, mid-frequency phase rise, and high-frequency attenuation suppression, providing a stable mathematical basis for the precise control of the outer loop of the position.

[0045] The transfer function of the position controller 10 is expressed as the series product of the transfer functions of the proportional-integral unit 11, the phase lead-lag compensator 12, and the low-pass filter 13. This clarifies the signal transmission relationship and mathematical combination logic between the various components within the position controller 10, providing a clear mathematical model basis for subsequent controller parameter tuning based on frequency domain methods.

[0046] In one embodiment, the transfer function expression of the proportional-integral converter 11 is: Where, k piτ is the gain coefficient of the proportional-integral unit 11, and τ is the zero-point time constant of the proportional-integral unit 11.

[0047] In specific implementation, the transfer function of the proportional-integral converter 11 It contains an integral element 1 / s and a component k pi The proportional-integral control element is determined by τ. The numerator of this transfer function, k... pi (τs+1) reflects the combined effect of proportional and integral operations, where the zero point s=﹣1 / τ determines the frequency transition point of the proportional-integral converter 11 from proportional dominance to integral dominance. Gain coefficient k pi The overall gain level of the proportional-integral (PI) circuit 11 is determined, directly affecting the amplitude of the position error response. The zero-point time constant τ determines the cutoff frequency of the PI circuit; that is, at frequency 1 / τ, the amplitude-frequency response curve of the PI circuit 11 transitions from the proportional-dominated region to the integral-dominated region. Below 1 / τ, Approximately k pi / s, exhibiting high-gain integral characteristics, can effectively eliminate the steady-state position error of the system; at frequencies higher than 1 / τ, Approximately k pi τ, exhibiting proportional control characteristics, provides a fast transient response.

[0048] In the frequency domain design of the position controller 10, k pi The selection of k and τ usually follows these principles: increase k pi It can improve the system's response speed, but an excessively large k pi This may lead to overshoot or system oscillation; increasing τ can lower the corner frequency of the proportional-integral unit 11, enhancing low-frequency gain, but will reduce the phase margin in the mid-frequency range. Adjusting k... pi The values ​​of k and τ can be adjusted to change the low-frequency gain of the position loop, thereby improving the system's trajectory tracking capability and eliminating steady-state position errors. In practical engineering applications, k... pi The tuning of τ is usually combined with the requirements of open-loop cutoff frequency and mid-frequency bandwidth to ensure that the position controller 10 has sufficient gain in the low-frequency range to eliminate steady-state error, and sufficient phase margin in the mid-frequency range to ensure system stability and dynamic response. The main contribution of the proportional-integral unit 11 is concentrated in the low-frequency range. Through high low-frequency gain, it ensures that the linear motor 70 can accurately track the given position command in steady state and is not affected by static error.

[0049] By analyzing the transfer function of the proportional-integral (PI) converter 11, its functions of low-frequency gain enhancement and steady-state error elimination in the position controller 10 are clearly defined. The PI converter 11 has a simple structure and clearly defined physical meanings for its parameters, providing a clear and easily implemented basis for parameter adjustment in the frequency domain design of the position controller 10.

[0050] In one embodiment, the transfer function expression of the phase lead-lag compensator 12 is: Wherein, τ1 is the zero-point time constant of the phase lead-lag compensator 12, and τ2 is the pole-point time constant of the phase lead-lag compensator 12.

[0051] In practical implementation, the phase lead-lag compensator 12 is the core component of the position controller 10 used to adjust the phase characteristics of the system, and its transfer function Composed of a zero s = -1 / τ1 and a pole s = -1 / τ2, this compensator can accurately compensate for the phase response of the system in the mid-frequency range by properly configuring the relative positions of the zero and pole. When the zero-point time constant τ1 is greater than the pole-point time constant τ2, the zero-point frequency 1 / τ1 is lower than the pole frequency 1 / τ2. This compensator provides a positive phase lead in the mid-frequency range between the zero-point frequency and the pole frequency, with its maximum phase lead occurring at frequency τ1 / τ2. At this point, the magnitude of the phase lead depends on the ratio of τ1 to τ2, i.e., the zero-pole frequency ratio. By adjusting the ratio of τ1 and τ2, the magnitude of the phase lead and the frequency band in which the phase lead occurs can be precisely adjusted.

[0052] The main function of the phase lead-lag compensator 12 in the position controller 10 is to compensate for the 1 / s delay caused by the double integral characteristic of the controlled object (i.e., the permanent magnet synchronous linear motor 70). 2 The introduced phase lag. Without compensation, the dual-integral object provides approximately -180° phase near the crossover frequency, resulting in insufficient system phase margin. The phase lead-lag compensator 12 introduces positive phase lead in the mid-frequency band, raising the phase response in this band and effectively increasing the system's phase margin. In practical applications, the selection of τ1 and τ2 is usually related to the open-loop cutoff frequency and mid-frequency bandwidth of the position controller 10. By reasonably configuring the positions of the zeros and poles, the position loop obtains sufficient phase margin near the cutoff frequency, thereby widening the effective bandwidth of the system. The zero-pole configuration of the phase lead-lag compensator 12 should satisfy the following: the zero-point time constant τ1 should be slightly smaller than the time constant corresponding to the system's open-loop cutoff frequency to provide maximum phase lead at the cutoff frequency; the pole time constant τ2 should be much smaller than the zero-point time constant τ1 to ensure that the phase lead fully functions in the required frequency band, while avoiding excessive gain boost in the high-frequency band. The phase lead-lag compensator 12 mainly functions in the mid-frequency range of the system. By raising the phase at the crossover frequency, it significantly improves the dynamic response speed of the system while ensuring system stability.

[0053] By defining the transfer function of the phase lead-lag compensator 12, its phase compensation and bandwidth widening functions in the position controller 10 are clarified. The phase lead-lag compensator 12 features flexible zero-pole configuration and intuitive parameter physical meaning, effectively matching the dual-integral characteristics of the permanent magnet synchronous linear motor 70. This provides a precise and easily implemented mathematical tool for improving the dynamic response performance of the linear motor's dual-loop position control system.

[0054] In one embodiment, the low-pass filter 13 is a second-order low-pass filter, and the transfer function expression of the low-pass filter 13 is: Where w1 is the low-pass corner frequency of the low-pass filter 13. It is the low-pass damping ratio of the low-pass filter 13.

[0055] In specific implementation, the low-pass filter 13 adopts a second-order low-pass filter structure. Compared with the first-order low-pass filter, the second-order low-pass filter 13 has a steeper amplitude attenuation characteristic in the high-frequency band, which can more effectively suppress high-frequency noise components while maintaining good passband flatness. Its transfer function The low-pass cutoff frequency w1 and the low-pass damping ratio ξ are jointly determined. The low-pass cutoff frequency w1 determines the cutoff frequency of the low-pass filter 13, that is, above this frequency, the filter begins to significantly attenuate the high-frequency components of the signal; the low-pass damping ratio ξ determines the shape of the amplitude-frequency response curve of the filter near the cutoff frequency. When ξ is around 0.707, the filter has the flattest passband characteristics (i.e., Butterworth response). When the value of ξ is too small, the filter will have an amplitude spike at the cutoff frequency (i.e., underdamped response). When the value of ξ is too large, the amplitude-frequency response of the filter attenuates too quickly at the cutoff frequency (i.e., overdamped response).

[0056] In practical configuration, by appropriately selecting w1 and ξ, the low-pass filter 13 can provide an amplitude attenuation slope of -40dB / dec in the high-frequency range of the system. Specifically, at frequencies much higher than w1, the amplitude of the second-order low-pass filter 13 attenuates by 40dB per decade. This amplitude attenuation characteristic effectively suppresses quantization noise from the encoder 701, switching frequency harmonics, and high-frequency noise interference introduced by electronic components. Compared to the first-order low-pass filter, the second-order low-pass filter 13 provides a steeper high-frequency attenuation slope at the same cutoff frequency, thus more effectively suppressing the influence of high-frequency disturbances in position control. The main function of the low-pass filter 13 is in the high-frequency range of the system; its amplitude attenuation characteristic ensures that the system gain at high frequencies is much less than 1, thereby preventing system oscillation or instability caused by high-frequency noise entering the control loop through the position controller 10 and current controller 20. Meanwhile, the selection of w1 should fully consider the open-loop cutoff frequency of the position controller 10. Usually, w1 should be set to several times or more of the cutoff frequency to ensure that the phase lag introduced by the low-pass filter 13 at the open-loop cutoff frequency of the system will not significantly affect the phase margin of the system. That is, the low-pass filter 13 should provide the strongest possible high-frequency attenuation capability without affecting the stability of the system.

[0057] By setting the low-pass filter 13 as a second-order low-pass filter and specifying its transfer function, the high-frequency noise suppression function of the low-pass filter 13 in the position controller 10 is clarified. The second-order low-pass filter 13 effectively suppresses interference from encoder quantization noise and switching frequency harmonics by providing an amplitude attenuation slope of -40dB / dec in the high-frequency band of the system. This provides an effective engineering implementation method for enhancing the anti-interference capability and steady-state accuracy of the linear motor position dual-loop control system in complex electromagnetic environments.

[0058] Based on the above, the transfer function expression of the position controller 10 is: Where, k pi τ is the gain coefficient of the proportional-integral unit 11, τ is the zero-point time constant of the proportional-integral unit 11, τ1 is the zero-point time constant of the phase lead-lag compensator 12, τ2 is the pole time constant of the phase lead-lag compensator 12, w1 is the low-pass corner frequency of the low-pass filter 13, and ξ is the low-pass damping ratio of the low-pass filter 13.

[0059] In specific implementation, the complete transfer function of the position controller 10 is derived from the transfer function of the proportional-integral converter 11. The transfer function of phase lead-lag compensator 12 And the transfer function of the second-order low-pass filter 13 The three factors are then multiplied in series. This comprehensive expression clearly demonstrates the complete frequency domain characteristics of the position controller 10 from input to output. See also... Figure 3 In the low-frequency range, the integral element 1 / s of the proportional-integral converter 11 provides an infinitely large low-frequency gain, ensuring complete elimination of position errors and achieving steady-state error-free tracking. As the frequency increases to near the zero-point frequency 1 / τ, the amplitude-frequency response of the proportional-integral converter 11 begins to flatten, and the proportional action gradually becomes dominant, allowing the controller to maintain sufficient gain in the low-to-mid-frequency range to ensure tracking capability. In the mid-frequency range (i.e., near the open-loop cutoff frequency of the position controller 10), the zero point s=﹣1 / τ1 and the pole point s=﹣1 / τ2 of the phase lead-lag compensator 12 begin to function. By reasonably configuring the ratio of τ1 to τ2, a designable positive phase lead is generated at the cutoff frequency, effectively compensating for the phase lag introduced by the dual-integral object of the permanent magnet synchronous linear motor 70, increasing the phase margin in the mid-frequency range, and thus significantly widening the effective bandwidth of the position loop while ensuring system stability. In the high-frequency band, the second-order low-pass filter 13, with its amplitude attenuation slope of -40dB / dec, effectively suppresses high-frequency interference introduced by factors such as encoder quantization noise, inverter 60 switching frequency harmonics, and nonlinearity of electronic components, preventing high-frequency noise from entering the control loop and causing oscillations or steady-state jitter. The series product of the above three components accurately describes the full-frequency characteristics of the position controller 10: the low-frequency band is dominated by the proportional-integral unit 11, providing high gain and steady-state accuracy; the mid-frequency band is dominated by the phase lead-lag compensator 12, providing phase margin and dynamic response capability; and the high-frequency band is dominated by the low-pass filter 13, providing noise attenuation and system stability. By comprehensively considering the parameter tuning of the three components, i.e., adjusting k according to the requirements of the system open-loop cutoff frequency and mid-frequency bandwidth... pi The parameters such as τ, τ1, τ2, w1 and ξ can achieve the best comprehensive control performance in the full frequency range of the position controller 10, so that the linear motor position dual-loop control system can simultaneously have high steady-state accuracy, fast dynamic response and good anti-interference ability.

[0060] In one embodiment, the open-loop transfer function expression for the position of the linear motor position dual-loop control system is: Among them, K f M is the thrust coefficient of the linear motor 70, and M is the equivalent mass coefficient of the linear motor 70.

[0061] In practical implementation, the open-loop transfer function of the position This describes the complete control link from the input of position controller 10 (i.e., the position error between the given position command and the actual position) to the actual position output of linear motor 70. This transfer function is derived from the transfer function of position controller 10. Transfer function of the controlled object with linear motor 70 It is constructed by series multiplication.

[0062] In the controlled object section of linear motor 70, K f is the thrust coefficient, characterizing the proportional relationship between the input current and the output electromagnetic thrust of the linear motor 70, i.e., the magnitude of the thrust generated when a unit current is applied to the stator winding of the linear motor 70; M is the equivalent mass coefficient of the mover and load of the linear motor 70, characterizing the magnitude of the inertia of the system under the action of thrust. Therefore, the transfer function of the controlled object of the linear motor 70... The physical meaning is as follows: the current given value is passed through the thrust coefficient K. f The thrust is converted into electromagnetic thrust, which is then converted into acceleration via an equivalent mass M. This acceleration is then converted into actual position through two integration steps. Due to the presence of two integration steps (1 / s),... 2 The controlled object of the linear motor 70 exhibits typical double-integral characteristics in the frequency domain, namely, it has a large open-loop gain and an inherent phase lag of -180° in the low-frequency range.

[0063] When the transfer function of position controller 10 With the linear motor 70 controlled object After cascading, the open-loop transfer function of the system position The Bode plot will exhibit distinct three frequency band characteristics. In the low-frequency band, the integral element 1 / s of the proportional-integral unit 11 and the double integral element 1 / s of the controlled object... 2 The superposition results in an extremely high amplitude gain in the open-loop position transfer function at low frequencies, ensuring that the system can accurately track a given position command without steady-state error; in the mid-frequency range (i.e., near the open-loop cutoff frequency). The positive phase lead provided by the phase lead-lag compensator 12 effectively compensates for the -180° phase lag caused by the dual-integral stage of the controlled object, ensuring sufficient phase margin in the open-loop transfer function at the cutoff frequency and guaranteeing the system's stability and dynamic response capability. In the high-frequency range, the -40dB / dec amplitude attenuation provided by the low-pass filter 13 is superimposed on the amplitude attenuation of the controlled object itself, giving the position open-loop transfer function a steep amplitude drop slope in the high-frequency range, significantly enhancing the system's ability to suppress high-frequency noise and interference. Through design... Parameters of each stage (such as k) pi The open-loop transfer function can be precisely adjusted by considering τ, τ1, τ2, w1, and ξ. The frequency domain parameters such as cutoff frequency, phase margin, and gain margin enable the system to simultaneously possess high steady-state accuracy, fast dynamic response, and good anti-interference capability.

[0064] In one embodiment, the parameters of the position controller 10 are tuned based on the open-loop shear frequency and mid-bandwidth of the linear motor position dual-loop control system.

[0065] In practice, the parameter tuning of the position controller 10 is a crucial step in determining the control performance of the entire linear motor position dual-loop control system. In this embodiment, the tuning of the position controller 10 is based on the system's open-loop position transfer function. The frequency domain characteristics are designed based on two core frequency domain indicators: open-loop cutoff frequency and mid-bandwidth.

[0066] Open-loop shear frequency refers to the position open-loop transfer function. The frequency at which the amplitude-frequency response curve crosses the 0dB line is denoted as w. c This frequency determines the closed-loop bandwidth of the system's position loop and is a key indicator for measuring the system's dynamic response speed. A higher open-loop cutoff frequency results in a faster system response to a given position command and a wider effective bandwidth for the position loop; however, an excessively high cutoff frequency can lead to insufficient phase margin, easily causing oscillations or instability. Therefore, in practical engineering, the open-loop cutoff frequency should be rationally selected based on the dynamic response requirements of the application scenario and the controller's computational capabilities. For example, in applications requiring high-precision CNC machine tools or high-precision welding robots, where trajectory tracking speed is critical, the open-loop cutoff frequency can be set to a higher value (e.g., 300~500 rad / s); while in applications with more stringent stability requirements, the open-loop cutoff frequency can be appropriately reduced to obtain a more ample phase margin.

[0067] Mid-frequency bandwidth refers to the position open-loop transfer function The amplitude-frequency response curve has a width in the mid-frequency range between the slope inflection point at the high-frequency end and the slope inflection point at the low-frequency end. The mid-frequency bandwidth determines the system's gain change rate and phase response characteristics near the cutoff frequency. In frequency domain design, the mid-frequency characteristics directly determine the system's dynamic response performance and stability margin. Specifically, the zero-point time constant τ1 and pole-point time constant τ2 of the phase lead-lag compensator 12 need to be set around the open-loop cutoff frequency w. c Expand. The selection of the zero frequency 1 / τ1 and pole frequency 1 / τ2 of the phase lead-lag compensator 12 should satisfy the following: the zero frequency 1 / τ1 is usually set to the crossover frequency ω. c The frequency is set to 0.5 to 0.8 times the shear frequency to provide a significant phase lead near the shear frequency; the pole frequency 1 / τ2 is then set to the shear frequency ω. c The phase lead is 2 to 5 times that of the cutoff frequency to limit excessive boosting of high-frequency gain. By properly configuring τ1 and τ2, the magnitude of the phase lead and its frequency band can be precisely controlled, so that the system can obtain sufficient phase margin near the cutoff frequency (usually a phase margin greater than 45° is required to achieve a good trade-off between dynamic response and stability).

[0068] In the actual parameter tuning process, the open-loop shear frequency w is first determined according to the dynamic response requirements of the system. c Then, based on the design principle of mid-frequency bandwidth, the zero-pole time constants τ1 and τ2 of the phase lead-lag compensator 12 are determined. Next, the gain coefficient k of the proportional-integral converter 11 is set according to the steady-state accuracy requirements. pi The zero-point time constant τ is typically set to 2 to 5 times the time constant corresponding to the cutoff frequency to ensure that the phase lag introduced by the proportional-integral unit 11 near the cutoff frequency does not affect the system stability margin. Finally, the cutoff frequency w1 of the low-pass filter 13 is set according to the high-frequency noise suppression requirements (usually the cutoff frequency w1 is used). c The phase lag introduced by the low-pass filter 13 at the crossover frequency is sufficiently small (more than 5 times) to ensure that it does not interfere with the phase compensation effect of the system in the mid-frequency band. The above parameter tuning process iterates alternately in the frequency domain until the phase margin, gain margin, and crossover frequency of the position open-loop transfer function all meet the design requirements.

[0069] In one embodiment, to further understand the above system, the following is combined with... Figure 1 , Figure 2 and Figure 3 The linear motor position dual-loop control system is described in detail.

[0070] like Figure 1 As shown, the system employs a dual-loop control structure with a position outer loop and a current inner loop connected in series. In the position outer loop control, the encoder 701 acquires the actual position signal θ1 of the linear motor 70 in real time and feeds it back to the position controller 10. The position controller 10 receives the given position command θ. ref The difference between this difference and the actual position θ1 is calculated to obtain the position error signal. This position error signal is then input... Figure 2 The position controller 10, which consists of a proportional-integral converter 11, a phase lead-lag compensator 12, and a low-pass filter 13 connected in series, processes the data. After proportional-integral operation, phase lead-lag compensation operation, and low-pass filtering, it outputs the q-axis current setpoint i. qref Meanwhile, the d-axis current setpoint i dref Set to zero. The current setpoint i output by the position controller 10 qref and i dref The command input is sent to the current controller 20 as the inner loop.

[0071] In the inner current loop control, the three-phase current i output by inverter 60 is... a i b i cThe signal is acquired and conditioned by the feedback transformation module 30. The feedback transformation module 30 first performs Clark transformation through the first transformation unit 31, converting the current i in the three-phase stationary coordinate system... a i b i c Transformed into current i in a two-phase stationary coordinate system α i β Then, the second transformation unit 32 performs Park transformation, and based on the position and angle information provided by the encoder 701, the current i in the two-phase stationary coordinate system is transformed. α i β Transform to a two-phase rotating coordinate system to obtain the q-axis current feedback value i. q and d-axis current feedback value i d This data is fed back to the input terminals of the first current controller 21 and the second current controller 22 of the current controller 20, respectively. The first current controller 21 is based on the q-axis current setpoint i. qref With feedback value i q The deviation is calculated using proportional-integral operations, and the output is the q-axis voltage command u. q *; The second current controller 22 is based on the d-axis current setpoint i dref With feedback value i d The deviation is calculated using proportional-integral operations, and the resulting output is the d-axis voltage command u. d *

[0072] The current controller 20 outputs two voltage commands u q *、u d *The voltage command u in the rotating coordinate system is transmitted downstream to the coordinate transformation module 40. The coordinate transformation module 40 first performs an inverse Park transformation to convert the voltage command u in the rotating coordinate system. q *、u d *Converted to voltage components u in a two-phase stationary coordinate system α *、u β *. Modulation module 50 receives the voltage component u α *、u β Finally, a set of high-frequency switching configuration signals S is generated through the internal space vector pulse width modulation (SVPWM) operation logic. a S b S c (i.e., PWM wave), and outputs this configuration signal to inverter 60. Inverter 60 then processes the switching configuration signal S. a S b S c The internal power switching transistors are controlled to turn on and off, generating the required three-phase drive current i in the stator windings of the linear motor 70. a i b i cThe moving part of the linear motor 70 is driven to move in a straight line, ultimately enabling the actual position θ1 of the linear motor 70 to accurately track the given position command θ. ref .

[0073] like Figure 3 The Bode plot of the position controller 10 shown above has the amplitude-frequency response, with the vertical axis representing gain in decibels (dB) and the horizontal axis representing frequency (logarithmic scale), showing how much the system amplifies or attenuates signals at each frequency. The lower plot shows the phase-frequency response, with the vertical axis representing phase angle and the horizontal axis also representing frequency, showing how much the output signal lags or leads the input signal. Figure 3 This further illustrates the frequency domain effect of the above system using position-current dual-loop control: In the low-frequency range, the integral element 1 / s of the proportional-integral converter 11 provides extremely high low-frequency gain, ensuring the system has strong trajectory tracking capability and eliminating steady-state position errors. In the mid-frequency range, the positive phase lead introduced by the phase lead-lag compensator 12 effectively compensates for the inherent phase lag of the linear motor 70 dual-integral controlled object at -180°, significantly increasing the phase margin in the mid-frequency range. Figure 3 The region marked by "stability" significantly widens the effective bandwidth of the position loop while ensuring system stability, thus improving the dynamic response speed of the system. In the high-frequency band, the second-order low-pass filter 13 suppresses high-frequency components with an attenuation slope of -40dB / dec. Figure 3 The area marked "Noise Suppression Capability" effectively filters out high-frequency noise components introduced by encoder 701 quantization noise, inverter 60 switching frequency harmonics, and electromagnetic interference, preventing high-frequency disturbances from entering the inner loop and causing system oscillation. By rationally configuring the parameters of each component, this system can achieve excellent dynamic response speed while maintaining high steady-state accuracy, and also has excellent anti-high-frequency noise capability, effectively meeting the stringent requirements of high-precision linear servo applications.

[0074] In summary, the linear motor position dual-loop control system provided in this application employs a dual-loop control structure consisting of an outer position loop and an inner current loop. Within the outer position loop, a linear control link is created by sequentially connecting a proportional-integral converter, a phase lead-lag compensator, and a low-pass filter. This effectively eliminates the inertial delay and quantization error introduced by the speed loop. The phase lead-lag compensator widens the position loop bandwidth while ensuring the system's phase margin, and the low-pass filter effectively suppresses high-frequency noise. This system features a simple control structure, parameters that can be quickly tuned based on the frequency domain, and combines high steady-state accuracy, fast dynamic response, and good anti-interference capabilities, making it particularly suitable for high-precision linear servo applications.

[0075] The above description is merely a specific embodiment of the present invention, but the scope of protection of the present invention is not limited thereto. Any person skilled in the art can easily conceive of various equivalent modifications or substitutions within the technical scope disclosed in the present invention, and these modifications or substitutions should all be covered within the scope of protection of the present invention. Therefore, the scope of protection of the present invention should be determined by the scope of the claims.

Claims

1. A dual-loop position control system for a linear motor, characterized in that, include: Position controller, current controller, feedback transformation module, coordinate transformation module, modulation module, inverter, and linear motor with encoder; The output terminal of the position controller is connected to the input terminal of the current controller, and the output terminal of the current controller is sequentially connected to the coordinate transformation module, the modulation module, and the inverter. The encoder is connected to the input terminal of the position controller and is used to acquire the actual position of the linear motor and feed it back to the position controller. The position controller is used to receive the position error between the given position command and the actual position, and output a current given value according to the position error; the position controller includes a proportional integrator, a phase lead-lag compensator and a low-pass filter connected in series, which are used to perform proportional integration calculation, phase lead-lag compensation calculation and low-pass filtering processing on the position error in sequence. The feedback conversion module is connected to the inverter output terminal and the current controller input terminal, and is used to convert the three-phase current output by the inverter into a current feedback value and feed it back to the current controller. The current controller outputs a voltage command based on the current setpoint and current feedback value, and the modulation module modulates a switching configuration signal based on the voltage command to drive the inverter to operate.

2. The linear motor position dual-loop control system according to claim 1, characterized in that, The current controller includes a first current controller and a second current controller; the current setpoint includes a q-axis current setpoint and a d-axis current setpoint, the current feedback includes a q-axis current feedback and a d-axis current feedback, and the voltage command includes a q-axis voltage command and a d-axis voltage command; the first current controller is used to receive the q-axis current setpoint and the q-axis current feedback, and output the q-axis voltage command; the second current controller is used to receive the d-axis current setpoint and the d-axis current feedback, and output the d-axis voltage command; both the q-axis voltage command and the d-axis voltage command are input to the coordinate transformation module, and after being processed by the modulation module, drive the inverter to operate.

3. The linear motor position dual-loop control system according to claim 2, characterized in that, The feedback transformation module includes a first transformation unit and a second transformation unit; the input terminal of the first transformation unit is connected to the output terminal of the inverter, and is used to transform the three-phase current output by the inverter from a three-phase stationary coordinate system to a two-phase stationary coordinate system; the input terminal of the second transformation unit is connected to the output terminal of the first transformation unit, and is used to transform the current in the two-phase stationary coordinate system to a two-phase rotating coordinate system to obtain the q-axis current feedback value and the d-axis current feedback value.

4. The linear motor position dual-loop control system according to claim 2, characterized in that, The given value for the d-axis current is zero.

5. The linear motor position dual-loop control system according to any one of claims 1-4, characterized in that, The transfer function expression of the position controller is: in, Let be the transfer function of the proportional-integral converter. Let be the transfer function of the phase lead-lag compensator. Let be the transfer function of the low-pass filter.

6. The linear motor position dual-loop control system according to claim 5, characterized in that, The transfer function expression of the proportional-integral converter is: Where, k pi τ is the gain coefficient of the proportional-integral converter, and τ is the zero-point time constant of the proportional-integral converter.

7. The linear motor position dual-loop control system according to claim 5, characterized in that, The transfer function expression of the phase lead-lag compensator is: Wherein, τ1 is the zero-point time constant of the phase lead-lag compensator, and τ2 is the pole-point time constant of the phase lead-lag compensator.

8. The linear motor position dual-loop control system according to claim 5, characterized in that, The low-pass filter is a second-order low-pass filter, and the transfer function expression of the low-pass filter is: Where w1 is the low-pass corner frequency of the low-pass filter. is the low-pass damping ratio of the low-pass filter.

9. The linear motor position dual-loop control system according to claim 5, characterized in that, The open-loop transfer function expression for the linear motor position dual-loop control system is: Among them, K f Let M be the thrust coefficient of the linear motor, and M be the equivalent mass coefficient of the linear motor.

10. The linear motor position dual-loop control system according to any one of claims 1-4, characterized in that, The parameters of the position controller are tuned based on the open-loop shear frequency and mid-bandwidth of the linear motor position dual-loop control system.