Current loop control device, method and equipment and readable storage medium
By executing the current PID algorithm in the driving unit and using optical fiber transmission and data frame structured communication, the problems of high delay and many interface signals in the current loop control are solved, and efficient and stable current loop control is achieved.
Patent Information
- Application Number
- CN202411193271.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-28
- Publication Date
- 2024-12-03
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
The existing current loop control has high delay and insufficient real-time performance during the PWM wave generation process, and the number of interface signals between the driving unit and the control unit is large, the cost is high, and the anti-interference performance and transmission stability are weak.
By executing the current PID algorithm in the driving unit, a PWM control signal is generated, and current instructions and PID adjustment parameters are transmitted through the serial bus. The communication method of optical fiber transmission and data frame structure is adopted to reduce the number of interface signals, improve transmission efficiency and stability sex.
It reduces the calculation pressure on the software side, improves the PWM wave frequency, reduces the cost, enhances the anti-interference performance and stability of transmission, and improves the scalability and reliability of current loop control.
Smart Images

Figure CN119065230A_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the technical field of numerical control systems, and in particular relates to a current loop control device, method, system, equipment and medium. Background Art
[0002] The servo drive control system is generally composed of a control unit (CNC), a drive unit, a servo motor, and a feedback detection device. Among them, the servo drive control system has three basic control modes: position control, speed control, and current control. These three control modes correspond to the three closed loops of the servo system from the outside to the inside: "position loop", "speed loop", and "current loop". When using the position control method, the servo unit completes the control of all three closed loops; when using the speed control method, the servo unit completes the control of the speed and current closed loops; when using the current control method, the servo unit only completes the closed loop control of the current loop.
[0003] In the existing technical solutions, the process of generating PWM waves by current loop control relies on PID calculation by software, which has high delay and insufficient real-time performance, resulting in a long waiting time for the PWM generation process and difficulty in increasing the PWM wave frequency. At the same time, limited by the current redundant and complex data transmission strategy, the number of interface signals between the drive unit and the control unit is large, the cost is high, the scalability is poor, and the anti-interference performance and transmission stability are relatively weak.
[0004] Therefore, in view of the above technical problems, it is necessary to provide an improved current loop control strategy.
[0005] The information disclosed in this background technology section is only intended to enhance the understanding of the overall background of the invention and should not be regarded as an acknowledgment or any form of suggestion that the information constitutes the prior art already known to a person skilled in the art. Summary of the invention
[0006] The object of the present invention is to provide a current loop control device, method, equipment and readable storage medium, which can reduce the number of interface signals between drive control devices, reduce costs, and improve the scalability of the drive control device interface, as well as the efficiency, stability and reliability of long-distance transmission.
[0007] In order to achieve the above object, a technical solution provided by a specific embodiment of the present invention is as follows:
[0008] In a first aspect, the present invention provides a current loop control device for an AC servo motor, comprising:
[0009] A control unit, used for generating a current command and a current PID adjustment parameter, and transmitting the current command and the current PID adjustment parameter to the drive unit via a serial bus;
[0010] The drive unit receives the current command and the current PID adjustment parameter from the control unit, performs the current PID algorithm adjustment in the drive unit, generates the PWM control signal, and feeds back the drive current to realize the current loop closed-loop control.
[0011] In one or more embodiments of the present invention, the serial bus protocol of the serial bus includes:
[0012] Define a data format of a minimum data unit, wherein the data format includes a start bit, a data bit, a check bit, and a stop bit;
[0013] A data frame structure of a basic information unit of a single communication is defined, wherein the data frame structure includes a control field, a periodic data field, a non-periodic data field and a check field.
[0014] In one or more embodiments of the present invention, the current loop control device comprises:
[0015] The periodic data field is used to write all periodically changing data to be transmitted based on a preset fixed position and field length, and the periodically changing data includes instruction id, instruction iq, actual motor position, current feedback data, and actual motor phase;
[0016] The non-periodic data field is used to write any non-periodic changing data to be transmitted, and the non-periodic changing data includes PWM wave generation frequency, dead time, current loop integral gain, and drive unit error code;
[0017] The control field is used to write a data tag corresponding to the non-periodically changing data to be transmitted written into the non-periodically changing data field, and the data tag corresponds to the non-periodically changing data to be transmitted one by one;
[0018] The check field is used to determine whether the data information in the data frame is abnormal.
[0019] In one or more embodiments of the present invention, the current loop control device comprises:
[0020] The control unit and the driving unit perform serial optical communication based on a preset optical module, and the optical module of the control unit and the optical module of the driving unit are correspondingly connected via an optical fiber;
[0021] The optical module of the control unit is used to convert the current command and the current PID adjustment parameter into an optical signal, and the optical module of the driving unit is used to convert the optical signal emitted by the control unit into the current command and the current PID adjustment parameter.
[0022] In one or more embodiments of the present invention, the driving unit further includes:
[0023] A current control module, used for receiving a current command and a current PID adjustment parameter from the control unit, and calculating and generating a PWM control signal based on a current PID algorithm;
[0024] A rectifier module converts the input AC power into DC power and performs filtering and voltage stabilization on the DC power;
[0025] The inverter module converts the filtered direct current into alternating current based on the PWM control signal generated by the current control module and the preset input voltage and frequency.
[0026] In a second aspect, the present invention provides a current loop control method, which is applied to the current loop control device, and comprises:
[0027] Generate a current command and a current PID adjustment parameter, and transmit the current command and the current PID adjustment parameter to the drive unit via a serial bus;
[0028] The current command and current PID adjustment parameter are received from the control unit, the current PID algorithm adjustment is performed in the drive unit, a PWM control signal is generated, and the drive current is fed back to realize current closed-loop control.
[0029] In one or more embodiments of the present invention, transmitting the current command and the current PID adjustment parameter to the drive unit via a serial bus includes:
[0030] Based on the serial bus protocol, the data to be transmitted is packaged into data frames, and the data frames are sent through the data lines of the serial bus;
[0031] The current control module parses the received data frame based on the serial bus protocol to read information in the data frame.
[0032] In one or more embodiments of the present invention, the method further comprises:
[0033] Based on the data frame check field, determining whether the data information in the data frame is abnormal;
[0034] If yes, performing a minimum data unit self-check based on the check bits of each minimum data unit constituting the data frame;
[0035] The receiving end reports abnormal data information and an alarm signal and discards the data frame.
[0036] In a third aspect, the present invention provides a computer device, comprising: a memory and a processor, wherein the memory and the processor are communicatively connected to each other, computer instructions are stored in the memory, and the processor executes the current loop control method by executing the computer instructions.
[0037] In a fourth aspect, the present invention provides a computer-readable storage medium, wherein the computer-readable storage medium stores computer instructions, and the computer instructions are used to enable a computer to execute the current loop control method.
[0038] Compared with the prior art, the current loop control device provided by the present invention decouples the calculation process of the current loop control from the software side of the control unit. By improving the system architecture, the relevant calculation process is implemented through the chip set in the drive unit, reducing the load pressure on the software side. Furthermore, through the newly added optical module, optical fiber transmission between drive and control devices can be realized, enhancing transmission efficiency.
[0039] On the other hand, the data communication method provided by the present invention converts the data to be transmitted into a data frame of a preset format for transmission, and does not need to set a transmission pin for each type of data separately, thereby reducing the number of interface signals between drive and control devices and reducing wiring costs. The periodic data in the data frame has a fixed position and bit, so that the receiving end can identify the data type of the corresponding field, and on the basis of not occupying the data frame space to establish a new identifier, there will be no confusion caused by multiple data transmission and reception; for non-periodic data, considering its own nature, in order to save transmission resources, the type and number of non-periodic data transmitted in each cycle can be dynamically set.
[0040] In addition, the prior art does not verify the data transmitted during current loop control, and assumes that the data transmission between drive and control devices is credible, which often causes instability in current loop control. The data communication method provided by the present invention has a check field in the data frame, and each DATA data constituting the data frame is also provided with a check bit. Through double verification, the source of abnormal data can be accurately identified, which facilitates the investigation of the path of error information and makes the current loop control more stable. BRIEF DESCRIPTION OF THE DRAWINGS
[0041] 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 recorded in the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.
[0042] Figure 1 is a schematic diagram of a current loop control device in one embodiment of the present invention;
[0043] Figure 2 is a flow chart of a current loop control method in one embodiment of the present invention;
[0044] Figure 3 This is a schematic diagram of the optical module architecture of a driving and controlling device in one embodiment of the present invention;
[0045] Figure 4 is a schematic diagram of a data transmission interface of a drive control device in one embodiment of the present invention;
[0046] Figure 5 is a schematic diagram of the data format of the smallest data unit in one embodiment of the present invention;
[0047] Figure 6 This is a schematic diagram of a data frame structure in one embodiment of the present invention;
[0048] Figure 7 It is a structural block diagram of an electronic device in one embodiment of the present invention. DETAILED DESCRIPTION
[0049] The specific implementation modes of the present invention are described in detail below in conjunction with the accompanying drawings, but it should be understood that the protection scope of the present invention is not limited by the specific implementation modes.
[0050] Unless explicitly stated otherwise, throughout the specification and claims, the term “comprise” or variations such as “include” or “comprising”, etc., will be understood to include the stated elements or components but not to exclude other elements or components.
[0051] In the prior art solution, there are related devices for current loop control and corresponding current loop control implementation methods. Specifically, in the prior art, the current loop control architecture includes a drive unit and a control unit, and the control unit is used to perform three-loop control in response to the actual working state of the servo motor. Among them, the speed loop calculates the current speed by detecting the servo motor encoder signal to perform negative feedback PID adjustment, and its internal PID output is the current command. The position loop is the outermost loop, and the internal PID output of the position loop is the speed command. The current loop detects the actual current of each phase of the motor, negatively feeds back to the current command, and performs PID adjustment based on software calculation in the central processor of the control unit, so that the actual current approaches the command current.
[0052] Under the existing servo control architecture, the position loop calculation, speed loop calculation and current loop calculation are all processed by the central processing unit of the control unit. The current command and current adjustment parameters obtained after processing are transmitted to the corresponding drive unit based on different pins on the board. The drive unit is used to convert the input AC power into DC power and filter and stabilize the DC power; based on the current control signal and the preset input voltage and frequency, the filtered DC power is converted into AC power.
[0053] Since the calculation tasks of the three-loop control are all based on the software processing of the control unit, the generation of PWM waves depends on the PID calculation link, which will greatly increase the load pressure on the software side, with high latency and insufficient real-time performance, resulting in a long waiting time for the PWM generation process and difficulty in increasing the PWM wave frequency. On the other hand, limited by the existing data transmission protocol, different data types occupy pins for transmission respectively, with a large number of interface signals and signal lines, resulting in high costs. At the same time, when a new set of signals needs to be added for transmission, the hardware layout needs to be adjusted, resulting in poor scalability. During the current loop control process, the transmitted data signal is credible by default. For scenarios such as long-distance transmission, the anti-interference performance and transmission stability are weak.
[0054] The inventor of the present invention has discovered the main shortcomings of the prior art, and based on the shortcomings of the prior art, has proposed a new technical implementation idea: adding a current control module for current loop calculation, decoupling the current loop related calculation steps from the central processing unit software side, and changing the data transmission format at the same time, defining the data frame format, and realizing efficient data transmission through optical fiber connection. When expanding the data type, it is only necessary to modify the data frame format according to the nature of the data, without changing the interface, rewiring, etc. on the hardware side. Furthermore, the data frame format defines a check field, and the validity of the data will be verified during the data reception process, thereby improving the reliability of the current loop control.
[0055] Please refer to Figure 1 , which is a schematic diagram of a current loop control device provided by the present invention under an implementation mode, the current loop control device comprises: a control unit 101 and a driving unit 102;
[0056] It should be noted that a communication connection is provided between the control unit 101 and the drive unit 102, and the communication network derived from the above communication connection may include various connection types, including but not limited to: wired connection, wireless connection or optical fiber cable connection, etc. At the same time, the communication network may be a local area network, a metropolitan area network, a wide area network or any combination of the three. Due to the current loop control, the signal is susceptible to interference and attenuation under long-distance transmission conditions. Therefore, in an industrial strong noise environment or a long-distance transmission environment, it is preferred to use an optical fiber to connect the drive unit and the control unit to achieve efficient and reliable data transmission.
[0057] In an exemplary embodiment, Figure 3 As shown, the control unit and the driving unit perform serial optical communication based on a preset optical module, and the optical module of the control unit is correspondingly connected to the optical module of the driving unit through an optical fiber; the optical module of the control unit is used to convert the current command and the current PID adjustment parameter into an optical signal, and the optical module of the driving unit is used to convert the optical signal emitted by the control unit into the current command and the current PID adjustment parameter.
[0058] In the three-loop control of the servo motor, optical fiber is used as the transmission medium between the drive and control devices, which can avoid electromagnetic interference during long-distance signal transmission, and the attenuation and distortion of the signal are greatly reduced compared with other transmission methods. In addition, the speed of optical fiber transmission is extremely fast, which makes up for the shortcomings of the current current loop control process in terms of data transmission. Optical fiber transmission is a physical transmission method, the signal cannot be eavesdropped or cracked, it has high security, and it is small in size, light in weight, and easy to wire.
[0059] More specifically, the control unit 101 is used to generate a current command and a current PID adjustment parameter, and transmit the current command and the current PID adjustment parameter to the drive unit via a serial bus;
[0060] It should be noted that the serial bus protocol of the serial bus includes: defining a data format of a minimum data unit, the data format including a start bit, a data bit, a check bit and a stop bit;
[0061] It can be understood that the start bit is used to mark the start of serial port data transmission, and the data sent thereafter is valid data; in contrast to the start bit, the stop bit is used to mark the end of data. One of the start bit and the stop bit is logic 0, and the other is logic 1. At the same time, the number of bits occupied by the two can be adaptively adjusted based on the needs of actual application scenarios.
[0062] For example, since the data is timed on the transmission line and each device has its own clock, in a poor transmission environment, data asynchrony is repeatedly detected during the transmission process. You can consider extending the number of bits occupied by the stop bit and performing clock synchronization correction when the stop bit is pulled high / low.
[0063] The data bit is used to store valid data to be transmitted, usually following the start bit, and the number of bits it occupies needs to be configured accordingly as needed. The check bit is set after the data bit and before the stop bit to prevent data deviation caused by external interference during the communication process. It is used to detect whether the data bit has a data jump during the transmission process. Different check modes can be configured based on different implementation scenarios. The check modes may include but are not limited to: odd check, even check, 0 check, 1 check, etc., and the embodiments of the present invention do not limit this.
[0064] For example, refer to Figure 5 The data format diagram of the minimum data unit in one embodiment of the present invention is shown. In this specific embodiment, a 1-bit start bit and a 1-bit stop bit are provided, a low level indicates the start of data transmission, and a high level indicates the end of data transmission. A 16-bit data bit is also provided between the above-mentioned start bit and stop bit for transmitting data such as current instructions and PID adjustment parameters of current loop control, as well as a 1-bit check bit. In this embodiment, an odd check method is adopted, that is, by setting a rule, the total number of 1s in the data unit must be an odd number. When the total number of 1s in other bits is an even number except the check bit, the check position is 1, otherwise the check position is 0.
[0065] It should also be noted that the serial bus protocol of the serial bus also includes: a data frame structure defining a basic information unit of a single communication, the data frame structure including a control field, a periodic data field, a non-periodic data field and a check field.
[0066] The data frame is composed of one or more of the above minimum data units, and its size can be configured based on the amount of data to be transmitted in an actual application scenario.
[0067] For example, in a specific embodiment, the data frame length is fixed to 8 DATA, wherein the length of the control field and the check field is 1 minimum data unit, the periodic data is 4 minimum data units, and the non-periodic data is 2 minimum data units. Based on the fixed frame length, the time required for data transmission can be calculated, T = 8*(19*1 / 100MHz) = 15.2us.
[0068] To realize current loop control, the drive unit and the control unit need to maintain communication. Figure 4As shown, it is a schematic diagram of the data transmission interface of the drive control device in one embodiment of the present invention. In the embodiment of the present invention, the traditional transmission mode of one type of data per pin is abandoned, and the data to be transmitted is packaged and transmitted based on the preset data frame format. The TX interface is used for data output and the RX interface is used for data input, which saves the number of interfaces to the greatest extent and reduces the cost and difficulty of wiring. Since the data to be transmitted is usually large, in order to further optimize the serial communication protocol of the present invention, the data is classified into periodic data and non-periodic data.
[0069] Among them, periodic data refers to the data to be transmitted that changes in each cycle over time during the current loop control process, such as instruction ID, instruction IQ, actual position of the servo motor, motor phase, etc. These data need to be synchronized in each cycle of communication. Conversely, non-periodic data refers to the data to be transmitted that does not change periodically over time in the current loop control. For example, PWM wave generation frequency, motor type, current loop integration limit, etc. Due to its inherent nature of being difficult to change, non-periodic data does not need to be fully synchronized in each cycle of communication. Based on this, the pressure of data transmission is greatly reduced without reducing the communication quality and control accuracy.
[0070] Specifically, the periodic data field of the above data frame is used to write all periodically changing data to be transmitted based on a preset fixed position and field length; the periodic data field is used to write any number of non-periodically changing data to be transmitted.
[0071] It is understandable that there are too many types of data contained in the data frame, so if a data tag is defined for each data written into the data frame, a large amount of memory will be occupied. Since the periodic data needs to be fully updated in each communication, that is, each data frame must contain all types of periodic data, in an embodiment of the present invention, various types of periodic data are fixed in the periodic field of the data frame. The corresponding position and field length. Based on this, the receiving end can perceive the type of data in the data frame without a data tag when receiving.
[0072] For non-periodic data, its transmission requirements are relatively loose. Any non-periodic data can be written in the non-periodic data field of the data frame for each communication, and the type of data written each time is not limited. It is only necessary to write the data tag of the written non-periodic data into the control field so that the receiving end can identify the data written in the corresponding non-periodic data field. Among them, the data tag corresponds to the non-periodic data one-to-one, and the mapping relationship and the specific setting rules of the label are not limited by the embodiment of the present invention. Preferably, in an embodiment of the present invention, when the non-periodic data changes, the changed non-periodic data can be written into the non-periodic data field of the data frame in the next cycle to perform data transmission and update.
[0073] Similar to the check bit of the minimum data unit, a check field is also provided in the data frame to check whether the data in the data frame is abnormal.
[0074] The drive unit 102 is used to receive the current command and current PID adjustment parameters from the control unit, execute the current PID algorithm adjustment in the drive unit, generate the PWM control signal, and feed back the drive current to realize the current loop closed-loop control.
[0075] It should be noted that the drive unit also includes: a current control module, a rectifier module and an inverter module. Specifically, the current control module is used to receive the current command and current PID adjustment parameters from the control unit, and calculate and generate a PWM control signal based on the current PID algorithm; the rectifier module is used to convert the input AC power into DC power, and filter and stabilize the DC power; the inverter module is used to convert the filtered DC power into AC power based on the PWM control signal generated by the current control module and the preset input voltage and frequency.
[0076] Among them, the current control module is used to replace the central processor software side to perform PID calculation, Clarke transformation, Park transformation, PWM switch signal generation and other tasks in the current loop control, thereby reducing the calculation pressure on the software side. It should be noted that the current control module may include but is not limited to: FPGA, MCU, MPU, etc., and the embodiment of the present invention does not limit this.
[0077] Please refer to Figure 2 FIG. 1 is a flow chart of a current loop control method according to an embodiment of the present invention. The current loop control method specifically comprises the following steps:
[0078] S201: Generate a current command and a current PID adjustment parameter, and transmit the current command and the current PID adjustment parameter to a drive unit via a serial bus;
[0079] It should be noted that the current command and current PID adjustment parameter are transmitted to the drive unit via the serial bus, including: based on the serial bus protocol, the data to be transmitted is packaged into a data frame, and the data frame is sent through the data line of the serial bus; the current control module parses the received data frame based on the serial bus protocol to read the information in the data frame.
[0080] The serial bus protocol also includes: defining a data format of the minimum data unit, the data format including a start bit, a data bit, a check bit and a stop bit; and defining a data frame structure of a basic information unit for a single communication, the data frame structure including a control field, a periodic data field, a non-periodic data field and a check field.
[0081] The periodic data field is used to write all periodically changing data to be transmitted based on a preset fixed position and field length, and the periodically changing data includes instruction id, instruction iq, actual motor position, current feedback data, and actual motor phase; the non-periodic data field is used to write any non-periodic changing data to be transmitted, and the non-periodic changing data includes PWM wave generation frequency, dead time, current loop integral gain, and drive unit error code; the control field is used to write the data tag corresponding to the non-periodic changing data to be transmitted written into the non-periodic data field, and the data tag corresponds one-to-one to the non-periodic changing data to be transmitted; the check field is used to determine whether the data information in the data frame is abnormal.
[0082] S202: receiving a current command and a current PID adjustment parameter from the control unit, executing a current PID algorithm adjustment in the drive unit, generating a PWM control signal, and feeding back the drive current to implement current closed-loop control.
[0083] It should be noted that the method also includes: based on the data frame check field, determining whether the data information in the data frame is abnormal; if so, performing a minimum data unit self-check based on the check bits of each minimum data unit constituting the data frame; the receiving end reports the abnormal data information and an alarm signal, and discards the data frame.
[0084] It is understandable that the present invention packages the data to be transmitted into a format of a data frame composed of multiple minimum data units, and the data frame and each of the data units have corresponding check bits / check fields. In the process of judging the abnormality, a comprehensive investigation can be carried out through the check field of the data frame, and if there is an abnormality, it can be accurately located based on the check bit of the above minimum data unit. After the source of the error information is found, the erroneous data frame should be discarded so that the system maintains the state of the correct data received in the previous cycle until the correct data frame of the next cycle is received.
[0085] Please refer to Figure 7 As shown, an embodiment of the present invention further provides an electronic device 300, which includes at least one processor 301, a memory 302 (such as a non-volatile memory), a memory 303, and a communication interface 304, and the at least one processor 301, the memory 302, the memory 303, and the communication interface 304 are connected together via a bus 305. At least one processor 301 is used to call at least one program instruction stored or encoded in the memory 302, so that the at least one processor 301 performs various operations and functions of the current loop control method described in various embodiments of this specification.
[0086] In an embodiment of the present specification, the electronic device 300 may include, but is not limited to, personal computers, server computers, workstations, desktop computers, laptop computers, notebook computers, mobile electronic devices, smart phones, tablet computers, cellular phones, personal digital assistants (PDAs), handheld devices, messaging devices, wearable electronic devices, consumer electronic devices, and the like.
[0087] An embodiment of the present invention further provides a computer-readable medium carrying computer-executable instructions. When the computer-executable instructions are executed by a processor, they can be used to implement various operations and functions of the current loop control method described in various embodiments of this specification.
[0088] The computer-readable medium in the present invention may be a computer-readable signal medium or a computer-readable storage medium or any combination of the above two. The computer-readable storage medium may be, for example, but not limited to, an electrical, magnetic, optical, electromagnetic, infrared, or semiconductor system, device or device, or any combination of the above. More specific examples of computer-readable storage media may include, but are not limited to: an electrical connection with one or more wires, a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the above. In the present invention, a computer-readable storage medium may be any tangible medium containing or storing a program that can be used by or in combination with an instruction execution system, device or device.
[0089] In the present invention, a computer-readable signal medium may include a data signal propagated in a baseband or as part of a carrier wave, which carries a computer-readable program code. Such propagated data signals may take a variety of forms, including but not limited to electromagnetic signals, optical signals, or any suitable combination of the above. A computer-readable signal medium may also be any computer-readable medium other than a computer-readable storage medium, which may send, propagate, or transmit a program for use by or in conjunction with an instruction execution system, device, or device. The program code contained on the computer-readable medium may be transmitted using any appropriate medium, including but not limited to: wireless, wire, optical cable, RF, etc., or any suitable combination of the above.
[0090] Those skilled in the art will appreciate that embodiments of the present invention may be provided as methods, systems, or computer program products. Therefore, the present invention may take the form of a complete hardware embodiment, a complete software embodiment, or an embodiment combining software and hardware. Moreover, the present invention may take the form of a computer program product implemented on one or more computer-usable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) containing computer-usable program code.
[0091] The present invention is described with reference to flowcharts and / or block diagrams of methods, apparatuses, systems, and computer program products according to embodiments of the present invention. It should be understood that each process and / or block in the flowchart and / or block diagram, as well as a combination of processes and / or blocks in the flowchart and / or block diagram, can be implemented by computer program instructions. These computer program instructions can be provided to a processor of a general-purpose computer, a special-purpose computer, an embedded processor, or other programmable data processing device to generate a machine, so that the instructions executed by the processor of the computer or other programmable data processing device generate instructions for implementing the process in the flowchart. Figure 1 A process or multiple processes and / or boxes Figure 1 A device that provides the functions specified in a block or multiple blocks.
[0092] The foregoing description of specific exemplary embodiments of the present invention is for the purpose of illustration and demonstration. These descriptions are not intended to limit the present invention to the precise form disclosed, and it is clear that many changes and variations can be made based on the above teachings. The purpose of selecting and describing the exemplary embodiments is to explain the specific principles of the present invention and its practical application, so that those skilled in the art can realize and utilize various different exemplary embodiments of the present invention and various different selections and changes. The scope of the present invention is intended to be limited by the claims and their equivalents.
Claims
1. A current loop control device for an AC servo motor, characterized in that: include: A control unit, used for generating a current command and a current PID adjustment parameter, and transmitting the current command and the current PID adjustment parameter to the drive unit via a serial bus; The drive unit is used to receive the current command and current PID adjustment parameters from the control unit, execute the current PID algorithm adjustment in the drive unit, generate the PWM control signal, and feed back the drive current to realize the current loop closed-loop control.
2. The current loop control device according to claim 1, characterized in that: The serial bus protocol of the serial bus includes: Define a data format of a minimum data unit, wherein the data format includes a start bit, a data bit, a check bit, and a stop bit; A data frame structure of a basic information unit of a single communication is defined, wherein the data frame structure includes a control field, a periodic data field, a non-periodic data field and a check field.
3. The current loop control device according to claim 2, characterized in that: include: The periodic data field is used to write all periodically changing data to be transmitted based on a preset fixed position and field length, and the periodically changing data includes instruction id, instruction iq, actual motor position, current feedback data, and actual motor phase; The non-periodic data field is used to write any non-periodic changing data to be transmitted, and the non-periodic changing data includes PWM wave generation frequency, dead time, current loop integral gain, and drive unit error code; The control field is used to write a data tag corresponding to the non-periodically changing data to be transmitted written into the non-periodically changing data field, and the data tag corresponds to the non-periodically changing data to be transmitted one by one; The check field is used to determine whether the data information in the data frame is abnormal.
4. The current loop control device according to claim 1, characterized in that: The control unit and the driving unit perform serial optical communication based on a preset optical module, and the optical module of the control unit and the optical module of the driving unit are correspondingly connected via an optical fiber; The optical module of the control unit is used to convert the current command and the current PID adjustment parameter into an optical signal, and the optical module of the driving unit is used to convert the optical signal emitted by the control unit into the current command and the current PID adjustment parameter.
5. The current loop control device according to claim 1, characterized in that: The driving unit further comprises: A current control module, used for receiving a current command and a current PID adjustment parameter from the control unit, and calculating and generating a PWM control signal based on a current PID algorithm; A rectifier module, used to convert the input AC power into DC power and filter and stabilize the DC power; The inverter module is used to convert the filtered direct current into alternating current based on the PWM control signal generated by the current control module and the preset input voltage and frequency.
6. A current loop control method, characterized in that: include: The control unit generates a current command and a current PID adjustment parameter, and transmits the current command and the current PID adjustment parameter to the drive unit via a serial bus; The drive unit receives the current command and the current PID adjustment parameter from the control unit, performs the current PID algorithm adjustment in the drive unit, generates a PWM control signal, and feeds back the drive current to realize the current loop closed-loop control.
7. The current loop control method according to claim 6, characterized in that: The current command and the current PID adjustment parameter are transmitted to the drive unit via a serial bus, including: Based on the serial bus protocol, the data to be transmitted is packaged into data frames, and the data frames are sent through the data lines of the serial bus; The current control module parses the received data frame based on the serial bus protocol to read information in the data frame.
8. The current loop control method according to claim 6, characterized in that: The method further comprises: Based on the data frame check field, determining whether the data information in the data frame is abnormal; If yes, performing a minimum data unit self-check based on the check bits of each minimum data unit constituting the data frame; The receiving end reports abnormal data information and an alarm signal and discards the data frame.
9. A computer device, characterized in that: include: A memory and a processor, wherein the memory and the processor are communicatively connected to each other, the memory stores computer instructions, and the processor executes the current loop control method according to any one of claims 6 to 8 by executing the computer instructions.
10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores computer instructions, and the computer instructions are used to enable a computer to execute the current loop control method according to any one of claims 6 to 8.
Citation Information
Patent Citations
Multi-processor system-on-chip based multi-shaft servo driving controller
CN109600075A
Closed-loop regulated high-precision super-audio pulse power supply
CN110729914A
Method and system for realizing electrical precise control by using FPGA (Field Programmable Gate Array)
CN115616942A
Intelligent transformation device and method for mechanical door lock and related equipment
CN116220479A
Verification value calculation method and device, equipment and storage medium
CN118509503A
Cited By
Synchronous motor system, control method and machine tool
CN121770393A
