Hardware current loop and motor control system

By curing the hardware current loop in the MCU and operating independently, the hardware current loop module is solved for the complexity and cost of the current loop design in servo motor control, and high-performance control and bandwidth improvement are achieved.

CN119093804AInactive Publication Date: 2024-12-06GUANGZHOU ARTINCHIP TECH CO LTD
View PDF 4 Cites 0 Cited by

Patent Information

Application Number
CN202411167103.7
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-23
Publication Date
2024-12-06
Estimated Expiration
Not applicable · inactive patent

AI Technical Summary

Technical Problem

In the prior art, the implementation of the current loop in servo motor control requires a faster refresh cycle, resulting in high computing power requirements of the MCU and increased design difficulty and cost. In particular, the software current loop and the hardware current loop require the MCU to cooperate closely with the FPGA. Increases design complexity and cost.

Method used

Design a hardware current loop and solidify it in the MCU, including current acquisition module, CLARK conversion acceleration module, electrical angle acquisition module, Cordic calculation module, Park conversion acceleration module, D-PID module, Q-PID module, and inverse Park conversion acceleration The module, dead-band compensation module and SVPWM acceleration module operate independently of the MCU, reducing the burden on the MCU and increasing the bandwidth of the current loop.

Benefits of technology

It realizes high-performance control of servo motors, reduces the burden on the MCU, releases computing resources, and realizes the hardware architecture of a single chip to replace MCU+FPGA, and improves the bandwidth of the current loop.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119093804A_ABST
    Figure CN119093804A_ABST
Patent Text Reader

Abstract

The invention discloses a hardware current loop and a motor control system. The hardware current loop comprises a current acquisition module, a CLARK transformation acceleration module, an electrical angle acquisition module, a Cordic calculation module, a Park transformation acceleration module, a D-PID module, a Q-PID module, a reverse Park transformation acceleration module, a dead zone compensation module and an SVPWM acceleration module, and the CLARK transformation acceleration module is used for acquiring alpha-axis current and beta-axis current; the Cordic calculation module is used for calculating a sine value and a cosine value of the electrical angle; the Park transformation acceleration module is used for obtaining d-axis current and q-axis current; the D-PID module and the Q-PID module are used for obtaining a d-axis voltage and a q-axis voltage; the reverse Park transformation acceleration module is used for obtaining alpha-axis voltage and beta-axis voltage; the SVPWM acceleration module is used for obtaining the duty ratio, and high-performance control over the servo motor is achieved through a hardware current loop solidified through an MCU.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of current loops, and in particular to a hardware current loop and a motor control system. Background Art

[0002] With the development of servo motor control technology, it is increasingly moving towards high precision, high speed, high response, and small size. A complete servo control solution includes position loop, speed loop, and current loop. Among the three loops, the current loop is the innermost and is the one that most affects the performance of motor control. The current loop mainly includes Clarke transformation, park transformation, anti-integral saturation PID, ipark transformation, dead zone compensation, and SVPWM calculation and processing. There have always been two ways to implement the current loop: one is to calculate and process in the MCU through software algorithms, also known as software current loops, and the other is to execute the hardware current loop in the FPGA; because the current loop requires a faster refresh cycle, the former has higher computing power requirements for the MCU, and the latter requires close cooperation between the MCU and the FPGA, which increases the design difficulty and cost of the solution. Summary of the invention

[0003] The present invention aims to solve at least one of the technical problems existing in the prior art. To this end, the present invention proposes a hardware current loop and motor control system, which realizes high-performance control of the servo motor by using the hardware current loop that has been solidified by the MCU, greatly reduces the burden of the MCU, and realizes the hardware architecture of replacing the MCU+FPGA with a single chip.

[0004] In a first aspect, a hardware current loop according to an embodiment of the present invention includes:

[0005] A current acquisition module, used for acquiring the U-phase current and the V-phase current of the motor, and preprocessing the U-phase current and the V-phase current;

[0006] A CLARK conversion acceleration module, used for converting the pre-processed U-phase current and the V-phase current into an α-axis current and a β-axis current;

[0007] An electrical angle acquisition module, used to acquire the electrical angle of the motor;

[0008] A Cordic calculation module, used for calculating the sine value and cosine value of the electrical angle;

[0009] A Park transformation acceleration module, used for obtaining a d-axis current and a q-axis current according to the α-axis current, the β-axis current, the sine value and the cosine value;

[0010] A D-PID module, used for obtaining a d-axis voltage according to a preset d-axis reference current and the d-axis current;

[0011] A Q-PID module, used for obtaining a q-axis voltage according to a preset q-axis reference current and the q-axis current;

[0012] an inverse Park transformation acceleration module, used for obtaining an α-axis voltage and a β-axis voltage according to the d-axis voltage, the q-axis voltage, the sine value and the cosine value;

[0013] A dead zone compensation module, used for obtaining an α-axis compensation voltage and a β-axis compensation voltage according to the d-axis current and the q-axis current;

[0014] The SVPWM acceleration module is used to obtain the duty cycle of the PWM module according to the α-axis voltage, the β-axis voltage, the α-axis compensation voltage and the β-axis compensation voltage, and send the duty cycle to the PWM module to control the rotation of the motor.

[0015] According to some embodiments of the present invention, the current acquisition module includes:

[0016] An ADC module is used to collect the U-phase current and the V-phase current of the motor, and perform analog-to-digital conversion on the U-phase current and the V-phase current;

[0017] The current preprocessing module is used to set the offset and gain of the current, and preprocess the U-phase current and the V-phase current after analog-to-digital conversion according to the offset and the gain.

[0018] According to some embodiments of the present invention, the preprocessed U-phase current and V-phase current are:

[0019] PDI U =(DI u -DI Uoff )*CurrCalGain;

[0020] PDI v =(DI v -DI Voff )*CurrCalGain;

[0021] Among them, DI u DI is the U-phase current value of the motor feedback after analog-to-digital conversion. v DI is the V-phase current value of the motor feedback after analog-to-digital conversion. Uoff is the offset of the U phase current, DI Voff is the offset of the V phase current, CurrCalGain is the gain, PDI U is the U-phase current after preprocessing, PDI V is the V-phase current after preprocessing.

[0022] According to some embodiments of the present invention, the calculation process of the CLARK transformation acceleration module is:

[0023] I α =PDI U ;

[0024]

[0025] Among them, I α is the α-axis current, I β is the β-axis current.

[0026] According to some embodiments of the present invention, the calculation process of the Park transform acceleration module is:

[0027] I d_fbk =I α *cosθ+I β *sinθ;

[0028] I q_fbk =I β *cosθ-I α *sinθ;

[0029] Among them, I d_fbk is the d-axis current, I q_fbk is the q-axis current, cosθ is the cosine of the electrical angle, and sinθ is the sine of the electrical angle.

[0030] According to some embodiments of the present invention, the calculation process of the inverse Park transform acceleration module is:

[0031] U α =U d *cosθ-U q *sonθ;

[0032] U β =U d *sinθ+U q *cosθ;

[0033] Among them, U d is the d-axis voltage, U q is the q-axis voltage, U α is the α-axis voltage, I β is the β-axis voltage.

[0034] According to some embodiments of the present invention, the electrical angle acquisition module includes:

[0035] QEP0 module, used to obtain the signal incremental encoder signal of the motor;

[0036] TA-AEIO module, used for obtaining the absolute encoder signal of the motor;

[0037] The electrical angle calculation module is used to calculate the electrical angle of the motor according to the incremental encoder signal or the absolute encoder signal.

[0038] According to some embodiments of the present invention, the preset d-axis reference current and q-axis reference current are obtained through speed loop calculation.

[0039] According to some embodiments of the present invention, the enabling state of the dead zone compensation module is configured through a register.

[0040] In a second aspect, a motor control system according to an embodiment of the present invention includes the hardware current loop described in the embodiment of the first aspect.

[0041] The hardware current loop and motor control system according to the embodiments of the present invention have at least the following beneficial effects: the hardware current loop can be solidified in the MCU, and the high-performance control of the servo motor is achieved by using the hardware current loop that has been solidified in the MCU, and the solidified hardware current loop runs independently of the MCU, which greatly reduces the burden on the MCU and releases more computing resources. At the same time, it also improves the bandwidth of the current loop, and realizes the hardware architecture of replacing MCU+FPGA with a single chip.

[0042] 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

[0043] The above and / or additional aspects and advantages of the present invention will become apparent and easily understood from the description of the embodiments in conjunction with the following drawings, in which:

[0044] Figure 1 A schematic diagram of the structure of a hardware current loop according to an embodiment of the present invention;

[0045] Figure 2 Schematic diagram of the structure of the D-PID module according to an embodiment of the present invention. DETAILED DESCRIPTION

[0046] Embodiments of the present invention are described in detail below, and examples of the embodiments are shown in the accompanying drawings, wherein the same or similar reference numerals throughout represent the same or similar elements or elements having the same or similar functions. The embodiments described below with reference to the accompanying drawings are exemplary and are only used to explain the present application, and are not to be construed as limitations on the present application. For the step numbers in the following embodiments, they are only provided for the convenience of explanation, and the order between the steps is not limited in any way, and the execution order of each step in the embodiment can be adaptively adjusted according to the understanding of those skilled in the art.

[0047] In the description of the present invention, it should be understood that descriptions involving orientations, such as up, down, front, back, left, right, etc., and orientations or positional relationships indicated are based on the orientations or positional relationships shown in the accompanying drawings, and are only for the convenience of describing the present invention and simplifying the description, and do not indicate or imply that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore should not be understood as a limitation on the present invention.

[0048] The terms "first", "second", "third" and "fourth" etc. in the specification and claims of the present invention and the drawings are used to distinguish different objects, rather than to describe a specific order. In addition, the terms "including" and "having" and any variations thereof are intended to cover non-exclusive inclusions. For example, a process, method, system, product or device that includes a series of steps or units is not limited to the listed steps or units, but may optionally include steps or units that are not listed, or may optionally include other steps or units that are inherent to these processes, methods, products or devices.

[0049] Reference to "embodiments" in the present invention means that a particular feature, structure, or characteristic described in conjunction with the embodiments may be included in at least one embodiment of the present invention. The appearance of the phrase in various places in the specification does not necessarily refer to the same embodiment, nor is it an independent or alternative embodiment that is mutually exclusive with other embodiments. It is explicitly and implicitly understood by those skilled in the art that the embodiments described herein may be combined with other embodiments.

[0050] With the development of servo motor control technology, it is increasingly moving towards high precision, high speed, high response, and small size. A complete servo control solution includes position loop, speed loop, and current loop. Among the three loops, the current loop is the innermost and is the one that most affects the performance of motor control. The current loop mainly includes Clarke transformation, park transformation, anti-integral saturation PID, ipark transformation, dead zone compensation, and SVPWM calculation and processing. There have always been two ways to implement the current loop: one is to calculate and process in the MCU through software algorithms, also known as software current loops, and the other is to execute the hardware current loop in the FPGA; because the current loop requires a faster refresh cycle, the former has higher computing power requirements for the MCU, and the latter requires close cooperation between the MCU and the FPGA, which increases the design difficulty and cost of the solution.

[0051] To this end, an embodiment of the present invention provides a hardware current loop and a motor control system. The hardware current loop can be solidified in the MCU. The hardware current loop solidified in the MCU is used to achieve high-performance control of the servo motor. The solidified hardware current loop runs independently of the MCU, which greatly reduces the burden on the MCU and releases more computing resources. At the same time, it also improves the bandwidth of the current loop, and realizes the hardware architecture of replacing MCU+FPGA with a single chip.

[0052] The following is combined with Figure 1-2 , describes in detail the hardware current loop and motor control system of the embodiment of the present invention.

[0053] On the one hand, if Figure 1 As shown, an embodiment of the present invention proposes a hardware current loop, including: a current acquisition module, a CLARK transformation acceleration module, an electrical angle acquisition module, a Cordic calculation module, a Park transformation acceleration module, a D-PID module, a Q-PID module, an inverse Park transformation acceleration module, a dead zone compensation module and an SVPWM acceleration module; wherein the current acquisition module is used to collect the U-phase current and the V-phase current of the motor, and pre-process the U-phase current and the V-phase current; the CLARK transformation acceleration module is used to convert the pre-processed U-phase current and the V-phase current into the α-axis current and the β-axis current; the electrical angle acquisition module is used to obtain the electrical angle of the motor; the Cordic calculation module is used to calculate the sine value and the cosine value of the electrical angle; the Park transformation acceleration module Used to obtain d-axis current and q-axis current according to α-axis current, β-axis current, sine value and cosine value; the D-PID module is used to obtain d-axis voltage according to preset d-axis reference current and d-axis current; the Q-PID module is used to obtain q-axis voltage according to preset q-axis reference current and the q-axis current; the inverse Park transformation acceleration module is used to obtain α-axis voltage and β-axis voltage according to d-axis voltage, q-axis voltage, sine value and cosine value; the dead zone compensation module is used to obtain α-axis compensation voltage and β-axis compensation voltage according to d-axis current and q-axis current; the SVPWM acceleration module is used to obtain the duty cycle of the PWM module according to the α-axis voltage, β-axis voltage, α-axis compensation voltage and β-axis compensation voltage, and send the duty cycle to the PWM module to control the rotation of the motor.

[0054] Specifically, Figure 1 As shown, in this example, the current acquisition module includes an ADC module (ADC0 / ADC1) and a current preprocessing module. The ADC module is used to collect the U-phase current AI of the motor. U and V phase current AI V , and the U phase current AI U and V phase current AI V Perform analog-to-digital conversion to obtain DI U and DI VThe current preprocessing module is used to set the current offset and gain, and preprocess the U-phase current and V-phase current after analog-to-digital conversion according to the offset and gain to obtain PDI U and PDI V Specifically, the ADC module calculates the U-phase current AI fed back by the motor. U and V phase current AI V Real-time sampling is performed and the conversion from analog to digital is realized. The data obtained are DIu and DIv, which are then transmitted to the current preprocessing module; the current preprocessing module mainly sets the offset and gain of the current value and performs calculations. The formula is as follows:

[0055] PDI U =(DI u -DI Uoff )*CurrCalGain;

[0056] PDI V =(DI v -DI Voff )*CurrCalGain;

[0057] Among them, DI u DI is the U-phase current value of the motor feedback after analog-to-digital conversion. v DI is the V-phase current value of the motor feedback after analog-to-digital conversion. Uoff is the offset of the U phase current, DI Voff is the offset of the V phase current, CurrCalGain is the gain of the motor U phase and V phase current sampling loop, PDI U is the U-phase current after preprocessing, PDI V is the V-phase current after preprocessing.

[0058] Since the zero drift problem in the current sampling analog circuit will affect the actual control effect of the motor, the actual zero drift value (i.e., offset) of the circuit can be obtained through pre-testing and other means, and converted into the value corresponding to the ADC after conversion. The current pre-processing module subtracts the zero drift value from the analog-to-digital converted current value to obtain the real current value. The current pre-processing module also provides a gain setting, which can correct and adjust the gain of the current sampling analog circuit.

[0059] The current preprocessing module sends the preprocessed U-phase current and V-phase current to the CLARK conversion acceleration module, and the CLARK conversion acceleration module converts the preprocessed U-phase current PDI U is the V phase current PDI V Converted to α-axis current I α and β-axis current I β, the calculation process of the CLARK transformation acceleration module is as follows:

[0060] I α =PDI U ;

[0061]

[0062] like Figure 1 As shown, in this example, the electrical angle acquisition module includes a QEP0 module, a TA-AEIO module and an electrical angle calculation module (QEP electrical angle calculation / AE electrical angle calculation), wherein the QEP0 module is used to obtain the motor's signal incremental encoder signal (Increment Encoder), the TA-AEIO module is used to obtain the motor's absolute encoder signal (Absolute Encoder), and the electrical angle calculation module is used to calculate the motor's electrical angle according to the signal incremental encoder signal or the absolute encoder signal. Specifically, after the chip is powered on and the relevant software configuration is completed, the hardware current loop (HCL) starts to work. First, through the θ-Sel module, it is selected whether the calculation source of the electrical angle is obtained from the QEP0 module or from the TA-AEIO module, and then the calculated electrical angle θ is sent to the Cordic calculation module for calculation. The Cordic calculation module returns the sine value and cosine value corresponding to the electrical angle, namely Sinθ and Cosθ, so that the Park transformation acceleration module and the inverse Park transformation acceleration module can call.

[0063] The α-axis current I obtained by the above calculation is α , β-axis current I β , sine value Sinθ and cosine value Cosθ are input into the Park transformation acceleration module to obtain the d-axis current I d_fbk and q-axis current I q_fbk The calculation process of the Park transformation acceleration module is:

[0064] I d_fbk =I α *cosθ+I β *sinθ;

[0065] I q_fbk =I β *cosθ-I α *sinθ.

[0066] The Park transformation acceleration module converts the calculated d-axis current I d_fbk and q-axis current I q_fbk The D-PID module is used to calculate the d-axis reference current I according to the preset d-axis reference current I d_ref and d-axis current I d_fbk, get the d-axis voltage U d ; The Q-PID module is used to adjust the q-axis reference current I according to the preset q_ref and q-axis current I q_fbk , get the q-axis voltage U q . Where, the d-axis reference current I d_ref and q-axis reference current I q_ref It is calculated through the speed loop and can also be configured through registers.

[0067] Among them, the D-PID module is as follows Figure 2 As shown, it is a PI regulator, Kp represents the proportional coefficient, Ki represents the integral time constant, Up represents the value of the comparison item, Ui represents the value of the integral item, and U d Represents the output of the PI regulator. The structure of the Q-PID module is similar to that of the D-PID module and will not be described here.

[0068] The d-axis voltage U obtained by the above calculation is d , q-axis voltage U q , sine value Sinθ and cosine value Cosθ, input to the inverse Park transformation acceleration module, and calculate the α-axis voltage I α and β-axis voltage I β , the calculation process of the inverse Park transform acceleration module is as follows:

[0069] I α =U d *cosθ-U q *sinθ;

[0070] U β =U d *sinθ+U q *cosθ.

[0071] In some embodiments of the present invention, the input value of the dead zone compensation module is the d-axis current I d_fbk and q-axis current I q_fbk The output value is the α-axis compensation voltage U ɑ_comp and β-axis compensation voltage U β_comp , α-axis compensation voltage U ɑ_comp and β-axis compensation voltage U β_comp For the α-axis voltage U α and β-axis voltage U β The dead zone compensation module can be enabled or not through register configuration.

[0072] The α-axis voltage U obtained by the above calculation is α , β-axis voltage U β , α-axis compensation voltage U ɑ_comp , β-axis compensation voltage U β_compThe SVPWM acceleration module is input together. After calculation and processing by the SVPWM acceleration module, the PWM wave output duty cycle of the three PWM modules (PWM0 / PWM1 / PWM2) is obtained, thereby generating the space vector signal required for motor control. The space vector signal can control the on and off of the power device, thereby driving the rotation of the servo motor. After the motor rotates, the phase current and position angle will change. After the data is collected by the ADC0 / ADC1, QEP0, and TA-AEI0 modules, it is sent to the next stage for processing, thus forming a full closed-loop control process of the entire hardware current loop control.

[0073] In addition, if Figure 1 As shown, in some embodiments of the present invention, the hardware current loop is further provided with a speed measurement module (QEP_SPEED_TEST / AE_SPEED_TEST) for measuring the motor speed. In addition, the hardware current loop is further provided with a current loop monitoring module for monitoring the operating state of the hardware current loop and monitoring whether various parameters are normal.

[0074] The hardware current loop according to the embodiment of the present invention can be solidified in the MCU, and the high-performance control of the servo motor is achieved by using the solidified hardware current loop of the MCU. The solidified hardware current loop runs independently of the MCU, which greatly reduces the burden on the MCU and releases more computing resources. At the same time, it also improves the bandwidth of the current loop, and realizes the hardware architecture of replacing MCU+FPGA with a single chip.

[0075] On the other hand, an embodiment of the present invention further proposes a motor control system, including the hardware current loop described in the above embodiment, the hardware current loop is solidified in the MCU, and the hardware current loop is connected to the CPU and the control board (DriverBoard) of the motor.

[0076] Although specific embodiments are described herein, those of ordinary skill in the art will recognize that many other modifications or alternative embodiments are also within the scope of the present disclosure. For example, any of the functions and / or processing capabilities described in conjunction with a particular device or component may be performed by any other device or component. In addition, although various exemplary implementations and architectures have been described according to embodiments of the present disclosure, those of ordinary skill in the art will recognize that many other modifications to the exemplary implementations and architectures described herein are also within the scope of the present disclosure.

[0077] Some aspects of the present disclosure are described above with reference to the block diagram and flow chart of the system, method, system and / or computer program product according to the exemplary embodiments.It should be understood that the combination of one or more blocks in the block diagram and the flow chart and the blocks in the block diagram and the flow chart can be realized by executing computer executable program instructions respectively.Equally, according to some embodiments, some blocks in the block diagram and the flow chart may not need to be executed in the order shown, or may not need to be executed in full.In addition, additional components and / or operations beyond those components and / or operations shown in the blocks in the block diagram and the flow chart may be present in certain embodiments.

[0078] Therefore, the blocks in the block diagrams and flow charts support the combination of devices for performing the specified functions, the combination of elements or steps for performing the specified functions, and the program instruction devices for performing the specified functions. It should also be understood that each block in the block diagrams and flow charts and the combination of blocks in the block diagrams and flow charts can be implemented by a special-purpose hardware computer system or a combination of special-purpose hardware and computer instructions that performs a specific function, element or step.

[0079] The program modules, applications, etc. described herein may include one or more software components, including, for example, software objects, methods, data structures, etc. Each such software component may include computer-executable instructions that, in response to execution, cause at least a portion of the functionality described herein (e.g., one or more operations of the illustrative methods described herein) to be performed.

[0080] Software components can be encoded with any of various programming languages. An exemplary programming language can be a low-level programming language, such as an assembly language associated with a specific hardware architecture and / or an operating system platform. The software component comprising assembly language instructions may need to be converted to executable machine code by an assembler before being executed by hardware architecture and / or platform. Another exemplary programming language can be a higher-level programming language, which can be transplanted across multiple architectures. The software component comprising a higher-level programming language may need to be converted to an intermediate representation by an interpreter or a compiler before execution. Other examples of programming languages ​​include but are not limited to macro languages, shells or command languages, job control languages, scripting languages, database queries or search languages ​​or report writing languages. In one or more exemplary embodiments, the software component comprising the instruction of one of the above-mentioned programming language examples can be directly executed by an operating system or other software components, without first being converted into another form.

[0081] Software components may be stored as files or other data storage structures. Software components of similar type or related functions may be stored together, such as in a specific directory, folder, or library. Software components may be static (e.g., preset or fixed) or dynamic (e.g., created or modified at execution time).

[0082] The embodiments of the present invention are described in detail above with reference to the accompanying drawings, but the present invention is not limited to the above embodiments, and various changes can be made within the knowledge scope of ordinary technicians in the relevant technical field without departing from the purpose of the present invention.

Claims

1. A hardware current loop, characterized in that: include: A current acquisition module, used for acquiring the U-phase current and the V-phase current of the motor, and preprocessing the U-phase current and the V-phase current; A CLARK conversion acceleration module, used for converting the pre-processed U-phase current and the V-phase current into an α-axis current and a β-axis current; An electrical angle acquisition module, used to acquire the electrical angle of the motor; A Cordic calculation module, used for calculating the sine value and cosine value of the electrical angle; A Park transformation acceleration module, used for obtaining a d-axis current and a q-axis current according to the α-axis current, the β-axis current, the sine value and the cosine value; A D-PID module, used for obtaining a d-axis voltage according to a preset d-axis reference current and the d-axis current; A Q-PID module, used for obtaining a q-axis voltage according to a preset q-axis reference current and the q-axis current; an inverse Park transformation acceleration module, used for obtaining an α-axis voltage and a β-axis voltage according to the d-axis voltage, the q-axis voltage, the sine value and the cosine value; A dead zone compensation module, used for obtaining an α-axis compensation voltage and a β-axis compensation voltage according to the d-axis current and the q-axis current; The SVPWM acceleration module is used to obtain the duty cycle of the PWM module according to the α-axis voltage, the β-axis voltage, the α-axis compensation voltage and the β-axis compensation voltage, and send the duty cycle to the PWM module to control the rotation of the motor.

2. The hardware current loop according to claim 1, characterized in that: The current acquisition module comprises: An ADC module is used to collect the U-phase current and the V-phase current of the motor, and perform analog-to-digital conversion on the U-phase current and the V-phase current; The current preprocessing module is used to set the offset and gain of the current, and preprocess the U-phase current and the V-phase current after analog-to-digital conversion according to the offset and the gain.

3. The hardware current loop according to claim 2, characterized in that: The U-phase current and V-phase current after preprocessing are: PDI U =(IN u -IN Uoff )*CurrCalGain; PDI V =(IN v -IN Voff )*CurrCalGain; Among them, DI u DI is the U-phase current value of the motor feedback after analog-to-digital conversion. v DI is the V-phase current of the motor feedback after analog-to-digital conversion. Uoff is the offset of the U phase current, DI Voff is the offset of the V phase current, CurrCalGain is the gain, PDI U is the U phase current after preprocessing, PDI V is the V-phase current after preprocessing.

4. The hardware current loop according to claim 3, characterized in that: The calculation process of the CLARK transformation acceleration module is: I α =PDI U ; Among them, I α is the α-axis current, I β is the β-axis current.

5. The hardware current loop according to claim 4, characterized in that: The calculation process of the Park transformation acceleration module is: I d_fbk =I α *cosθ+I β *sinθ; I q_fbk =I β *cosθ-I α *sinθ; Among them, I d_fbk is the d-axis current, I q_fbk is the q-axis current, cosθ is the cosine of the electrical angle, and sinθ is the sine of the electrical angle.

6. The hardware current loop according to claim 5, characterized in that: The calculation process of the inverse Park transform acceleration module is: IN α =in d *cosθ-U q *sinθ; IN β =in d *sinθ+u q *cosθ; Among them, U d is the d-axis voltage, U q is the q-axis voltage, U α is the α-axis voltage, U β is the β-axis voltage.

7. The hardware current loop according to claim 1, characterized in that: The electrical angle acquisition module comprises: QEP0 module, used to obtain the signal incremental encoder signal of the motor; TA-AEIO module, used for obtaining the absolute encoder signal of the motor; The electrical angle calculation module is used to calculate the electrical angle of the motor according to the incremental encoder signal or the absolute encoder signal.

8. The hardware current loop according to claim 1, characterized in that: The preset d-axis reference current and q-axis reference current are obtained through speed loop calculation.

9. The hardware current loop according to claim 1, characterized in that: The enabling state of the dead zone compensation module is configured through a register.

10. A motor control system, characterized in that: Comprising a hardware current loop as described in any one of claims 1-9.

Citation Information

Patent Citations

  • Current loop hardware acceleration engine and system

    CN115913040A

  • Vehicle-carried motor controlling device

    CN1969453A

  • Electric power steering apparatus

    US20040262074A1

  • Motor control device and motor control method

    US6388416B1