Control method and system of intelligent servo driver
Through the force value feedback signal collected by the intelligent servo driver in the tension sensor and the speed and position feedback signal collected by the photoelectric encoder, combined with the PID and three-ring control algorithm, the closed-loop control of the force value, speed and position of the motor is achieved, and the solution is to The problems of complex design and high cost in the prior art improve control accuracy and flexibility.
Patent Information
- Application Number
- CN202411066352.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-05
- Publication Date
- 2024-11-15
AI Technical Summary
When the prior art realizes closed-loop control of analog quantities such as tension, the design is complex, the technical threshold is high, the implementation is difficult and the cost is high, and it is difficult to effectively solve the complexity of weak signal acquisition and PID control.
Using intelligent servo drivers, the force value is collected through the tension sensor and the analog signal is converted into digital signals. Combined with the PID control algorithm and the three-ring control algorithm, control instructions for the position ring, speed ring and torque ring are generated, and control and space through magnetic field direction The vector algorithm converts instructions into PWM signals to realize closed-loop control of the motor.
It simplifies the design process, reduces implementation difficulty and cost, improves response speed and accuracy, significantly enhances the flexibility and stability of the system, and is suitable for industrial control applications with high precision and high dynamic performance.
Smart Images

Figure CN118971696A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of motor control, and in particular to a control method and system for an intelligent servo drive. Background Art
[0002] Traditional general servo drives usually use pulse signals or bus signals to achieve closed-loop speed control and position control of the servo system. However, in many applications, closed-loop control of analog quantities such as tension is required. In order to achieve this function, the prior art extends a set of acquisition control systems outside the servo system. On the one hand, this extended system needs to collect weak signals output by strain sensors such as tension; on the other hand, according to the difference between the target value and the current value, the servo system is PID controlled through pulses or bus signals. The implementation of this method requires technicians to have considerable knowledge background in circuit design, software programming, and automatic control principles, which greatly increases the difficulty and complexity of such applications. Therefore, when the prior art realizes closed-loop control of analog quantities such as tension, there are problems such as complex design, difficulty in implementation, and high cost. Summary of the invention
[0003] In view of this, the present invention is committed to providing a control method and system for an intelligent servo drive, which is used to solve the problems of complex control system design, high technical threshold, great implementation difficulty and high cost in the closed-loop control of analog quantities such as tension in the prior art.
[0004] In a first aspect, the present invention provides a control method for an intelligent servo drive, the method comprising:
[0005] Transmit force value command, position command and speed command to the intelligent servo drive;
[0006] The force value feedback analog signal of the motor is collected by the tension sensor, and the force value analog signal is converted into a force value digital signal by a high-precision AD converter and transmitted to the intelligent servo drive;
[0007] Collecting the speed feedback signal and the position feedback signal of the motor through the photoelectric encoder, and transmitting the speed feedback signal and the position feedback signal to the intelligent servo drive;
[0008] Calculate and generate control instructions for position loop, speed loop and torque loop based on PID control algorithm and three-loop control algorithm;
[0009] The motor is decoupled and controlled by magnetic field oriented control, and the control instruction is converted into a PWM signal by a space vector algorithm to control the motor.
[0010] Optionally, the calculation and generation of control instructions for the position loop, the speed loop and the torque loop based on the PID control algorithm and the three-loop control algorithm includes:
[0011] Transmitting the force value instruction and the force value digital signal to a force value closed-loop PID control module;
[0012] Calculating and generating a force value adjustment instruction through a PID control algorithm, and transmitting the force value adjustment instruction to the torque loop;
[0013] Based on the force value adjustment instruction and the actual torque of the motor, a first current instruction is generated by calculating through a PID control algorithm, and the first current instruction is output to a magnetic field oriented control module.
[0014] Optionally, the control instructions of the position loop, the speed loop and the torque loop calculated based on the PID control algorithm and the three-loop control algorithm also include:
[0015] According to the speed command and the speed feedback signal, the speed loop generates a first torque control command by calculating through a PID control algorithm, and transmits the first torque control command to the torque loop;
[0016] Based on the first torque control instruction and the actual torque, a second current instruction is generated by calculating through a PID control algorithm, and the second current instruction is output to a magnetic field oriented control module.
[0017] Optionally, the control instructions of the position loop, the speed loop and the torque loop calculated based on the PID control algorithm and the three-loop control algorithm also include:
[0018] According to the position command and the position feedback signal, the position loop generates a speed control command by calculating through a PID control algorithm, and transmits the speed control command to the speed loop;
[0019] According to the speed control instruction and the speed feedback signal, the speed loop generates a second torque control instruction by calculating through a PID control algorithm, and transmits the second torque control instruction to the torque loop;
[0020] Based on the second torque control instruction and the actual torque, a third current instruction is generated by calculating through a PID control algorithm, and the third current instruction is output to a field-oriented control module.
[0021] Optionally, the method further comprises:
[0022] Based on the first current command, a corresponding torque PWM signal is generated through field oriented control and space vector algorithm, and the torque PWM signal is transmitted to the IPM drive module; or,
[0023] Based on the second current instruction, a corresponding speed PWM signal is generated through field oriented control and space vector algorithm, and the speed PWM signal is transmitted to the IPM drive module; or,
[0024] Based on the third current instruction, a corresponding position PWM signal is generated through field-oriented control and a space vector algorithm, and the position PWM signal is transmitted to the IPM drive module.
[0025] Optionally, the method further comprises:
[0026] Control the power switch according to the torque PWM signal to generate a corresponding three-phase current signal to control the motor; or,
[0027] Control the power switch according to the speed PWM signal to generate a corresponding three-phase current signal to control the motor; or,
[0028] The power switch is controlled according to the position PWM signal to generate a corresponding three-phase current signal to control the motor.
[0029] In a second aspect, the present invention provides a control system of an intelligent servo drive, the system comprising:
[0030] A tension sensor configured to collect a force value analog signal;
[0031] A photoelectric encoder configured to transmit a speed feedback signal and a position feedback signal to the intelligent servo drive;
[0032] An intelligent servo driver comprises a high-precision AD converter and a DSP processor, wherein the DSP processor comprises a three-loop control module and a magnetic field oriented control module; the high-precision AD converter is configured to convert the force value analog signal into a force value digital signal; the three-loop control module comprises a position loop, a speed loop and a torque loop, and is configured to calculate control instructions of the position loop, the speed loop and the torque loop based on a PID control algorithm and a three-loop control algorithm; the magnetic field oriented control module is configured to decouple the motor through magnetic field oriented control, and convert the control instructions into PWM signals through a space vector algorithm to control the motor.
[0033] Optionally, the DSP processor also includes a force closed-loop PID control module and an IPM drive module, the force closed-loop PID control module is configured to calculate and generate a force adjustment instruction through a PID control algorithm, and transmit the force adjustment instruction to the torque loop; the torque loop is configured to calculate and generate a first current instruction through a PID control algorithm based on the force adjustment instruction and the actual torque, and output the first current instruction to the magnetic field oriented control module.
[0034] Optionally, the speed loop is configured to calculate and generate a first torque control instruction through a PID control algorithm based on the speed instruction and the speed feedback signal, and transmit the first torque control instruction to the torque loop; the torque loop is also configured to calculate and generate a second current instruction through a PID control algorithm based on the first torque control instruction and the actual torque, and output the second current instruction to the magnetic field oriented control module.
[0035] Optionally, the position loop is configured to calculate a speed control instruction through a PID control algorithm based on the position instruction and the position feedback signal, and transmit the speed control instruction to the speed loop; the speed loop is also configured to calculate a second torque control instruction through a PID control algorithm based on the speed control instruction and the speed feedback signal, and transmit the second torque control instruction to the torque loop; the torque loop is also configured to calculate a third current instruction through a PID control algorithm based on the second torque control instruction and the actual torque, and output the third current instruction to the magnetic field oriented control module.
[0036] According to the solution of the present invention, a high-precision analog-to-digital conversion (AD) module is integrated in the intelligent servo control system to convert the force feedback analog signal of the motor collected by the tension sensor into a force digital signal, and the PID control algorithm and the three-loop control algorithm are used to realize the closed-loop control of the force, speed and position, thereby driving the motor to complete the corresponding action. In this way, the technical solution of the present invention does not need to expand the external acquisition control system, simplifies the design process, reduces the implementation difficulty and cost, improves the response speed and accuracy through internal closed-loop control, significantly enhances the flexibility and stability of the system, and can be widely used in various high-precision, high-dynamic performance industrial control applications.
[0037] Furthermore, the force value closed-loop PID control module generates a force value adjustment instruction through a PID algorithm, and after transmitting it to the torque loop, generates a current instruction through a PID control algorithm to control the motor to adjust the force value. The technical solution of the present invention realizes a separate closed-loop control of the force value through force value closed-loop PID control and three-loop control, and has a fast response speed and high control accuracy.
[0038] The above description is only an overview of the technical solution of the present invention. In order to more clearly understand the technical means of the present invention and implement it according to the contents of the specification, the preferred embodiments of the present invention are described in detail as follows. BRIEF DESCRIPTION OF THE DRAWINGS
[0039] Figure 1 A schematic flow chart of a control method of an intelligent servo drive according to an embodiment of the present invention is shown;
[0040] Figure 2 Shows Figure 1 A schematic flow chart of an implementation method of calculating and generating control instructions for a position loop, a speed loop and a torque loop based on a PID control algorithm and a three-loop control algorithm in step S400;
[0041] Figure 3 Shows Figure 1 A schematic flow chart of another implementation method of calculating and generating control instructions of the position loop, the speed loop and the torque loop based on the PID control algorithm and the three-loop control algorithm in step S400;
[0042] Figure 4 Shows Figure 1 A schematic flow chart of another implementation method of calculating and generating control instructions of the position loop, the speed loop and the torque loop based on the PID control algorithm and the three-loop control algorithm in step S400;
[0043] Figure 5 A structural block diagram of an intelligent servo control system according to an embodiment of the present invention is shown. DETAILED DESCRIPTION
[0044] In order to make the above-mentioned purposes, features and advantages of the present application more obvious and easy to understand, the specific implementation methods of the present application are described in detail below in conjunction with the accompanying drawings. It is to be understood that the specific embodiments described herein are only used to explain the present application, rather than to limit the present application. It should also be noted that, for ease of description, only some structures related to the present application are shown in the accompanying drawings, rather than all structures. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without making creative work are within the scope of protection of this application.
[0045] The terms "including" and "having" and any variations thereof in this application are intended to cover non-exclusive inclusions. For example, a process, method, system, product or device comprising a series of steps or units is not limited to the listed steps or units, but may optionally include steps or units not listed, or may optionally include other steps or units inherent to these processes, methods, products or devices.
[0046] Reference to "embodiments" herein 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 application. The appearance of the phrase in various locations 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.
[0047] Figure 1FIG. 2 shows a schematic flow chart of a control method of an intelligent servo drive according to an embodiment of the present invention. Figure 1 As shown, the control method of the intelligent servo drive includes:
[0048] Step S100, transmitting the force value instruction, position instruction and speed instruction to the intelligent servo drive.
[0049] In some embodiments, the host computer sends the force value instruction, position instruction and speed instruction to the intelligent servo driver through the RS232 serial port.
[0050] Step S200, collecting the force feedback analog signal of the motor through the tension sensor, converting the force analog signal into a force digital signal through a high-precision AD converter and transmitting it to the intelligent servo driver.
[0051] Step S300, collecting the speed feedback signal and position feedback signal of the motor through the photoelectric encoder, and transmitting the speed feedback signal and position feedback signal to the intelligent servo driver.
[0052] Step S400: generating control instructions for the position loop, speed loop and torque loop based on the PID control algorithm and the three-loop control algorithm.
[0053] Step S500, decoupling control is performed on the motor through field oriented control, and the control instruction is converted into a PWM signal through a space vector algorithm to control the motor.
[0054] According to the solution of the present invention, a high-precision analog-to-digital conversion (AD) module is integrated in the intelligent servo control system to convert the force feedback analog signal of the motor collected by the tension sensor into a force digital signal, and the PID control algorithm and the three-loop control algorithm are used to realize the closed-loop control of the force, speed and position, thereby driving the motor to complete the corresponding action. In this way, the technical solution of the present invention does not need to expand the external acquisition control system, simplifies the design process, reduces the implementation difficulty and cost, improves the response speed and accuracy through internal closed-loop control, significantly enhances the flexibility and stability of the system, and can be widely used in various high-precision, high-dynamic performance industrial control applications.
[0055] Figure 2 Shows Figure 1 A schematic flow chart of a method for calculating and generating control instructions for the position loop, speed loop, and torque loop based on the PID control algorithm and the three-loop control algorithm in step S400. In one embodiment, Figure 2 As shown, step S400 includes:
[0056] S410, transmitting the force value instruction and the force value digital signal to the force value closed-loop PID control module.
[0057] The force command is the target force value input by the user through the host computer; the force digital signal is obtained by converting the motor force analog signal collected by the tension sensor through a high-precision AD converter. The collected motor force analog signal represents the actual force value of the motor at this moment.
[0058] In some embodiments, the high-precision AD converter transmits the converted force value digital signal to the force value closed-loop control module via an I2C interface.
[0059] S411, generating a force value adjustment instruction through calculation by a PID control algorithm, and transmitting the force value adjustment instruction to the torque loop.
[0060] After receiving the above-mentioned force value command and force value digital signal, the force value closed-loop PID control module calculates the error between the actual force value and the target force value through the PID control algorithm, that is, calculates the error between the force value command and the force value digital signal, and generates a force value adjustment command based on the error, and transmits the force value adjustment command to the torque loop for adjusting the torque of the motor to control the force value.
[0061] S412, based on the force value adjustment instruction and the actual torque of the motor, a first current instruction is generated by calculating through a PID control algorithm, and the first current instruction is output to a magnetic field oriented control module.
[0062] After receiving the above-mentioned force value adjustment instruction, the torque loop compares the force value adjustment instruction with the actual torque of the motor at this moment through the PID control algorithm, calculates the torque error, generates a first current instruction according to the error value, and outputs it to the magnetic field oriented control module for adjusting the stator current of the motor to ensure that the torque output by the motor meets the requirements of the force value adjustment instruction.
[0063] In some embodiments, the intelligent servo control system includes a torque sensor or a current sensor, which collects data such as the current and voltage of the motor in real time. The control system calculates the real-time torque of the motor based on the collected real-time current and voltage of the motor.
[0064] S413, based on the first current instruction, generate a corresponding torque PWM signal through field oriented control and space vector algorithm, and transmit the torque PWM signal to the IPM drive module.
[0065] The field-oriented control module performs decoupling control on the motor through field-oriented control based on the first current command, converts the first current command into a PWM signal through a space vector algorithm, and outputs it to the IPM drive module for controlling the motor.
[0066] S414, controlling the power switch according to the torque PWM signal, generating a corresponding three-phase current signal, and controlling the motor.
[0067] In some embodiments, the PWM signal is composed of 6 waveforms, each pair of waveforms controls one phase of the motor, and the IPM drive module generates corresponding three-phase current signals according to the 6 waveforms of the torque PWM signal to control the motor.
[0068] According to the above embodiment, the force value closed-loop PID control module generates a force value adjustment instruction through the PID algorithm, and after transmitting it to the torque loop, it generates a current instruction through the PID control algorithm to control the motor to adjust the force value, thereby realizing a separate closed-loop control of the force value with fast response speed and high control accuracy.
[0069] like Figure 3 As shown, in another embodiment, the step S400 further includes:
[0070] S420, according to the speed command and the speed feedback signal, the speed loop calculates and generates a first torque control command through a PID control algorithm, and transmits the first torque control command to the torque loop.
[0071] When the intelligent servo control system receives the speed command sent by the host computer, the speed loop compares the speed command with the speed feedback signal of the motor at this time, calculates the error value through the PID control algorithm, and generates the first torque control command based on the error value, which is used to adjust the motor torque to achieve the speed required by the speed command.
[0072] In some embodiments, the speed feedback signal is collected by a photoelectric encoder and transmitted to the speed loop through a QEP interface.
[0073] S421, based on the first torque control instruction and the actual torque, generate a second current instruction through a PID control algorithm, and output the second current instruction to a magnetic field oriented control module.
[0074] After receiving the first torque control command sent by the speed loop, the torque loop compares it with the actual torque of the motor at this time, calculates the error value between the first torque control command and the actual torque through the PID control algorithm, and generates a second current command based on this error value to adjust the stator current of the motor, thereby adjusting the torque of the motor. The torque of the motor is proportional to the acceleration of the motor. Therefore, by adjusting the torque of the motor, the speed loop can control the acceleration and deceleration of the motor and control the speed of the motor.
[0075] S422, based on the second current instruction, generate a corresponding speed PWM signal through field oriented control and space vector algorithm, and transmit the speed PWM signal to the IPM drive module.
[0076] S423, controlling the power switch according to the speed PWM signal, generating a corresponding three-phase current signal, and controlling the motor.
[0077] like Figure 4 As shown, in another embodiment, the step S400 further includes:
[0078] S430, according to the position command and the position feedback signal, the position loop calculates and generates a speed control command through a PID control algorithm, and transmits the speed control command to the speed loop.
[0079] When the intelligent servo control system receives the position command sent by the host computer, the position loop compares the position command with the position feedback signal of the motor at that time, calculates the error value through the PID control algorithm, and generates a speed control command based on the error value to adjust the motor speed to achieve the position required by the position command.
[0080] In some embodiments, the position feedback signal is acquired by a photoelectric encoder and transmitted to the position loop through a QEP interface.
[0081] S431, according to the speed control instruction and the speed feedback signal, the speed loop calculates and generates a second torque control instruction through a PID control algorithm, and transmits the second torque control instruction to the torque loop.
[0082] After receiving the speed control command sent by the position loop, the speed loop compares it with the actual speed of the motor at this time, calculates the error value between the speed control command and the actual speed through the PID control algorithm, and generates a second torque control command based on this error value to adjust the torque of the motor, thereby controlling the speed of the motor.
[0083] S432, based on the second torque control instruction and the actual torque, generate a third current instruction through PID control algorithm calculation, and output the third current instruction to the magnetic field oriented control module.
[0084] After receiving the second torque control instruction, the torque loop compares it with the actual torque of the motor at this time, calculates the error value between the second torque control instruction and the actual torque through the PID control algorithm, and generates a third current instruction based on this error value to adjust the stator current of the motor, thereby adjusting the torque of the motor. By adjusting the motor torque, the speed of the motor is affected, thereby changing the position of the motor and realizing the control of the motor position.
[0085] S433, based on the third current instruction, generate a corresponding position PWM signal through magnetic field oriented control and space vector algorithm, and transmit the position PWM signal to the IPM drive module.
[0086] S434, controlling the power switch according to the position PWM signal, generating a corresponding three-phase current signal, and controlling the motor.
[0087] According to the above embodiments, the technical solution of the present invention controls the motor force, speed and position respectively through three-loop control, thereby improving the control accuracy of the system, enhancing the stability of the system, and providing more applicable scenarios.
[0088] The embodiment of the present invention also provides a control system of an intelligent servo drive. Figure 5 As shown, the control system includes a tension sensor 100 , a photoelectric encoder 200 and an intelligent servo driver 300 .
[0089] A tension sensor 100 is configured to collect a force value analog signal;
[0090] The photoelectric encoder 200 is configured to transmit a speed feedback signal and a position feedback signal to the intelligent servo driver 300;
[0091] The intelligent servo drive 300 includes a high-precision AD converter 310 and a DSP processor 320, wherein the DSP processor 320 includes a three-loop control module 321 and a magnetic field oriented control module 322; the high-precision AD converter 310 is configured to convert a force value analog signal into a force value digital signal; the three-loop control module 321 includes a position loop 3211, a speed loop 3212 and a torque loop 3213, and the three-loop control module 321 is configured to calculate control instructions of the position loop 3211, the speed loop 3212 and the torque loop 3213 based on a PID control algorithm and a three-loop control algorithm; the magnetic field oriented control module 322 is configured to decouple the motor through magnetic field oriented control, and to control the motor by converting the control instructions into PWM signals through a space vector algorithm.
[0092] In some feasible embodiments, the DSP processor 320 also includes a force closed-loop PID control module 323 and an IPM drive module 324. The force closed-loop PID control module 323 is configured to generate a force adjustment instruction through a PID control algorithm, and transmit the force adjustment instruction to the torque loop 3213; the torque loop 3213 is configured to generate a first current instruction through a PID control algorithm based on the force adjustment instruction and the actual torque, and output the first current instruction to the magnetic field oriented control module 322.
[0093] In some feasible embodiments, the speed loop 3212 is configured to calculate and generate a first torque control instruction through a PID control algorithm based on the speed instruction and the speed feedback signal, and transmit the first torque control instruction to the torque loop 3213; the torque loop 3213 is also configured to calculate and generate a second current instruction through a PID control algorithm based on the first torque control instruction and the actual torque, and output the second current instruction to the magnetic field oriented control module 322.
[0094] In some feasible embodiments, the position loop 3211 is configured to generate a speed control instruction by calculating through a PID control algorithm according to the position instruction and the position feedback signal, and transmit the speed control instruction to the speed loop 3212; the speed loop 3212 is also configured to generate a second torque control instruction by calculating through a PID control algorithm according to the speed control instruction and the speed feedback signal, and transmit the second torque control instruction to the torque loop 3213; the torque loop 3213 is also configured to generate a third current instruction by calculating through a PID control algorithm based on the second torque control instruction and the actual torque, and output the third current instruction to the magnetic field oriented control module 322.
[0095] In the control system of the control method using the intelligent servo drive, the specific implementation methods when receiving different instructions refer to the relevant contents of the embodiments of the above method, which will not be repeated here.
[0096] The technical features of the above-described embodiments may be arbitrarily combined. To make the description concise, not all possible combinations of the technical features in the above-described embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification.
[0097] The above-mentioned embodiments only express several implementation methods of the present invention, and the descriptions thereof are relatively specific and detailed, but they cannot be understood as limiting the scope of the invention patent. It should be pointed out that, for ordinary technicians in this field, several variations and improvements can be made without departing from the concept of the present invention, and these all belong to the protection scope of the present invention. Therefore, the protection scope of the patent of the present invention shall be subject to the attached claims.
Claims
1. A control method for an intelligent servo drive, characterized in that: The method comprises: Transmit force value command, position command and speed command to the intelligent servo drive; The force value feedback analog signal of the motor is collected by the tension sensor, and the force value analog signal is converted into a force value digital signal by a high-precision AD converter and transmitted to the intelligent servo drive; Collecting the speed feedback signal and the position feedback signal of the motor through the photoelectric encoder, and transmitting the speed feedback signal and the position feedback signal to the intelligent servo drive; Calculate and generate control instructions for position loop, speed loop and torque loop based on PID control algorithm and three-loop control algorithm; The motor is decoupled and controlled by magnetic field oriented control, and the control instruction is converted into a PWM signal by a space vector algorithm to control the motor.
2. The control method according to claim 1, characterized in that: The control instructions for calculating and generating the position loop, speed loop and torque loop based on the PID control algorithm and the three-loop control algorithm include: Transmitting the force value instruction and the force value digital signal to a force value closed-loop PID control module; Calculating and generating a force value adjustment instruction through a PID control algorithm, and transmitting the force value adjustment instruction to the torque loop; Based on the force value adjustment instruction and the actual torque of the motor, a first current instruction is generated by calculating through a PID control algorithm, and the first current instruction is output to a magnetic field oriented control module.
3. The control method according to claim 1, characterized in that: The control instructions of the position loop, speed loop and torque loop calculated based on the PID control algorithm and the three-loop control algorithm also include: According to the speed command and the speed feedback signal, the speed loop generates a first torque control command by calculating through a PID control algorithm, and transmits the first torque control command to the torque loop; Based on the first torque control instruction and the actual torque, a second current instruction is generated by calculating through a PID control algorithm, and the second current instruction is output to a magnetic field oriented control module.
4. The control method according to claim 1, characterized in that: The control instructions of the position loop, speed loop and torque loop calculated based on the PID control algorithm and the three-loop control algorithm also include: According to the position command and the position feedback signal, the position loop generates a speed control command by calculating through a PID control algorithm, and transmits the speed control command to the speed loop; According to the speed control instruction and the speed feedback signal, the speed loop generates a second torque control instruction by calculating through a PID control algorithm, and transmits the second torque control instruction to the torque loop; Based on the second torque control instruction and the actual torque, a third current instruction is generated by calculating through a PID control algorithm, and the third current instruction is output to a field-oriented control module.
5. The control method according to any one of claims 1 to 4, characterized in that: The method further comprises: Based on the first current command, a corresponding torque PWM signal is generated through field oriented control and space vector algorithm, and the torque PWM signal is transmitted to the IPM drive module; or, Based on the second current instruction, a corresponding speed PWM signal is generated through field oriented control and space vector algorithm, and the speed PWM signal is transmitted to the IPM drive module; or, Based on the third current instruction, a corresponding position PWM signal is generated through field-oriented control and a space vector algorithm, and the position PWM signal is transmitted to the IPM drive module.
6. The intelligent servo control method according to claim 5, characterized in that: The method further comprises: Control the power switch according to the torque PWM signal to generate a corresponding three-phase current signal to control the motor; or, Control the power switch according to the speed PWM signal to generate a corresponding three-phase current signal to control the motor; or, The power switch is controlled according to the position PWM signal to generate a corresponding three-phase current signal to control the motor.
7. A control system using the control method of the intelligent servo drive according to any one of claims 1 to 6, characterized in that: The system comprises: A tension sensor configured to collect a force value analog signal; A photoelectric encoder configured to transmit a speed feedback signal and a position feedback signal to the intelligent servo drive; An intelligent servo driver comprises a high-precision AD converter and a DSP processor, wherein the DSP processor comprises a three-loop control module and a magnetic field oriented control module; the high-precision AD converter is configured to convert the force value analog signal into a force value digital signal; the three-loop control module comprises a position loop, a speed loop and a torque loop, and is configured to calculate control instructions of the position loop, the speed loop and the torque loop based on a PID control algorithm and a three-loop control algorithm; the magnetic field oriented control module is configured to decouple the motor through magnetic field oriented control, and convert the control instructions into PWM signals through a space vector algorithm to control the motor.
8. The control system according to claim 7, characterized in that: The DSP processor further comprises a force value closed-loop PID control module and an IPM driving module, wherein the force value closed-loop PID control module is configured to generate a force value adjustment instruction by calculating a PID control algorithm and transmit the force value adjustment instruction to the torque loop; The torque loop is configured to generate a first current command through a PID control algorithm based on the force value adjustment command and the actual torque, and output the first current command to the field oriented control module.
9. The control system according to claim 7, characterized in that: The speed loop is configured to generate a first torque control instruction by calculating through a PID control algorithm according to the speed instruction and the speed feedback signal, and transmit the first torque control instruction to the torque loop; The torque loop is further configured to generate a second current command by calculating through a PID control algorithm based on the first torque control command and the actual torque, and output the second current command to a field oriented control module.
10. The control system according to claim 7, characterized in that: The position loop is configured to calculate and generate a speed control instruction through a PID control algorithm according to the position instruction and the position feedback signal, and transmit the speed control instruction to the speed loop; the speed loop is also configured to calculate and generate a second torque control instruction through a PID control algorithm according to the speed control instruction and the speed feedback signal, and transmit the second torque control instruction to the torque loop; the torque loop is also configured to calculate and generate a third current instruction through a PID control algorithm based on the second torque control instruction and the actual torque, and output the third current instruction to the magnetic field oriented control module.
Citation Information
Cited By
Force-position cooperative control circuit with energy feedback
CN120370824A
A force-position coordinated control circuit with energy feedback
CN120370824B
