Hardware current loop control system of permanent magnet synchronous motor for rotary transformer feedback

By integrating the rotational resolution angle and current control algorithms in the FPGA chip, the motor vector control is directly controlled by the rotational output, which solves the delay and noise problems caused by the abnormal synchronization of the rotational feedback signal processing and the motor control and the angle calculation of the angle is solved. , realizes high-precision and fast response motor control, simplifies the system structure and reduces costs.

CN119051522APending Publication Date: 2024-11-29SHENZHEN VECTOR AUTOMATION TECH CO LTD
View PDF 4 Cites 0 Cited by

Patent Information

Application Number
CN202411193079.4
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-28
Publication Date
2024-11-29

AI Technical Summary

Technical Problem

In traditional permanent magnet synchronous motor control systems, the rotational feedback signal processing is not synchronized with the motor control, resulting in delay and high-frequency noise problems caused by rotor angle calculation, affecting control accuracy and response speed, and increasing system complexity and cost.

Method used

The rotational deformation angle algorithm and current control algorithm are integrated into an FPGA chip, and the rotational deformation angle algorithm is used to integrate the rotational deformation angle algorithm, and the coordinate transformation module through sinusoidal pulse width modulation, Sigma-Delta modulator, 3sinc filter, time-sharing integrator, real-time amplitude correction and phase correction module, and coordinate transformation module , PI regulator and synchronization control module directly use the sine cosine signal output from the rotary change to perform motor vector control to eliminate the delay and noise caused by angle calculation.

Benefits of technology

It improves control accuracy and response speed, simplifies the system structure, reduces hardware complexity and cost, enhances the system's real-time response and anti-interference capabilities, and is suitable for industrial control applications with high dynamic response.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119051522A_ABST
    Figure CN119051522A_ABST
Patent Text Reader

Abstract

The invention discloses a hardware current loop control system of a permanent magnet synchronous motor for resolver feedback. A highly integrated FPGA (Field Programmable Gate Array) chip is adopted to realize resolver angle solution and current control functions. The traditional rotor angle calculation is abandoned, and the sine and cosine signals output by the rotary transformer are directly used for vector control, so that the problems of high-frequency noise amplification and phase delay are solved, and the control precision and the response speed are remarkably improved. Meanwhile, real-time amplitude and phase correction and synchronous control functions are integrated in the FPGA, so that the signal accuracy and the system synchronism are ensured, and the system stability and the anti-interference capability are greatly improved. The design simplifies the hardware structure, reduces the cost, and is suitable for industrial control application with high dynamic response.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of motor servo control, and in particular to a hardware current loop control system of a permanent magnet synchronous motor for resolver feedback. Background Art

[0002] Permanent magnet synchronous motor (PMSM) has been widely used in the field of industrial control, especially in high-precision servo control systems. Its superior dynamic response and efficient energy conversion capabilities make it the first choice for many key application scenarios.

[0003] In order to achieve precise control of permanent magnet synchronous motors, it is usually necessary to monitor and feedback the motor's rotor position in real time. This task is usually achieved by using a resolver (resolver) as a position sensor, which can provide sine and cosine signals related to the rotor angle, thereby providing key feedback information for motor control.

[0004] In traditional motor control systems, resolver decoding and motor control are usually implemented on two independent controllers. Specifically, the resolver angle resolution chip is responsible for generating the excitation signal, and obtaining the high-frequency sine and cosine pulse signal through sampling, and calculating the sine and cosine signals related to the rotor angle after integration. These signals are used to obtain the rotor angle through inverse tangent operation and are passed to the servo drive for motor speed calculation and control. Although this method achieves closed-loop control of the motor to a certain extent, it faces multiple problems in practical applications, such as:

[0005] 1. Signal processing delay and reduced phase margin: The sine and cosine signals obtained by the resolver chip through integral operation often introduce a certain delay after being processed by the software phase-locked loop (PLL), which is particularly obvious when the motor is running at high speed. As the speed increases, the phase margin of the control system gradually decreases, resulting in slower system response and even possible system instability. In addition, the high-frequency components introduced by the inverse tangent calculation process will be amplified when passing through the differential operation of the servo drive, further affecting the control accuracy and stability.

[0006] 2. Synchronization issues between different chips: Since resolver decoding and motor control run on two different chips, signal transmission will inevitably produce different delays and errors. In traditional methods, it is difficult to achieve accurate synchronization between the two chips, which makes it difficult for the servo system to ensure real-time performance and accuracy in high-precision control scenarios, thus affecting the overall performance of the system.

[0007] In order to overcome the above problems, some existing technologies try to optimize in various ways. For example, by improving the phase-locked loop algorithm or increasing the computing power of the signal processor to reduce the delay and noise impact, or introducing more sensors and control chips in the system to improve the feedback accuracy and synchronization of the system. However, these methods usually bring the following new problems:

[0008] 1. Increased system complexity and cost: Introducing more hardware or more complex algorithms will inevitably increase the complexity of the system, making the design, debugging and maintenance of the system more difficult. It will also significantly increase the cost of the system and limit its application in a wider range of fields.

[0009] 2. Limited performance improvement: Although these improvements can reduce delays or improve synchronization to a certain extent, the traditional rotor angle calculation is still a bottleneck for performance improvement. High-frequency noise and phase delay problems are difficult to fundamentally solve, making it difficult for the system's control accuracy and dynamic response capabilities to meet high-standard industrial requirements.

[0010] Therefore, how to integrate the resolver angle resolution algorithm with the motor control algorithm to avoid the delay and noise problems caused by traditional angle calculation and improve the accuracy and response speed of motor control has become a technical problem to be solved by the present invention. Summary of the invention

[0011] The technical problem solved by the present invention is to provide a hardware current loop control system for a permanent magnet synchronous motor with resolver feedback in response to the defects existing in the above-mentioned prior art, so as to solve the problems of the resolver feedback signal processing being out of sync with the motor control, and the delay and high-frequency noise caused by the rotor angle calculation proposed in the above-mentioned background technology.

[0012] In order to solve the above technical problems, the technical solution adopted by the present invention is as follows:

[0013] A hardware current loop control system for a permanent magnet synchronous motor with resolver feedback, the system integrates a resolver angle resolution algorithm and a current control algorithm, and all functions are implemented in one FPGA chip, the FPGA chip comprising:

[0014] A sinusoidal pulse width modulation (SPWM) waveform generation module is used to generate an SPWM waveform signal by comparing a triangular carrier with a sinusoidal signal generated by a lookup table;

[0015] The Sigma-Delta modulator and 3sinc filter combination module is used to convert the analog signal fed back by the resolver into a high-frequency digital signal, and filter it through a 3sinc filter to extract stable sine and cosine signals;

[0016] A time-sharing integrator is used to perform periodic integration processing on the pulse signal fed back by the resolver to obtain a sine signal and a cosine signal;

[0017] Real-time amplitude correction and phase correction module, used to correct the sine signal and cosine signal in real time according to the actual difference of hardware to ensure the accuracy of their amplitude and phase;

[0018] A coordinate transformation module is used to directly use the sine signal and the cosine signal to perform coordinate transformation, generate a d-axis current feedback signal and a q-axis current feedback signal, so as to realize vector control of the motor without calculating the rotor angle;

[0019] A PI regulator module is used to perform proportional-integral regulation according to the error between the d-axis and q-axis current feedback signals and the current given signal, and output a current regulation signal;

[0020] The synchronous control module is used to achieve precise synchronization between resolver signal sampling and SVPWM output, thereby reducing the delay and error caused by asynchrony and improving the control accuracy of the system.

[0021] As a further solution of the present invention, the Sigma-Delta modulator and 3sinc filter combination module adopts a cascaded filtering structure to eliminate high-frequency noise in the resolver feedback signal, and the discrete time transfer function of the 3sinc filter is:

[0022]

[0023] As a further solution of the present invention, the time-sharing integrator is used to accumulate the amplitude within a pulse cycle, and the accumulated result is subjected to sign processing to generate corresponding sine signals and cosine signals.

[0024] As a further solution of the present invention, the real-time amplitude correction and phase correction module dynamically corrects the amplitude and phase of the sine signal and the cosine signal by detecting hardware differences, so as to correct the sine signal and the cosine signal to standard signals with an amplitude of 1 and a phase difference of 90°.

[0025] As a further solution of the present invention, the coordinate transformation module includes a transformation matrix for converting the α-β axis signal into the dq axis signal, and the transformation matrix is:

[0026]

[0027] Where θ is the phase of the sinusoidal signal.

[0028] As a further solution of the present invention, the PI regulator module includes a proportional controller and an integral controller, the proportional controller is used to amplify the current error signal, and the integral controller is used to integrate the current error signal, and the regulated signal is output as a voltage given signal.

[0029] As a further solution of the present invention, the synchronization control module realizes accurate synchronization between the sampling of the resolver feedback signal and the SVPWM waveform output through a unified clock signal inside the FPGA, so as to reduce control delay and phase error.

[0030] As a further solution of the present invention, the SPWM waveform generation module inside the FPGA chip generates a sinusoidal signal through a sinusoidal lookup table, and compares it with the internal triangular carrier signal to generate an SPWM waveform signal.

[0031] As a further solution of the present invention, the SVPWM modulation module adopts the traditional seven-segment SVPWM modulation strategy, selects adjacent space vectors and calculates their action time, thereby generating a conduction time signal of the three-phase bridge arm for driving the IGBT to control the operation of the permanent magnet synchronous motor.

[0032] As a further solution of the present invention, the SVPWM modulation module includes a transformation matrix for inverse rotation transformation, and the transformation matrix is ​​used to convert the voltage signals of the d-axis and the q-axis back to the α-β-axis signals. The transformation matrix is:

[0033]

[0034] Wherein, θ is the phase angle of the sinusoidal signal corrected in real time so as to ensure the accuracy and real-time performance of the motor vector control.

[0035] Compared with the prior art, the present invention has the following beneficial effects:

[0036] 1. Eliminate the performance bottleneck caused by angle calculation: Traditional methods achieve motor control by calculating the rotor angle. This process introduces high-frequency noise and phase delay, especially in high-speed and high-precision control scenarios, resulting in system performance degradation. This invention innovatively abandons the calculation of the rotor angle and directly uses the sine and cosine signals output by the resolver to perform vector control of the motor, completely eliminating the high-frequency noise amplification and phase delay problems caused by angle calculation, thereby greatly improving the control accuracy and system response speed.

[0037] 2. Innovative breakthrough in integrated design: The present invention integrates the resolver angle resolution algorithm and the motor current control algorithm into one FPGA chip, avoiding the synchronization problems and signal delays caused by the multi-chip architecture in the traditional system. Through this integrated design, the present invention not only simplifies the system structure and reduces the hardware complexity, but also significantly improves the real-time response capability of the system, making the control system more compact and more synchronized.

[0038] 3. Accuracy of real-time correction and synchronous control: The real-time amplitude correction and phase correction functions implemented inside the FPGA ensure the accuracy and consistency of the sine and cosine signals, greatly improving the stability and accuracy of motor control. At the same time, the FPGA implements precise synchronization of resolver signal sampling and SVPWM waveform output, thus avoiding the delay and error caused by signal asynchrony in traditional multi-chip systems, further enhancing the control effect of the system.

[0039] 4. Significantly improved system stability and anti-interference ability: The design of the present invention is particularly suitable for industrial control applications with high dynamic response and complex environments. Under high-speed operation conditions, the present invention can significantly reduce position error and torque fluctuation, making the motor run more smoothly. In addition, the integrated hardware design and real-time signal processing make the system have extremely strong anti-interference ability, ensuring high reliability and high stability in complex industrial environments.

[0040] 5. Simplify implementation and reduce costs: By implementing complex vector control and signal processing functions in a single FPGA chip, the present invention not only simplifies the implementation process of the control system, but also reduces the dependence on high-performance dedicated chips and reduces the overall cost of system implementation.

[0041] Additional aspects and advantages of the present invention will be given in part in the following description and in part will be obvious from the following description, or will be learned through practice of the present invention. BRIEF DESCRIPTION OF THE DRAWINGS

[0042] In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative labor.

[0043] Figure 1 The present invention is a schematic block diagram of the hardware current loop control system structure of a permanent magnet synchronous motor with resolver feedback.

[0044] Figure 2 Waveform diagram of motion curve of traditional AU6802N1 resolver servo.

[0045] Figure 3 The figure is a waveform diagram of the improved resolver servo motion curve of the present invention. DETAILED DESCRIPTION

[0046] The technical solutions in the embodiments of the present invention are described clearly and completely below. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of them. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0047] See also Figure 1 —3. In an embodiment of the present invention, a hardware current loop control system for a permanent magnet synchronous motor with resolver feedback is provided. The system integrates a resolver angle resolution algorithm and a current control algorithm. All functions are implemented in one FPGA chip. The FPGA chip includes:

[0048] A sinusoidal pulse width modulation (SPWM) waveform generation module is used to generate an SPWM waveform signal by comparing a triangular carrier with a sinusoidal signal generated by a lookup table;

[0049] The Sigma-Delta modulator and 3sinc filter combination module is used to convert the analog signal fed back by the resolver into a high-frequency digital signal, and filter it through a 3sinc filter to extract stable sine and cosine signals;

[0050] A time-sharing integrator is used to perform periodic integration processing on the pulse signal fed back by the resolver to obtain a sine signal and a cosine signal;

[0051] Real-time amplitude correction and phase correction module, used to correct the sine signal and cosine signal in real time according to the actual difference of hardware to ensure the accuracy of their amplitude and phase;

[0052] A coordinate transformation module is used to directly use the sine signal and the cosine signal to perform coordinate transformation, generate a d-axis current feedback signal and a q-axis current feedback signal, so as to realize vector control of the motor without calculating the rotor angle;

[0053] A PI regulator module is used to perform proportional-integral regulation according to the error between the d-axis and q-axis current feedback signals and the current given signal, and output a current regulation signal;

[0054] The synchronous control module is used to achieve precise synchronization between resolver signal sampling and SVPWM output, thereby reducing the delay and error caused by asynchrony and improving the control accuracy of the system.

[0055] The Sigma-Delta modulator and 3sinc filter combination module adopts a cascaded filtering structure to eliminate high-frequency noise in the resolver feedback signal. The discrete time transfer function of the 3sinc filter is:

[0056]

[0057] The time-sharing integrator is used to accumulate the amplitude within a pulse cycle, and the accumulated result is sign-processed to generate corresponding sine and cosine signals.

[0058] The real-time amplitude correction and phase correction module dynamically corrects the amplitude and phase of the sine signal and the cosine signal by detecting hardware differences, so as to correct the sine signal and the cosine signal to a standard signal with an amplitude of 1 and a phase difference of 90°.

[0059] The coordinate transformation module includes a transformation matrix for converting the α-β axis signal into the dq axis signal, and the transformation matrix is:

[0060]

[0061] Where θ is the phase of the sinusoidal signal.

[0062] The PI regulator module includes a proportional controller and an integral controller. The proportional controller is used to amplify the current error signal, and the integral controller is used to integrate the current error signal. The regulated signal is output as a voltage given signal.

[0063] The synchronous control module uses the unified clock signal inside the FPGA to achieve precise synchronization between the resolver feedback signal sampling and the SVPWM waveform output to reduce control delay and phase error.

[0064] The SPWM waveform generation module inside the FPGA chip generates a sine signal through a sine lookup table, and compares it with the internal triangular carrier signal to generate an SPWM waveform signal.

[0065] The SVPWM modulation module adopts the traditional seven-segment SVPWM modulation strategy, selects adjacent space vectors and calculates their action time, thereby generating a three-phase bridge arm conduction time signal for driving the IGBT to control the operation of the permanent magnet synchronous motor.

[0066] The SVPWM modulation module includes a transformation matrix for inverse rotation transformation, which is used to convert the voltage signals of the d-axis and q-axis back to the α-β-axis signals. The transformation matrix is:

[0067]

[0068] Wherein, θ is the phase angle of the sinusoidal signal corrected in real time so as to ensure the accuracy and real-time performance of the motor vector control.

[0069] The present invention integrates the resolver angle resolution algorithm and the permanent magnet synchronous motor current control algorithm and implements them in FPGA. Instead of calculating the angle, the coordinate transformation is performed directly using the two integrated sine and cosine signals to achieve vector control of the motor. Figure 1 The block diagram of

[0070] Among them, the FPGA has a built-in sine signal generator to generate SPWM waveform. After SPWM passes through the filtering circuit, it generates a sine signal. After the sine signal is amplified, it is used to excite the primary side of the rotary transformer. Due to the excitation of the primary side, the two windings of the secondary side generate two high-frequency pulse signals with a phase difference of 90 degrees. The two signals are modulated into high-frequency digital signals through the Sigma-Deta modulator and input into the FPGA. The high-frequency digital signal is 3 The filter demodulates two high-frequency pulse signals. After time-sharing integration, amplitude offset correction and phase offset correction, the high-frequency pulse signals are converted into sine signals sinθ and cosine signals cosθ. After the rotary transformer installation position and the permanent magnet synchronous motor magnetic pole position are calibrated, these two sine and cosine signals are directly used for rotation conversion to obtain the d-axis current feedback i dfb and q-axis current feedback i qfb . dq axis current given and d q The shaft current feedback is input into the corresponding PI regulator after error calculation. The output u of the regulator d 、u q , and then perform the reverse rotation transformation with sinθ and cosθ to obtain u α ,u β It is then input into the SVPWM modulation module to generate a SVPWM wave.

[0072] The entire operation process is implemented in the FPGA and synchronized with the output of the SVPWM. The calculation method inside the FPGA includes the following steps:

[0073] (1) Sine excitation signal generator module. A triangular carrier is designed internally. The triangular carrier is compared with the sine signal and then outputs SPWM. The sine signal is generated by a sine lookup table.

[0074] (2)sinc 3 Filter. The high-frequency digital signal output by the Sigma-Deta modulator uses sinc 3 The filter performs filtering.

[0075] Its discrete-time transfer function is as follows:

[0076]

[0077] Where M is the decimation rate. When implemented in FPGA, the following cascade structure is used.

[0078]

[0079] (3) Time-sharing integrator. That is, the amplitude of a pulse cycle is accumulated periodically. The summed value is processed by sign to obtain the sine and cosine signals.

[0080] (4) Amplitude correction and phase correction. Due to differences in actual hardware, the amplitude of the generated sine and cosine signals will have zero drift, and the peak-to-peak value may not be ±1. Therefore, corrections need to be made according to different hardware to correct the two sine and cosine signals into standard sine and cosine signals sinθ and cosθ with a phase difference of 90° and an amplitude of 1.

[0081] (5) Coordinate transformation: Coordinate transformation includes two transformation matrices, as shown in the following formula.

[0082]

[0083] in,

[0084]

[0085] (6) dq axis current loop regulator: PI regulator is used for control. The output of the PI regulator is limited and used as the given dq axis voltage. The PI regulator is implemented using the following calculation formula:

[0086]

[0087] (7) Inverse rotation transformation: Use the following matrix to perform inverse rotation transformation.

[0088]

[0089] in,

[0090]

[0091] (8) SVPWM modulation. SVPWM adopts the traditional seven-segment SVPWM modulation strategy. The main process includes sector judgment of the synthetic space vector, selecting adjacent space vectors and calculating their action time, and calculating the conduction time of the three-phase bridge arm.

[0092] This method abandons the traditional angle calculation, but collects the high-frequency pulse signal output by the resolver, and performs rotation transformation with the sine and cosine values ​​obtained after time-sharing integration, eliminating the phase delay caused by angle phase lock, and can further improve the control bandwidth of the current loop. According to different hardware characteristics, amplitude correction and phase correction are added to the resolver signal, which further improves the decomposition accuracy of the dq current, making the torque control more precise and the motor running more stable. The entire control process is based on FPGA and implemented in hardware. The SVPWM signal output by the FPGA is precisely synchronized with the resolver sampling, reducing the delay and error caused by signal asynchrony. Since sampling and output are carried out under the control of the same clock or signal source, the influence of external interference on system performance is effectively suppressed, and the stability and reliability of the system are improved.

[0093] Under the same working conditions, the servo control is performed by using the traditional AU6802n1 resolver chip and the method of the present invention. The performance test comparison results are as follows: Figure 2 and Figure 3 As shown, the improved resolver servo of the present invention has significantly reduced position error fluctuation under the same speed command, the motor runs more smoothly, and the torque fluctuation is significantly reduced.

[0094] Embodiment 1:

[0095] This embodiment describes in detail a specific application of a permanent magnet synchronous motor hardware current loop control system for resolver feedback in high-precision industrial servo control.

[0096] In high-precision industrial servo control systems, motors are required to respond to commands quickly and accurately, especially in application scenarios such as CNC machine tools, robot control, and high-precision positioning systems, which have extremely high requirements for motor control accuracy and response speed. In traditional methods, servo systems rely on the sine and cosine signals fed back by the resolver to determine the rotor position of the motor. However, since resolver decoding and motor control are implemented on different chips, and complex angle calculations are required to obtain the rotor position, this method is prone to introduce delays, noise, and asynchrony problems, affecting the overall control performance of the system.

[0097] In specific application scenarios, such as in the control system of high-precision CNC machine tools, the rotor position of the motor needs real-time feedback to accurately control the position of the tool. However, when the traditional resolver decoding method is running at high speed, the phase delay caused by the integral operation and the arc tangent calculation causes the system response to slow down, and even unstable control may occur. In addition, since the decoding of the resolver signal and the control of the motor are performed in two independent chips, it is inevitable that there will be problems of asynchrony and signal transmission delay. This delay is particularly significant during high-speed machining, resulting in a decrease in machining accuracy and reduced efficiency.

[0098] In order to overcome these problems, this embodiment adopts the hardware current loop control system proposed in the present invention. The system integrates the resolver angle resolution algorithm and the current control algorithm into an FPGA chip, so that all signal processing and control calculations are completed in the same chip, thereby avoiding the delay and synchronization problems caused by the multi-chip architecture in the traditional method. In a specific application, the sine and cosine pulse signals fed back by the resolver are directly input into the FPGA chip, and the analog signal is converted into a high-frequency digital signal through the built-in Sigma-Delta modulator, and then the high-frequency noise is filtered out through a 3sinc filter to obtain a stable sine signal and cosine signal.

[0099] Then, these sine and cosine signals are directly used for coordinate transformation to generate current feedback signals of the d-axis and q-axis to realize vector control of the motor. Since the traditional rotor angle calculation is abandoned, this embodiment avoids the problems of high-frequency noise amplification and phase delay, and greatly improves the real-time performance and response speed of the system. In the control of CNC machine tools, this fast and accurate response significantly improves the processing accuracy, while reducing the error and scrap rate caused by system delay.

[0100] In addition, the real-time amplitude correction and phase correction functions in the FPGA further ensure the accuracy of the signal and improve the stability of the system. This function is particularly important in complex industrial environments. For example, in scenarios affected by electromagnetic interference or temperature changes, it can effectively suppress the impact of external interference on control accuracy and ensure that the motor always runs in the best condition.

[0101] Through the hardware current loop control system of the present invention, the motor control of the CNC machine tool not only achieves higher accuracy and response speed, but also significantly reduces the complexity and cost of the system. Compared with the traditional multi-chip solution, this embodiment implements all key functions through a single FPGA chip, reduces the dependence on high-performance dedicated chips, simplifies the system design and debugging process, and provides a more efficient and economical solution.

[0102] In summary, this embodiment demonstrates the application of the present invention in high-precision industrial servo control, and successfully solves the synchronization problem, noise problem and system delay problem in traditional technology.

[0103] Embodiment 2:

[0104] This embodiment describes a hardware current loop control system for improving the control performance of a permanent magnet synchronous motor. The system is particularly suitable for industrial servo control scenarios that require high precision, high speed, and high stability, such as high-speed sorting systems in automated production lines. In this scenario, precise control of the motor is crucial to ensuring rapid response of the system and accurate sorting of products.

[0105] In high-speed sorting systems, permanent magnet synchronous motors are responsible for driving the movement of conveyor belts and robotic arms to achieve fast sorting of different types of products. The system requires the motor to respond to instructions in a very short time and accurately control the speed of the conveyor belt and the position of the robotic arm. However, traditional resolver feedback control systems often face problems such as signal processing delays, reduced phase margins, and insufficient control accuracy under high-speed conditions because resolver decoding and motor control are implemented on different chips. These problems lead to a decrease in system response speed and control accuracy, which ultimately affects product sorting accuracy and production efficiency.

[0106] The present invention provides a solution that can significantly improve the motor control performance by integrating the resolver angle resolution algorithm and the motor current control algorithm into an FPGA chip. In this embodiment, the high-frequency sine and cosine pulse signals collected by the resolver sensor are directly input into the FPGA chip, and the Sigma-Delta modulator built into the FPGA converts the analog signal into a high-frequency digital signal, and then the high-frequency noise is filtered out by a 3sinc filter to generate stable sine and cosine signals. Unlike the traditional method, this system does not calculate the rotor angle, but directly uses the sine and cosine signals for coordinate transformation to generate d-axis and q-axis current feedback signals, thereby realizing vector control of the motor.

[0107] In the specific application process, the time-sharing integrator in the FPGA chip processes the sine and cosine signals through periodic accumulation to ensure the accuracy and consistency of the signal. At the same time, the real-time amplitude correction and phase correction modules dynamically adjust the signal according to the hardware differences to eliminate the influence of zero drift and non-standard amplitude on the control accuracy. All these processing processes are completed synchronously in the FPGA chip, ensuring the precise synchronization of signal processing and control output, and avoiding the delay and error caused by the multi-chip structure in the traditional system.

[0108] By applying the control system of the present invention, the response speed and control accuracy of the motor of the high-speed sorting system are significantly improved under high-speed operation conditions. During the sorting process, the conveyor belt speed control is more stable, and the positioning accuracy of the robot arm is also greatly improved, ensuring the accurate sorting of different types of products, greatly improving production efficiency and sorting accuracy. In addition, due to the simplified system structure, the dependence on complex algorithms and multi-chip hardware is reduced, the implementation cost of the system is reduced, and the difficulty of system debugging and maintenance is reduced.

[0109] In summary, this embodiment demonstrates the application of the present invention in high-speed industrial automation control, and achieves higher motor control accuracy and system stability through an innovative hardware current loop control system.

[0110] In the present invention, unless otherwise clearly stipulated and limited, the terms such as "installation", "setting", "connection", "fixation" and "screw-on" should be understood in a broad sense. For example, it can be a fixed connection, a detachable connection, or an integral one; it can be a mechanical connection or an electrical connection; it can be directly connected or indirectly connected through an intermediate medium; it can be the internal connection of two elements or the interaction relationship between two elements. Unless otherwise clearly defined, ordinary technicians in this field can understand the specific meanings of the above terms in the present invention according to the specific circumstances.

[0111] It will be apparent to those skilled in the art that the present invention is not limited to the details of the exemplary embodiments described above and that the present invention can be implemented in other specific forms without departing from the spirit or essential features of the present invention. Therefore, the embodiments should be considered exemplary and non-restrictive in all respects, and the scope of the present invention is defined by the appended claims rather than the above description, and it is intended that all changes falling within the meaning and scope of the equivalent elements of the claims be included in the present invention.

Claims

1. A hardware current loop control system for a permanent magnet synchronous motor with resolver feedback, characterized in that: The system integrates the resolver angle resolution algorithm and the current control algorithm. All functions are implemented in one FPGA chip. The FPGA chip includes: A sine pulse width modulation waveform generation module is used to generate an SPWM waveform signal by comparing a triangular carrier with a sine signal generated by a lookup table; The Sigma-Delta modulator and 3sinc filter combination module is used to convert the analog signal fed back by the resolver into a high-frequency digital signal, and filter it through a 3sinc filter to extract stable sine and cosine signals; A time-sharing integrator is used to perform periodic integration processing on the pulse signal fed back by the resolver to obtain a sine signal and a cosine signal; Real-time amplitude correction and phase correction module, used to correct the sine signal and cosine signal in real time according to the actual difference of hardware to ensure the accuracy of their amplitude and phase; A coordinate transformation module is used to directly use the sine signal and the cosine signal to perform coordinate transformation, generate a d-axis current feedback signal and a q-axis current feedback signal, so as to realize vector control of the motor without calculating the rotor angle; A PI regulator module is used to perform proportional-integral regulation according to the error between the d-axis and q-axis current feedback signals and the current given signal, and output a current regulation signal; The synchronous control module is used to achieve precise synchronization between resolver signal sampling and SVPWM output, thereby reducing the delay and error caused by asynchrony and improving the control accuracy of the system.

2. The hardware current loop control system for a permanent magnet synchronous motor with resolver feedback according to claim 1, characterized in that: The Sigma-Delta modulator and 3sinc filter combination module adopts a cascaded filtering structure to eliminate high-frequency noise in the resolver feedback signal. The discrete time transfer function of the 3sinc filter is:

3. The hardware current loop control system for a permanent magnet synchronous motor with resolver feedback according to claim 1, characterized in that: The time-sharing integrator is used to accumulate the amplitude within a pulse cycle, and the accumulated result is subjected to sign processing to generate corresponding sine signals and cosine signals.

4. The hardware current loop control system for a permanent magnet synchronous motor with resolver feedback according to claim 1, characterized in that: The real-time amplitude correction and phase correction module dynamically corrects the amplitude and phase of the sine signal and the cosine signal by detecting hardware differences, so as to correct the sine signal and the cosine signal to standard signals with an amplitude of 1 and a phase difference of 90°.

5. The hardware current loop control system for a permanent magnet synchronous motor with resolver feedback according to claim 1, characterized in that: The coordinate transformation module includes a transformation matrix for transforming the α-β axis signal into the dq axis signal, and the transformation matrix is: Where θ is the phase of the sinusoidal signal.

6. The hardware current loop control system for a permanent magnet synchronous motor with resolver feedback according to claim 1, characterized in that: The PI regulator module includes a proportional controller and an integral controller. The proportional controller is used to amplify the current error signal, and the integral controller is used to integrate the current error signal. The regulated signal is output as a voltage given signal.

7. The hardware current loop control system for a permanent magnet synchronous motor with resolver feedback according to claim 1, characterized in that: The synchronous control module realizes accurate synchronization between the sampling of the resolver feedback signal and the output of the SVPWM waveform through the unified clock signal inside the FPGA, so as to reduce the control delay and phase error.

8. The hardware current loop control system for a permanent magnet synchronous motor with resolver feedback according to claim 1, characterized in that: The SPWM waveform generation module inside the FPGA chip generates a sine signal through a sine table lookup, and compares it with an internal triangular carrier signal to generate an SPWM waveform signal.

9. The hardware current loop control system for a permanent magnet synchronous motor with resolver feedback according to claim 1, characterized in that: The SVPWM modulation module adopts the traditional seven-segment SVPWM modulation strategy, selects adjacent space vectors and calculates their action time, thereby generating a conduction time signal of the three-phase bridge arm for driving the IGBT to control the operation of the permanent magnet synchronous motor.

10. The hardware current loop control system for a permanent magnet synchronous motor with resolver feedback according to claim 9, characterized in that: The SVPWM modulation module includes a transformation matrix for inverse rotation transformation, and the transformation matrix is ​​used to convert the voltage signals of the d-axis and the q-axis back to the α-β-axis signals. The transformation matrix is: Wherein, θ is the phase angle of the sinusoidal signal after real-time correction so as to ensure the accuracy and real-time performance of the motor vector control.

Citation Information

Patent Citations

  • Delta-Sigma modulation principle based digital switching device and method for rotary transformer

    CN102751991A

  • Field programmable gate array-based (FPGA-based) multi-axis servo motor current loop control system and control method

    CN102811012A

  • Permanent magnet synchronous motor vibration noise active suppression method

    CN112398399A

  • Method and apparatus for vector control on a synchronous reluctance motor

    JP2002199799A