Motor drive control circuit for servo driver

Abstract

The utility model discloses a motor driving control circuit for a servo driver, which relates to the technical field of motor driving and comprises a power supply module for supplying power; the protection control module is used for electric energy transmission control; the servo driving module is used for outputting a pulse signal, carrying out inversion work and driving a servo motor connected with the servo motor module to work; and the pulse amplitude detection module is used for detecting whether the pulse signals output by the servo driving module are unequal in amplitude and controlling the protection control module to be powered off when the pulse signals output by the servo driving module are unequal in amplitude, and the fault display module displays the fault. The motor driving control circuit used for the servo driver can complete driving of the servo motor module, performs power-off protection when detecting that pulse signals output by the servo driving module have unequal amplitudes, improves the safety of the driving control circuit, displays the fault position of the servo driving module through the fault display module, and improves the reliability of the driving control circuit. And maintenance by related personnel is facilitated.

Description

Technical Field

[0001] The utility model relates to the technical field of motor drive, in particular to a motor drive control circuit for a servo driver. Background Art

[0002] A servo drive is an electronic device used to control the movement of a servo motor. The servo drive in the prior art is generally composed of a microcontroller, an inverter, etc. The microcontroller provides four sets of PWM (Pulse-Width Modulation) signals with the same pulse amplitude and pulse width, and the pulse signal then drives the inverter to work, and then drives the servo motor. However, the four sets of PWM signals generated by the microcontroller are easily affected by external interference, such as electromagnetic interference, which causes the output PWM signal to deviate. At this time, the servo drive cannot be stopped in time, resulting in abnormal movement of the servo motor. There are certain safety hazards, so it needs to be improved. Utility Model Content

[0003] The embodiment of the utility model provides a motor drive control circuit for a servo drive to solve the problems raised in the above background technology.

[0004] In order to achieve the above purpose, the utility model provides the following technical solutions:

[0005] A motor drive control circuit for a servo driver, comprising: a power supply module, a protection control module, a servo drive module, a servo motor module, a pulse amplitude detection module and a fault display module;

[0006] A power module, used for receiving AC power and performing rectification and filtering on the AC power to output first power;

[0007] a protection control module, connected to the power supply module, the servo drive module and the pulse amplitude detection module, and configured to transmit the first electric energy to the servo drive module, and stop transmitting the first electric energy upon receiving the first control signal or the second control signal output by the pulse amplitude detection module;

[0008] A servo drive module, used for outputting a first pulse signal, a second pulse signal, a third pulse signal and a fourth pulse signal and performing inversion processing on the first electric energy input, and outputting driving electric energy;

[0009] A servo motor module, connected to the servo drive module, and used to transmit the received drive signal to the connected servo motor;

[0010] a pulse amplitude detection module connected to the servo drive module, configured to rectify the first pulse signal and the fourth pulse signal and output a first processing signal, rectify the second pulse signal and the third pulse signal and output a second processing signal, and output a first control signal when the voltage of the first processing signal is greater than the voltage of the second processing signal, and output a second control signal when the second processing signal is greater than the first processing signal;

[0011] A fault display module is connected to the servo drive module and the pulse amplitude detection module, and is used to rectify the received first pulse signal and the fourth pulse signal, and to display a fault when the first control signal or the second control signal is received and the first pulse signal is received, and to display a fault when the first control signal or the second control signal is received and the fourth pulse signal is received.

[0012] As a further solution of the utility model: the power supply module includes a power supply access port, a first rectifier and a first capacitor; the protection control module includes a first resistor, a first field effect tube and a first switch tube;

[0013] Preferably, the first end and the second end of the power access port are respectively connected to the first end and the second end of the first rectifier, the third end of the first rectifier is connected to one end of the first capacitor and the drain of the first field effect tube and connected to the gate of the first field effect tube and the collector of the first switching tube through the first resistor, the fourth end of the first rectifier is connected to the other end of the first capacitor and the emitter of the first switching tube, the source of the first field effect tube is connected to the servo drive module, and the base of the first switching tube is connected to the fault display module.

[0014] As a further solution of the utility model: the servo drive module includes a servo driver, a first power tube, a second power tube, a third power tube and a fourth power tube; the servo motor module includes a servo motor interface;

[0015] Preferably, the first end, the second end, the third end and the fourth end of the servo driver are respectively connected to the gate of the first power tube, the gate of the second power tube, the gate of the third power tube and the gate of the fourth power tube, the collector of the first power tube is connected to the collector of the third power tube and the source of the first field effect tube, the emitter of the first power tube is connected to one end of the servo motor interface and the collector of the fourth power tube, the emitter of the third power tube is connected to the other end of the servo motor interface and the collector of the second power tube, and the emitter of the fourth power tube is connected to the emitter of the second power tube and the emitter of the first switching tube.

[0016] As a further solution of the utility model: the pulse amplitude detection module includes a fourth diode, a fifth diode, a sixth diode, a seventh diode, a first comparator, a first voltage source, a second voltage source, a second resistor, a first diode and a first inverter;

[0017] Preferably, the anode of the fourth diode, the anode of the fifth diode, the anode of the sixth diode and the anode of the seventh diode are respectively connected to the gate of the first power tube, the gate of the third power tube, the gate of the fourth power tube and the gate of the second power tube, the cathode of the fourth diode is connected to the cathode of the fifth diode and the in-phase end of the first comparator, the cathode of the sixth diode is connected to the cathode of the seventh diode and the inverting end of the first comparator, the first power supply end and the second power supply end of the first comparator are respectively connected to the first voltage source and the second voltage source, the output end of the first comparator is connected to the input end of the first inverter and is connected to the anode of the first diode through the second resistor, and the cathode of the first diode is connected to the output end of the first inverter and the base of the first switching tube.

[0018] As a further solution of the utility model: the fault display module includes a third diode, a first logic chip, a third resistor and a first indicator light;

[0019] Preferably, the anode of the third diode is connected to the gate of the first power tube, the cathode of the third diode is connected to the A end of the first logic chip, the B end of the first logic chip is connected to the cathode of the first diode, the F end of the first logic chip is connected to the anode of the first indicator light through the third resistor, and the cathode of the first indicator light is grounded.

[0020] As a further solution of the utility model: the fault display module also includes a second diode, a second logic chip, a fourth resistor and a second indicator light;

[0021] Preferably, the anode of the second diode is connected to the gate of the fourth power tube, the cathode of the second diode is connected to the B end of the second logic chip, the A end of the second logic chip is connected to the cathode of the first diode, the F end of the second logic chip is connected to the anode of the second indicator light through the fourth resistor, and the cathode of the second indicator light is grounded.

[0022] Compared with the prior art, the beneficial effects of the utility model are as follows: the motor drive control circuit of the utility model for the servo driver can complete the drive control of the servo motor module by the servo drive module, and the pulse amplitude detection module detects whether the pulse signal output by the servo drive module has unequal amplitudes, and when the pulse signal has unequal amplitudes, the control protection control module performs power-off protection, thereby improving the safety of the drive control circuit, and at the same time, the fault display module displays the fault location of the servo drive module, which is convenient for relevant personnel to carry out maintenance. BRIEF DESCRIPTION OF THE DRAWINGS

[0023] In order to more clearly illustrate the technical solutions of the embodiments of the utility model, the drawings required for use in the description of the embodiments of the utility model will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the utility model. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.

[0024] Figure 1 The present invention provides a schematic block diagram of a motor drive control circuit for a servo drive.

[0025] Figure 2 A circuit diagram of a motor drive control circuit for a servo drive provided in an example of the utility model.

[0026] Figure 3 A connection circuit diagram of a fault display module provided for an example of the utility model. DETAILED DESCRIPTION

[0027] The following will be combined with the drawings in the embodiments of the utility model to clearly and completely describe the technical solutions in the embodiments of the utility model. Obviously, the described embodiments are only part of the embodiments of the utility model, not all of the embodiments. Based on the embodiments in the utility model, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the utility model.

[0028] In one embodiment, see Figure 1 , a motor drive control circuit for a servo drive, comprising: a power supply module 1, a protection control module 2, a servo drive module 3, a servo motor module 4, a pulse amplitude detection module 5 and a fault display module 6;

[0029] Specifically, the power module 1 is used to receive AC power and perform rectification and filtering on the AC power to output first power;

[0030] a protection control module 2, connected to the power supply module 1, the servo drive module 3 and the pulse amplitude detection module 5, for transmitting the first electric energy to the servo drive module 3, and stopping the transmission of the first electric energy upon receiving the first control signal or the second control signal output by the pulse amplitude detection module 5;

[0031] The servo drive module 3 is used to output a first pulse signal, a second pulse signal, a third pulse signal and a fourth pulse signal and to invert the first electric energy received to output drive electric energy;

[0032] A servo motor module 4, connected to the servo drive module 3, and used for transmitting the received drive signal to the connected servo motor;

[0033] a pulse amplitude detection module 5, connected to the servo drive module 3, for rectifying the first pulse signal and the fourth pulse signal and outputting a first processing signal, rectifying the second pulse signal and the third pulse signal and outputting a second processing signal, and outputting a first control signal when the voltage of the first processing signal is greater than the voltage of the second processing signal, and outputting a second control signal when the second processing signal is greater than the first processing signal;

[0034] The fault display module 6 is connected to the servo drive module 3 and the pulse amplitude detection module 5, and is used for rectifying the received first pulse signal and the fourth pulse signal, and performing a fault display when the first control signal or the second control signal is received and the first pulse signal is received, and performing a fault display when the first control signal or the second control signal is received and the fourth pulse signal is received.

[0035] In a specific embodiment, the power supply module 1 can adopt a power supply circuit composed of a power access port, a rectifier and a capacitor, can access AC power and perform rectification and filtering on the AC power; the protection control module 2 can adopt a protection control circuit composed of a power tube, a triode and a resistor, and can control the transmission state of the power; the servo drive module 3 can adopt a servo drive circuit composed of a servo driver and a power tube, the servo driver provides four groups of pulse signals, and performs inversion processing on the power transmitted by the protection control module 2; the servo motor module 4 can adopt a servo motor circuit composed of a servo motor interface, connected to the power supply end of the servo motor, and driven by the servo drive module 3; the pulse amplitude detection module 5 can adopt a pulse amplitude detection circuit composed of a diode, a comparator, a voltage source, an inverter, etc., can rectify the pulse signal output by the servo drive module 3, and determine whether the pulse signal has unequal pulse amplitudes; the fault display module 6 can adopt a fault display circuit composed of a diode, a logic chip, an indicator light, etc., and when the pulse signal has unequal pulse amplitudes, the fault is displayed according to the driving state of the servo drive module 3.

[0036] In another embodiment, see Figure 1 , Figure 2 and Figure 3 The power module 1 includes a power access port, a first rectifier T1 and a first capacitor C1; the protection control module 2 includes a first resistor R1, a first field effect transistor G1 and a first switch tube V1;

[0037] Specifically, the first end and the second end of the power access port are respectively connected to the first end and the second end of the first rectifier T1, the third end of the first rectifier T1 is connected to one end of the first capacitor C1 and the drain of the first field effect tube G1 and connected to the gate of the first field effect tube G1 and the collector of the first switch tube V1 through the first resistor R1, the fourth end of the first rectifier T1 is connected to the other end of the first capacitor C1 and the emitter of the first switch tube V1, the source of the first field effect tube G1 is connected to the servo drive module 3, and the base of the first switch tube V1 is connected to the fault display module 6.

[0038] In a specific embodiment, the first field effect transistor G1 may be an N-channel field effect transistor; and the first switch transistor V1 may be an NPN transistor.

[0039] Further, the servo drive module 3 includes a servo driver, a first power tube Q1, a second power tube Q2, a third power tube Q3 and a fourth power tube Q4; the servo motor module 4 includes a servo motor interface;

[0040] Specifically, the first end, the second end, the third end and the fourth end of the servo driver are respectively connected to the gate of the first power tube Q1, the gate of the second power tube Q2, the gate of the third power tube Q3 and the gate of the fourth power tube Q4, the collector of the first power tube Q1 is connected to the collector of the third power tube Q3 and the source of the first field effect tube G1, the emitter of the first power tube Q1 is connected to one end of the servo motor interface and the collector of the fourth power tube Q4, the emitter of the third power tube Q3 is connected to the other end of the servo motor interface and the collector of the second power tube Q2, and the emitter of the fourth power tube Q4 is connected to the emitter of the second power tube Q2 and the emitter of the first switching tube V1.

[0041] In a specific embodiment, the servo driver may be composed of an STM32 single-chip microcomputer and a drive circuit composed of IR2110, the STM32 single-chip microcomputer provides four sets of PWM signals, and the drive circuit provides the driving capability of the PWM signals; the first power tube Q1, the second power tube Q2, the third power tube Q3 and the fourth power tube Q4 may all be IGBTs.

[0042] Further, the pulse amplitude detection module 5 includes a fourth diode D4, a fifth diode D5, a sixth diode D6, a seventh diode D7, a first comparator A1, a first voltage source VCC1, a second voltage source VCC2, a second resistor R2, a first diode D1 and a first inverter INV1;

[0043] Specifically, the anode of the fourth diode D4, the anode of the fifth diode D5, the anode of the sixth diode D6 and the anode of the seventh diode D7 are respectively connected to the gate of the first power tube Q1, the gate of the third power tube Q3, the gate of the fourth power tube Q4 and the gate of the second power tube Q2, the cathode of the fourth diode D4 is connected to the cathode of the fifth diode D5 and the non-inverting end of the first comparator A1, the cathode of the sixth diode D6 is connected to the cathode of the seventh diode D7 and the inverting end of the first comparator A1, the first power supply end and the second power supply end of the first comparator A1 are respectively connected to the first voltage source VCC1 and the second voltage source VCC2, the output end of the first comparator A1 is connected to the input end of the first inverter INV1 and is connected to the anode of the first diode D1 through the second resistor R2, and the cathode of the first diode D1 is connected to the output end of the first inverter INV1 and the base of the first switch tube V1.

[0044] In a specific embodiment, the first comparator A1 may be a LM393 comparator; the first voltage source VCC1 may be a +12V voltage, the second voltage source VCC2 may be a -12V voltage; and the first inverter INV1 may be a NOT gate chip.

[0045] Further, the fault display module 6 includes a third diode D3, a first logic chip J1, a third resistor R3 and a first indicator LED1;

[0046] Specifically, the anode of the third diode D3 is connected to the gate of the first power tube Q1, the cathode of the third diode D3 is connected to the A end of the first logic chip J1, the B end of the first logic chip J1 is connected to the cathode of the first diode D1, the F end of the first logic chip J1 is connected to the anode of the first indicator light LED1 through the third resistor R3, and the cathode of the first indicator light LED1 is grounded.

[0047] In a specific embodiment, the first logic chip J1 may be an AND gate chip; the first indicator light LED1 may be an LED lamp.

[0048] Furthermore, the fault display module 6 also includes a second diode D2, a second logic chip J2, a fourth resistor R4 and a second indicator LED2;

[0049] Specifically, the anode of the second diode D2 is connected to the gate of the fourth power tube Q4, the cathode of the second diode D2 is connected to the B end of the second logic chip J2, the A end of the second logic chip J2 is connected to the cathode of the first diode D1, the F end of the second logic chip J2 is connected to the anode of the second indicator light LED2 through the fourth resistor R4, and the cathode of the second indicator light LED2 is grounded.

[0050] In a specific embodiment, the second logic chip J2 may be an AND gate chip; the second indicator light LED2 may be an LED lamp.

[0051] In a motor drive control circuit for a servo drive of the present embodiment, AC power is connected to a power access port, a first rectifier T1 and a first capacitor C1 perform rectification and filtering processing, a first field effect tube G1 is triggered to conduct through a first resistor R1, and the power after rectification and filtering processing is transmitted, a first pulse signal, a second pulse signal, a third pulse signal and a fourth pulse signal are respectively output from a first end, a second end, a third end and a fourth end of the servo drive device, and the conduction states of the first power tube Q1, the second power tube Q2, the third power tube Q3 and the fourth power tube Q4 are respectively driven, specifically, in the positive half cycle of the driving power after inversion, the first pulse signal and the second pulse signal are simultaneously output, and in the negative half cycle of the driving power, the third pulse signal and the fourth pulse signal are simultaneously output, a fourth diode D4, a fifth diode D5, a sixth diode D6 and a seventh diode D7 perform rectification processing on the signals input to the first power tube Q1, the third power tube Q3, the fourth power tube Q4 and the second power tube Q2, respectively, when the voltage of the signal input to the first power tube Q1 is greater than that of the signal input to the second When the voltage of the signal input to the first power tube Q1 is less than the voltage of the signal input to the second power tube Q2, the first comparator A1 outputs a high level, triggering the first switch tube V1 to turn on. When the voltage of the signal input to the first power tube Q1 is less than the voltage of the signal input to the second power tube Q2, the first comparator A1 outputs a low level, which is inverted by the first inverter INV1 to trigger the first switch tube V1 to turn on. At this time, it is indicated that the pulse amplitudes of the first pulse signal and the second pulse signal are not equal. Similarly, when the pulse amplitudes of the signal input to the third power tube Q3 and the signal input to the fourth power tube Q4 are not equal, the first switch tube V1 will also be triggered to turn on. The first switch tube V1 will control the first power tube Q1 to be turned off for power-off protection. At the same time, if the pulse amplitudes are not equal when the first power tube Q1 is working, the first indicator LED1 is lit, indicating that the signal input to the first power tube Q1 or the second power tube Q2 is abnormal. When the pulse amplitudes are not equal when the fourth power tube Q4 is working, the second indicator LED2 is lit, indicating that the signal input to the third power tube Q3 or the fourth power tube Q4 is abnormal.

[0052] It is obvious to those skilled in the art that the present invention is not limited to the details of the exemplary embodiments described above, and that the present invention can be implemented in other specific forms without departing from the spirit or essential features of the present invention. Therefore, the embodiments should be regarded as exemplary and non-restrictive from any point of view, and the scope of the present invention is defined by the appended claims rather than the above description, and it is intended that all changes falling within the meaning and scope of the equivalent elements of the claims be included in the present invention. Any reference numeral in a claim should not be regarded as limiting the claim to which it relates.

[0053] In addition, it should be understood that although the present specification is described according to implementation modes, not every implementation mode contains only one independent technical solution. This description of the specification is only for the sake of clarity. Those skilled in the art should regard the specification as a whole. The technical solutions in each embodiment may also be appropriately combined to form other implementation modes that can be understood by those skilled in the art.

Claims

1. A motor drive control circuit for a servo drive, characterized in that: The motor drive control circuit for the servo drive comprises: a power supply module, a protection control module, a servo drive module, a servo motor module, a pulse amplitude detection module and a fault display module; The power module is used to receive AC power and perform rectification and filtering on the AC power to output the first power; The protection control module is connected to the power supply module, the servo drive module and the pulse amplitude detection module, and is used to transmit the first electric energy to the servo drive module, and stop transmitting the first electric energy when receiving the first control signal or the second control signal output by the pulse amplitude detection module; The servo drive module is used to output a first pulse signal, a second pulse signal, a third pulse signal and a fourth pulse signal and to invert the first electric energy received to output drive electric energy; The servo motor module is connected to the servo drive module and is used to transmit the received drive signal to the connected servo motor; The pulse amplitude detection module is connected to the servo drive module, and is used to rectify the first pulse signal and the fourth pulse signal and output a first processing signal, rectify the second pulse signal and the third pulse signal and output a second processing signal, and output a first control signal when the voltage of the first processing signal is greater than the voltage of the second processing signal, and output a second control signal when the second processing signal is greater than the first processing signal; The fault display module is connected to the servo drive module and the pulse amplitude detection module, and is used to rectify the received first pulse signal and the fourth pulse signal, and to display a fault when the first control signal or the second control signal is received and the first pulse signal is received, and to display a fault when the first control signal or the second control signal is received and the fourth pulse signal is received.

2. A motor drive control circuit for a servo drive according to claim 1, characterized in that: The power supply module includes a power access port, a first rectifier and a first capacitor; the protection control module includes a first resistor, a first field effect tube and a first switch tube; The first end and the second end of the power access port are respectively connected to the first end and the second end of the first rectifier, the third end of the first rectifier is connected to one end of the first capacitor and the drain of the first field effect tube and is connected to the gate of the first field effect tube and the collector of the first switch tube through the first resistor, the fourth end of the first rectifier is connected to the other end of the first capacitor and the emitter of the first switch tube, the source of the first field effect tube is connected to the servo drive module, and the base of the first switch tube is connected to the fault display module.

3. A motor drive control circuit for a servo drive according to claim 2, characterized in that: The servo drive module includes a servo driver, a first power tube, a second power tube, a third power tube and a fourth power tube; the servo motor module includes a servo motor interface; The first end, the second end, the third end and the fourth end of the servo driver are respectively connected to the gate of the first power tube, the gate of the second power tube, the gate of the third power tube and the gate of the fourth power tube, the collector of the first power tube is connected to the collector of the third power tube and the source of the first field effect tube, the emitter of the first power tube is connected to one end of the servo motor interface and the collector of the fourth power tube, the emitter of the third power tube is connected to the other end of the servo motor interface and the collector of the second power tube, and the emitter of the fourth power tube is connected to the emitter of the second power tube and the emitter of the first switching tube.

4. A motor drive control circuit for a servo drive according to claim 3, characterized in that: The pulse amplitude detection module includes a fourth diode, a fifth diode, a sixth diode, a seventh diode, a first comparator, a first voltage source, a second voltage source, a second resistor, a first diode and a first inverter; The anodes of the fourth diode, the fifth diode, the sixth diode and the seventh diode are connected to the gates of the first power tube, the third power tube, the fourth power tube and the second power tube respectively, the cathode of the fourth diode is connected to the cathode of the fifth diode and the non-inverting end of the first comparator, the cathode of the sixth diode is connected to the cathode of the seventh diode and the inverting end of the first comparator, the first power supply end and the second power supply end of the first comparator are connected to the first voltage source and the second voltage source respectively, the output end of the first comparator is connected to the input end of the first inverter and connected to the anode of the first diode through the second resistor, and the cathode of the first diode is connected to the output end of the first inverter and the base of the first switch tube.

5. A motor drive control circuit for a servo drive according to claim 4, characterized in that: The fault display module includes a third diode, a first logic chip, a third resistor and a first indicator light; The anode of the third diode is connected to the gate of the first power tube, the cathode of the third diode is connected to the A end of the first logic chip, the B end of the first logic chip is connected to the cathode of the first diode, the F end of the first logic chip is connected to the anode of the first indicator light through the third resistor, and the cathode of the first indicator light is grounded.

6. A motor drive control circuit for a servo drive according to claim 5, characterized in that: The fault display module also includes a second diode, a second logic chip, a fourth resistor and a second indicator light; The anode of the second diode is connected to the gate of the fourth power tube, the cathode of the second diode is connected to the B end of the second logic chip, the A end of the second logic chip is connected to the cathode of the first diode, the F end of the second logic chip is connected to the anode of the second indicator light through the fourth resistor, and the cathode of the second indicator light is grounded.

Images