Control device
The control device uses hardware and software thresholds to adaptively detect short circuits in unipolar motors, improving detection accuracy and preventing motor burnout by setting a second threshold based on motor type and operating conditions.
Patent Information
- Application Number
- JP2023082582
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-05-18
- Publication Date
- 2024-11-28
AI Technical Summary
Conventional methods for detecting short circuits in unipolar motors are inadequate as they rely on fixed threshold values that may not accurately detect short-circuit currents due to varying motor types and operating states, leading to potential motor burnout or false alarms.
A control device with a current detection unit that sets a first threshold via hardware and a second threshold via software, allowing for adaptive detection of short circuits in switching elements by comparing the detected current against these thresholds, and includes mechanisms to verify the duration and context of current deviations.
Enhances the accuracy of short circuit detection in unipolar motors, preventing motor burnout and reducing false alarms while simplifying the device configuration and reducing manufacturing complexity.
Smart Images

Figure 2024165961000001_ABST
Abstract
Description
[Technical field]
[0001] The present invention relates to a control device. [Background technology]
[0002] Patent Document 1 discloses a technique for driving a unipolar motor. Patent Document 2 discloses a technique for detecting a short circuit in a switching element that drives a motor. The conventional technique disclosed in Patent Document 2 stops the motor when a current detected by a current detection unit exceeds a predetermined value, assuming that an overcurrent has flowed (see, for example, FIG. 1 in Patent Document 2). [Prior art documents] [Patent documents]
[0003] [Patent Document 1] Patent No. 4652017 [Patent Document 2] JP 2014-143782 A Summary of the Invention [Problem to be solved by the invention]
[0004] Here, in the conventional technology, the current may be compared with a threshold value that is a predetermined value (fixed value) set in the hardware configuration. In this case, depending on the type and operating state of the unipolar motor, when the switching element is short-circuited, the short-circuit current flowing through the motor coil may not be detected. That is, in a unipolar motor, one switching element is connected to a motor coil corresponding to one phase, so the short-circuit current may flow through the motor coil and become a relatively small value due to the resistance component of the motor coil. Such a short-circuit current may not be detected by a threshold value that is set assuming a circuit in which a large short-circuit current flows without passing through the motor coil, such as a short circuit of a switching element in a bridge circuit for a bipolar motor, or a short circuit of a cable connecting a motor and a control device, or a burnout of the motor. In addition, since the value of the detected short-circuit current changes depending on the type and operating state of the motor, simply setting the threshold value to a small value may erroneously detect a short circuit even when no short circuit has occurred. As described above, the conventional technology has room for improvement in detecting a short circuit of a switching element that drives a motor.
[0005] The present invention has been made in consideration of the above-mentioned problems, and an object of the present invention is to provide a control device that can detect a short circuit in a switching element regardless of the type of motor. [Means for solving the problem]
[0006] In order to achieve the above object, the control device disclosed herein includes a current detection unit that detects the current flowing through each of a plurality of switching elements that drive a unipolar motor, a first threshold setting unit that sets, by hardware configuration, a first threshold for detecting an overcurrent state by comparing the first threshold with a detected current that is the current detected by the current detection unit, a second threshold setting unit that sets, by software configuration, a second threshold having a different value from the first threshold, and a short circuit detection unit that detects the occurrence of a short circuit in the plurality of switching elements depending on the comparison result between the second threshold and the detected current.
[0007] According to the present disclosure, a short circuit in a switching element can be detected regardless of the type of motor. [Brief description of the drawings]
[0008] [Figure 1] FIG. 2 is a diagram illustrating a configuration of a control device according to the first embodiment of the present disclosure. [Diagram 2] 4 is a diagram for explaining a configuration of an overcurrent detection unit; FIG. [Diagram 3] 4 is a diagram for explaining a function of an overcurrent detection unit; FIG. [Figure 4] 4 is a diagram for explaining a function of an A-phase current converter; FIG. [Diagram 5] 4 is a diagram for explaining the configuration of an A-phase current converter. FIG. [Figure 6] FIG. 2 is a diagram showing functional blocks of a cutoff command generating unit. [Figure 7] 4 is a diagram for explaining a function of a current command conversion unit; FIG. [Figure 8] FIG. 4 is a diagram illustrating functional blocks of an overcurrent comparator. [Figure 9] 10A and 10B are diagrams for explaining a current that flows when a switching element is short-circuited. [Figure 10] 10A and 10B are diagrams for explaining a current that flows when a switching element is short-circuited. [Figure 11] 10 is a diagram for explaining a current that flows normally when a switching element is not short-circuited. FIG. [Figure 12] 10A and 10B are diagrams for explaining a current that flows when a switching element is short-circuited. [Figure 13] 4 is a flowchart illustrating the operation of the control device according to the first embodiment. [Figure 14] 5 is a diagram for explaining the relationship between a threshold value and a change in current during operation of the control device according to the first embodiment. FIG. [Figure 15] FIG. 11 is a diagram illustrating a configuration of a control device according to a second embodiment of the present disclosure. [Figure 16]FIG. 11 is a diagram illustrating an example of a functional configuration of a cutoff command generating unit according to a second embodiment. [Figure 17] FIG. 4 illustrates an example of the configuration of a servo-off overcurrent monitoring unit; [Figure 18] 10 is a flowchart illustrating the operation of the control device according to the second embodiment. [Figure 19] 13 is a diagram for explaining the relationship between a change in current during operation of the control device according to the second embodiment and a threshold value. FIG. [Figure 20] FIG. 13 is a diagram illustrating a configuration of a control device according to a third embodiment of the present disclosure. [Figure 21] FIG. 13 is a diagram illustrating an example of a functional configuration of a cutoff command generating unit according to a third embodiment. [Figure 22] FIG. 4 illustrates an example of the configuration of a current command response deviation monitoring unit; [Figure 23] 13 is a flowchart illustrating the operation of the control device according to the third embodiment. [Figure 24] 13 is a diagram for explaining the relationship between a change in current and a threshold value while the control device according to the third embodiment is in operation. FIG. [Diagram 25] 10A and 10B are diagrams for explaining a current that flows when a switching element is short-circuited. [Figure 26] 10A and 10B are diagrams for explaining a current that flows when a switching element is short-circuited. [Figure 27] FIG. 13 is a diagram illustrating a configuration of a control device according to a fourth embodiment of the present disclosure. [Figure 28] FIG. 13 is a diagram illustrating an example of a functional configuration of a cutoff command generating unit according to a fourth embodiment. [Figure 29] FIG. 4 illustrates an example of the configuration of a power comparison unit; [Diagram 30] 13 is a first flowchart illustrating the operation of the control device according to the fourth embodiment. [Diagram 31] 13 is a second flowchart illustrating the operation of the control device according to the fourth embodiment. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0009] Hereinafter, one embodiment of the present invention will be described.
[0010] (First embodiment) 1 is a diagram showing the configuration of a control device according to a first embodiment of the present disclosure. The control device 100-1 is a device that controls the rotation of a motor 200 using electric power from a driving source 300.
[0011] The driving source 300 may be interpreted as a DC power supply provided outside the control device 100-1. The motor 200 may be interpreted as a unipolar motor. Specifically, the motor 200 may be interpreted as a two-phase stepping motor having two pairs of bifilar-wound coils.
[0012] One of the pair of coils may be interpreted as the A-phase coil and the / A-phase (Abar-phase) coil. The other of the pair of coils may be interpreted as the B-phase coil and the / B-phase coil. The A-phase coil and the / A-phase coil, and the B-phase coil and the / B-phase coil may be interpreted as motor coils 201, which are windings of the motor 200.
[0013] In this embodiment, in order to simplify the explanation, the explanation of the function of controlling the current flowing through coils other than the A-phase coil and the / A-phase coil will be omitted.
[0014] The control device 100-1 includes a drive source cutoff unit 1, an A-phase current control unit 2, an A-phase driving FET (Field Effect Transistor) 3, a / A-phase driving FET 4, a current detection unit 5, an overcurrent detection unit 6, an A-phase current conversion unit 7, and a cutoff command generation unit 8-1.
[0015] When the driving-source cutoff unit 1 receives a driving-source cutoff command output from the cutoff command generation unit 8-1, it cuts off the connection between the driving source 300 and the motor 200. Specifically, when the driving-source cutoff unit 1 does not receive a driving-source cutoff command, it maintains the electrical connection between the driving source 300 and the motor 200 to continue the supply of power from the driving source 300 to the motor 200. When the driving-source cutoff unit 1 receives a driving-source cutoff command, it immediately cuts off the electrical connection between the driving source 300 and the motor 200 to stop the supply of power from the driving source 300 to the motor 200. The configuration of the cutoff command generation unit 8-1 will be described in detail later.
[0016] The A-phase current control unit 2 generates commands to drive the A-phase drive FET 3 and the / A-phase drive FET 4. Specifically, the A-phase current control unit 2 generates an A-phase drive command which is a command to drive the A-phase drive FET 3 so that the A-phase current response from the A-phase current conversion unit 7 follows the A-phase current command from the cutoff command generation unit 8-1, and inputs the command to the A-phase drive FET 3. The A-phase drive command may be interpreted as a signal indicating a high-level or low-level value. Similarly, the A-phase current control unit 2 generates a / A-phase drive command which is a command to drive the / A-phase drive FET 4, and inputs the command to the / A-phase drive FET 4.
[0017] The A-phase drive FET 3 may be considered as a switching element that drives the motor 200. The A-phase drive FET 3 may be considered as a transistor having a drain connected to the A-phase coil, a source connected to the A-phase current detection unit 51, and a gate connected to the A-phase current control unit 2. The A-phase drive FET 3 controls the current flowing through the A-phase coil based on the A-phase drive command.
[0018] When the A-phase drive FET 3 is short-circuited, the A-phase drive FET 3 is constantly in a conducting state, i.e., in an on state, regardless of the presence or absence of an A-phase drive command, i.e., regardless of whether the A-phase drive command indicates a high level value or a low level value.
[0019] The / A-phase drive FET 4 may be considered as a switching element that drives the motor 200. The / A-phase drive FET 4 may be considered as a transistor having a drain connected to the / A-phase coil, a source connected to the / A-phase current detection unit 52, and a gate connected to the / A-phase current control unit 2. The / A-phase drive FET 4 controls the current flowing through the / A-phase coil based on the / A-phase drive command.
[0020] Like the A-phase drive FET 3, when the / A-phase drive FET 4 is shorted, the / A-phase drive FET 4 is turned on regardless of the presence or absence of a / A-phase drive command.
[0021] Although the control device 100-1 uses a FET, the control device 100-1 may use a transistor other than a FET.
[0022] The current detection unit 5 detects the current flowing through each of a plurality of switching elements that drive the motor 200, and generates a voltage corresponding to the detected current, which is the detected current.
[0023] Specifically, the current detection unit 5 includes an A-phase current detection unit 51 and a / A-phase current detection unit 52. The A-phase current detection unit 51 detects the current flowing through the A-phase drive FET 3, and inputs a voltage equivalent to the detected current to the A-phase current conversion unit 7 and the overcurrent detection unit 6. The A-phase current detection unit 51 may be considered as a shunt resistor with a small resistance value for detecting the current flowing through the A-phase drive FET 3.
[0024] The / A phase current detection unit 52 detects the current flowing through the / A phase drive FET 4, and inputs a voltage equivalent to the detected current to the A phase current conversion unit 7 and the overcurrent detection unit 6. The / A phase current detection unit 52 may be considered as a shunt resistor with a small resistance value for detecting the current flowing through the / A phase drive FET 4.
[0025] The overcurrent detection unit 6 compares the current detected by the current detection unit 5 with a first threshold value, which is a threshold value set in the hardware configuration, and outputs an overcurrent detection signal if the current exceeds the first threshold value. The configuration of the overcurrent detection unit 6 will be described with reference to Figs. 2 and 3.
[0026] 2 is a diagram for explaining the configuration of the overcurrent detection unit 6. As shown in FIG. 2, the overcurrent detection unit 6 includes a comparator 61 and a first threshold setting unit 62.
[0027] The first threshold setting unit 62 may be interpreted as a voltage dividing circuit including resistors R1 and R2 connected in series. The first threshold setting unit 62 divides the power supply voltage and applies the first threshold, which is the divided voltage, to the positive input terminal of the comparator 61. The first threshold may be interpreted as a threshold set in a hardware configuration to detect a short circuit in a cable (not shown) connecting the motor 200 and the control device 100-1 and a layer short (burnout) in the motor 200.
[0028] The positive input terminal of comparator 61 receives as input the first threshold value set by first threshold value setting unit 62. The negative input terminal of comparator 61 receives as input a voltage equivalent to the current detected by current detection unit 5. The voltage input to the negative input terminal of comparator 61 will be specifically described with reference to FIG.
[0029] Fig. 3 is a diagram for explaining the function of the overcurrent detection unit. On the left side of Fig. 3, a graph is shown in which the horizontal axis indicates the A-phase detection current response or the / A-phase detection current response, and the vertical axis indicates the corresponding voltage. The A-phase detection current response may be interpreted as a voltage equivalent to the current detected by the A-phase current detection unit 51 shown in Fig. 1. The / A-phase detection current response may be interpreted as a voltage equivalent to the current detected by the / A-phase current detection unit 52 shown in Fig. 1. The negative input terminal of the comparator 61 receives an absolute value of a current obtained by adding together the A-phase detection current response and the / A-phase detection current response.
[0030] 3 shows a graph with the horizontal axis representing the A-phase current response, which is a current obtained by adding together the A-phase detection current response and the / A-phase detection current response, and the vertical axis representing a voltage corresponding to the A-phase current response. Comparator 61 compares the A-phase current response thus added together with a first threshold value to determine whether or not the current detected by current detection unit 5 exceeds the first threshold value. If the current does not exceed the first threshold value, comparator 61 outputs a low-level signal. If the current exceeds the first threshold value, comparator 61 outputs an overcurrent detection signal, which is a high-level signal.
[0031] 1, the A-phase current converter 7 receives an input of a voltage equivalent to the current detected by the current detector 5, and generates an A-phase current response. The function of the A-phase current converter 7 will be specifically described with reference to FIG.
[0032] Fig. 4 is a diagram for explaining the function of the A-phase current converter. The left side of Fig. 4 shows a graph in which the horizontal axis represents the A-phase detection current response or / A-phase detection current response, and the vertical axis represents the corresponding voltage. The right side of Fig. 4 shows a graph in which the horizontal axis represents the A-phase current response, and the vertical axis represents the voltage corresponding to the A-phase current response.
[0033] As shown in Fig. 4, the A-phase current converter 7 offsets the voltages corresponding to the A-phase detected current response and the / A-phase detected current response in the vertical direction using the zero portions of these current responses as a center voltage for AD (Analog to Digital) conversion. The center voltage is, for example, 1.65V. The A-phase current converter 7 generates the A-phase current response such that the A-phase detected current is on the positive side with respect to the center voltage, and the / A-phase detected current is on the negative side with respect to the center voltage. The configuration of the A-phase current converter 7 will be specifically described with reference to Fig. 5.
[0034] FIG. 5 is a diagram for explaining the configuration of the A-phase current conversion unit. As shown in FIG. 5, the A-phase current conversion unit 7 includes, for example, an operational amplifier 71. The positive input terminal of the operational amplifier 71 receives a voltage corresponding to the current detected by the A-phase current detection unit 51, and the negative input terminal of the operational amplifier 71 receives a voltage corresponding to the current detected by the / A-phase current detection unit 52. The operational amplifier 71 outputs the A-phase current response as zero when the voltages of the A phase and the / A phase are offset, that is, when the absolute values of the A-phase response current and the / A-phase response current are equal, with the zero portion of these voltages being the center voltage (for example, 1.65 V described above) of the AD conversion. The operational amplifier 71 outputs the A-phase current response which is the difference between the A-phase detection current response and the / A-phase detection current response. However, the A-phase current conversion unit 7 is not limited to one including the operational amplifier 71, and may be a current sensor that outputs the difference between the A-phase detection current response and the / A-phase detection current response as the A-phase current response, or one that calculates with software.
[0035] Returning to Fig. 1, the cutoff command generating unit 8-1 generates a drive source cutoff command based on the overcurrent detection signal and the A-phase current response. The configuration of the cutoff command generating unit 8-1 will be specifically described with reference to Fig. 6.
[0036] 6 is a diagram showing functional blocks of the cutoff command generation unit 8-1. The cutoff command generation unit 8-1 includes a speed control unit 10, a current command conversion unit 11, an A-phase current command operation unit 12, a B-phase current command operation unit 13, an A-phase current recognition unit 14, a B-phase current recognition unit 15, an overcurrent comparison unit 16, an overcurrent detection signal recognition unit 17, an overcurrent signal processing unit 18, an error reporting unit 19, and a drive source cutoff operation unit 20.
[0037] The speed control unit 10 generates a current command so that the speed response obtained based on a signal from an encoder (not shown) attached to the motor 200 follows the speed command. The current command conversion unit 11 generates an A-phase current command and a B-phase current command from the current command by vector control. FIG. 7 is a diagram for explaining the function of the current command conversion unit. FIG. 7 shows a graph in which the horizontal axis represents the A-phase current command and the vertical axis represents the B-phase current command. The current command conversion unit 11 performs rotational coordinate conversion on the current command to generate an A-phase current command and a B-phase current command by dividing the current command into an A-phase and a B-phase whose phase is 90° different from the phase of the A-phase.
[0038] Returning to FIG. 6, the A-phase current command operation unit 12 converts the A-phase current command in the form of a digital value from the current command conversion unit 11 into an analog value using a DA (Digital to Analog) converter.
[0039] The B-phase current command operation unit 13 converts the B-phase current command, which is a digital value from the current command conversion unit 11, into an analog value using a DA converter.
[0040] The A-phase current recognition unit 14 converts the A-phase current response in analog value into a digital value using an AD converter. The B-phase current recognition unit 15 converts the B-phase current response in analog value into a digital value using an AD converter.
[0041] When an excessive current is detected, the overcurrent comparator 16 issues an error notification. Fig. 8 is a diagram showing functional blocks of the overcurrent comparator 16. The overcurrent comparator 16 includes a second threshold setting unit 21-1, a short circuit detector 22-1, and an error notification unit 23.
[0042] The second threshold setting unit 21-1 sets, by software configuration, a second threshold whose value is different from the first threshold whose value is set by the above-mentioned hardware configuration. The second threshold may be interpreted as a threshold whose value is different from the first threshold.
[0043] Specifically, the second threshold setting unit 21-1 may set the second threshold to the smaller of the upper limit current and the expected current. The upper limit current may be interpreted as a current indicating the upper limit of the current that the current detection unit 5 shown in FIG. 1 can detect. The expected current may be interpreted as a current that is expected to flow through the motor 200 based on the winding resistance and power supply voltage of the motor 200. Specifically, when the expected current is I, the drive voltage is V [V], and the winding resistance of the motor 200 is R [Ω], the expected current may be interpreted as a current calculated by I=V÷R. The value of the winding resistance of the motor 200 may be interpreted as a specification value (nominal value), and may be interpreted as a value that takes into account the cable resistance, a tolerance of ±10%, and the like, rather than the specification value (nominal value) itself. Therefore, the second threshold setting unit 21-1 stores the upper limit current, and also stores the value of the winding resistance and the value of the power supply voltage that are determined depending on the type of the motor 200. Then, the second threshold setting unit 21-1 calculates an estimated current according to the type of the motor 200 connected to the control device 100-1, based on the stored values of the winding resistance and the power supply voltage.
[0044] Here, the reason for selecting the smaller of the upper limit current and the expected current is as follows. That is, although details regarding the current when a short circuit occurs will be described later, even if a short circuit occurs in the A-phase drive FET 3 or the like and a current flows, a relatively small current may flow depending on the value of the winding resistance, and the current may not exceed the upper limit current determined by the detection capability (circuit configuration) of the current detection unit 5. Therefore, a short circuit may not be detected by simply setting the upper limit current as the second threshold. Also, depending on the value of the winding resistance of the motor 200, the expected current may be relatively larger than the upper limit current, and a short circuit may not be detected by simply setting only the expected current as the second threshold. Therefore, by selecting the smaller of the upper limit current and the expected current as the second threshold, a short circuit can be detected more accurately.
[0045] When the detected current exceeds a second threshold set to the smaller of the upper limit current and the expected current, the short circuit detection unit 22-1 detects a short circuit and inputs detection information indicating the detection of a short circuit to the error notification unit 23. The short circuit detection unit 22-1 may be interpreted as a short circuit detection unit that detects a short circuit in a plurality of switching elements according to a comparison result between the second threshold and the detected current.
[0046] When the error notification unit 23 receives the detection information, it inputs an error notification indicating that an excessive current has been detected to the error reporting unit 19 shown in FIG.
[0047] Returning to Fig. 6, the overcurrent detection signal recognition unit 17 recognizes the state of the overcurrent detection signal from the overcurrent detection unit 6 shown in Fig. 1. Specifically, the overcurrent detection signal recognition unit 17 recognizes whether the overcurrent detection signal from the overcurrent detection unit 6 is at a low level or a high level. When the overcurrent detection signal is at a high level, the overcurrent detection signal recognition unit 17 generates an overcurrent detection signal of a digital value indicating that the current detected by the current detection unit 5 shown in Fig. 1 is excessive, that is, indicating that the current has exceeded the first threshold value set in the hardware configuration described above.
[0048] When the overcurrent detection signal is input from the overcurrent detection signal recognition unit 17, the overcurrent signal processing unit 18 inputs an error notification indicating that an excessive current has been detected to the error reporting unit 19.
[0049] The error reporting unit 19 issues an error report when it receives an error report from either the overcurrent comparing unit 16 or the overcurrent signal processing unit 18. Specifically, the error reporting unit 19 generates a command to cut off the driving source 300 shown in Fig. 1 and inputs it to the driving source cutoff operation unit 20. When the error reporting unit 19 does not receive an error report, it stops generating the command.
[0050] When the driving source cutoff operation unit 20 receives a command from the error reporting unit 19, the driving source cutoff operation unit 20 generates a driving source cutoff command and inputs it to the driving source cutoff unit 1 shown in FIG.
[0051] Next, the operation of the control device according to the first embodiment will be described with reference to Fig. 9 to Fig. 14. Fig. 9, Fig. 10, Fig. 12, Fig. 13, and Fig. 14 are diagrams for explaining the current that flows when a switching element is short-circuited. Fig. 11 is a diagram for explaining the current that flows normally when the switching element is not short-circuited.
[0052] (Bipolar type: normal) The switching elements connected to the bipolar motor are shown in the upper part of Fig. 9. In the bipolar motor, at least four switching elements are used as a bridge circuit for the bipolar motor, and multiple switching elements are connected to one motor coil.
[0053] In the bridge circuit, for example, a first switching element pair of an A-phase high side drive FET and an / A-phase low side drive FET and a second switching element pair of an / A-phase high side drive FET and an A-phase low side drive FET repeatedly perform on-off operations in a complementary manner. Note that the configuration example of the bridge circuit is just one example, and a circuit other than the bridge circuit may be applied to a bipolar motor.
[0054] As a result, current flows alternately in the A-phase coil in a specific direction and in a direction opposite to the specific direction. The arrows represent current flowing in a specific direction. Specifically, when the first switching element pair is turned on and the second switching element pair is turned off, current flows in the A-phase coil in a specific direction. The current is approximately equal to a value determined based on the winding resistance of the A-phase coil and the power supply voltage.
[0055] (Bipolar type: short circuit) The lower part of FIG. 9 shows a current that flows when the A-phase low-side driving FET is normal but the A-phase high-side driving FET is short-circuited. When the A-phase low-side driving FET is turned on with the A-phase high-side driving FET short-circuited, the A-phase high-side driving FET and the A-phase low-side driving FET are in a conductive state. In this case, the current from the driving source 300 flows through a path with an impedance lower than the impedance of the A-phase coil, that is, the A-phase high-side driving FET and the A-phase low-side driving FET. This current is not attenuated by the winding resistance of the A-phase coil, so it has a larger value than the current shown in the upper part of FIG. 9. This current can be detected by a first threshold value set in the overcurrent detection unit 6 shown in FIG. 1, that is, a threshold value set in the hardware configuration assuming a short circuit of the cable connecting the motor 200 and the control device 100-1 or burnout of the motor 200.
[0056] In addition, when the A-phase low-side driver FET is short-circuited instead of the A-phase high-side driver FET, a similar current is detected when the A-phase high-side driver FET is turned on.
[0057] FIG. 9 has been used to explain the current that flows when a bipolar motor is driven. Below, the current that flows when a unipolar motor 200 is driven will be explained with reference to FIGS. 10 to 14.
[0058] (Unipolar type: A-phase drive FET on / off operation, and / A-phase drive FET off) The upper part of FIG. 10 shows switching elements connected to a unipolar motor. In a unipolar motor, one switching element is connected to one motor coil. Specifically, an A-phase drive FET 3 is connected to the A-phase coil, and a / A-phase drive FET 4 is connected to the / A-phase coil. The arrows represent the current flowing through the A-phase coil when the / A-phase drive FET 4 is in the off state and the A-phase drive FET 3 performs on-off operation without shorting. The current flows only in a specific direction with respect to the A-phase coil. The state of the current will be described in detail with reference to FIG. 11.
[0059] The upper part of Fig. 11 shows the A-phase current, / A-phase current, and A-phase current command that flow when the A-phase drive FET 3 shown in the upper part of Fig. 10 is turned on and off. The vertical axis represents current, and the horizontal axis represents time. The A-phase current command is shown by a thick solid line, the A-phase current is shown by a normal solid line, and the / A-phase current is shown by a dotted line. The lower part of Fig. 11 shows the state of the A-phase drive FET 3 and the state of the / A-phase drive FET 4.
[0060] At time t1, when the / A-phase drive FET 4 is in the off state and the A-phase drive FET 3 changes from off to on, the A-phase current begins to increase with the A-phase current command as the target value. The A-phase current can be interpreted as the A-phase current response. The A-phase current rises slowly because its flow is impeded by the inductance component of the A-phase coil. Note that the / A-phase drive FET 4 remains in the off state, so the / A-phase current is 0 [A].
[0061] When the A-phase current reaches the A-phase current command at time t2, a certain time after time t1, the A-phase drive FET 3 starts switching operation, that is, on / off operation, so that the A-phase current maintains the current specified by the A-phase current command.
[0062] When the A-phase current command decreases at time t3, a certain time after time t2, the A-phase drive FET3 stops switching and turns off. The A-phase coil tries to maintain the current flow due to the back electromotive force of the A-phase coil and the impedance of the switching element, so the A-phase current gradually decreases.
[0063] When the A-phase current falls below the A-phase current command at time t4 after a certain time has elapsed from time t3, the A-phase drive FET 3 resumes switching operation so as to maintain the A-phase current defined by the A-phase current command.
[0064] When the A-phase current command changes further in the direction to become smaller at time t5, which is a fixed time after time t4, the A-phase drive FET 3 stops switching operation.
[0065] (Unipolar type: A-phase drive FET shorted and / A-phase drive FET off) Returning to Fig. 10, the lower part of Fig. 10 shows the current that flows when the A-phase drive FET 3 is short-circuited during on-off operation. In this case, the A-phase coil is grounded via the A-phase drive FET 3, so the current that flows through the A-phase coil is smaller than the current shown in the lower part of Fig. 9 described above, that is, the current that flows without passing through the A-phase coil. This is because the current attenuates due to the winding resistance of the motor 200, that is, the resistance component of the A-phase coil. The state of this current will be described in detail with reference to Fig. 12.
[0066] The upper part of Fig. 12 shows the A-phase current, / A-phase current, and A-phase current command that flow before and after the A-phase drive FET 3 shown in the lower part of Fig. 10 is short-circuited. The vertical axis represents current, and the horizontal axis represents time. The A-phase current command is shown by a thick solid line, the A-phase current is shown by a normal solid line, and the / A-phase current is shown by a dotted line. The lower part of Fig. 12 shows the state of the A-phase drive FET 3 and the state of the / A-phase drive FET 4.
[0067] The operation from time t1 to time t4 is similar to the operation from time t1 to time t4 described with reference to FIG.
[0068] If the A-phase drive FET 3 is shorted at time t4' after a certain time has elapsed from time t4, the A-phase coil is grounded and current flows through the A-phase coil. The current flowing through the A-phase coil starts to increase gradually from time t4' and saturates when it reaches a specific value. The specific value may be interpreted as being approximately equal to a value determined based on the winding resistance of the A-phase coil and the power supply voltage.
[0069] As mentioned above, this current has a relatively small value, and the saturation value can vary depending on the type of motor 200, the winding resistance value of the A-phase coil, the operating state of motor 200, etc., so it may be difficult to detect using a single first threshold value that is set in the hardware configuration in anticipation of a cable short circuit or burnout of motor 200.
[0070] To address this issue, if the hardware configuration is reset depending on the type of motor 200, the manufacture of control device 100-1 may be delayed. Furthermore, if a configuration is adopted in which multiple first thresholds are set and a specific first threshold is selected depending on the type of motor 200, the configuration of control device 100-1 becomes complex, and the yield of control device 100-1 may decrease.
[0071] In contrast, by using the second threshold set in the second threshold setting unit 21-1 shown in FIG. 8, that is, the threshold set by a software configuration, the second threshold can be easily set without complicating the circuit configuration, and short circuits that are difficult to detect using the first threshold can be detected.
[0072] Fig. 13 is a flowchart for explaining the operation of the control device according to the first embodiment. Fig. 14 is a diagram for explaining the relationship between a change in current and a threshold value while the control device according to the first embodiment is operating.
[0073] When the overcurrent comparator 16 receives the current response (step S11), it determines whether the current response exceeds the second threshold (step S12). The current response may be interpreted as an A-phase current response, which is the difference between the A-phase detection current response and the / A-phase detection current response. FIG. 14 shows a graph with the horizontal axis representing time and the vertical axis representing current, i.e., the A-phase current response. FIG. 14 shows the current response before it exceeds the second threshold and a state in which the current response that exceeds the second threshold continues for a specific time T (e.g., 200 ms).
[0074] If the current response exceeds the second threshold (step S12: YES), the overcurrent comparator 16 increments the software overcurrent monitoring counter (step S13), regardless of whether the current response exceeds the first threshold.
[0075] The overcurrent comparator 16 determines whether the software overcurrent monitoring counter is equal to or greater than a specified value (step S14). Specifically, the overcurrent comparator 16 determines whether the duration of the current response exceeding the second threshold value exceeds a specific time T (e.g., 200 ms) which is a specified value.
[0076] In step S14, if the software overcurrent monitoring counter is equal to or greater than the specified value (step S14: YES), the overcurrent comparator 16 issues an error notification (step S15) and ends the series of processes. In other words, if the state in which the current response exceeds the second threshold continues for the specific time T, the overcurrent comparator 16 detects a short circuit and issues an error notification.
[0077] If the software overcurrent monitoring counter is not equal to or greater than the specified value (step S14: NO), the overcurrent comparator 16 does not issue an error notification, and repeats the processes from step S11 onwards.
[0078] In step S12, if the current response does not exceed the second threshold (step S12: NO), the overcurrent comparator 16 clears the software overcurrent monitoring counter (step S16), and repeats the processes from step S11 onwards.
[0079] In addition, the second threshold value set by the software configuration may be preset in the control device 100-1 as multiple values corresponding to the type of motor 200, etc., and the second threshold value may be selected when the control device 100-1 is used, and a short circuit may be detected based on the selected second threshold value.
[0080] (Action and effect) As described above, according to the control device 100-1 of the first embodiment, by utilizing the second threshold value set by the software configuration, it is possible to detect a short circuit that is difficult to detect using the first threshold value, which is a hardware threshold value.
[0081] Moreover, according to the control device 100-1, it is not necessary to have a complex configuration in which a plurality of hardware thresholds corresponding to the type of the motor 200 are set in advance and the hardware configuration in which each hardware threshold is set is switched. Specifically, it is not necessary to have a configuration in which a hardware configuration corresponding to each of a first motor including a motor coil having a first resistance value and a second motor including a motor coil having a second resistance value different from the first resistance value is switched. Therefore, the configuration of the control device 100-1 is simplified, and the yield of the control device 100-1 can be improved. In addition, after a specific hardware threshold is set, it is possible to change the software threshold to correspond to various motors 200 without changing the setting, so that it is easy to change the specifications of the control device 100-1, and the operation cost of the control device 100-1 can be reduced.
[0082] In addition, according to the control device 100-1, by determining whether the duration of the current response exceeding the second threshold value exceeds a specific time T, which is a prescribed value, it is possible to prevent erroneous detection of the occurrence of a short circuit even if an overcurrent state occurs suddenly due to fluctuations in the power supplied from the driving source 300, fluctuations in the load on the motor 200, etc.
[0083] In addition, the control device 100-1 improves the accuracy of detecting short circuits in switching elements compared to when only a hardware threshold is set, thereby preventing the motor 200 from burning out due to current continuing to flow through the motor 200 in a short-circuited state.
[0084] Second embodiment The second embodiment has a basic configuration similar to that of the first embodiment, and therefore differences will be described below. The same reference numerals as those in the first embodiment indicate the same configuration, and the preceding description will be referred to.
[0085] Fig. 15 is a diagram showing the configuration of a control device according to a second embodiment of the present disclosure. The difference from the first embodiment is that a control device 100-2 according to the second embodiment includes a cutoff command generating unit 8-2 that inputs a position information signal and a servo command from an encoder 202, instead of the cutoff command generating unit 8-1 shown in Fig. 1. The encoder 202 may be interpreted as a photoelectric encoder, a capacitive encoder, or a magnetic encoder that detects the amount of rotation, the direction of rotation, and the like of the motor 200 as position information and outputs the detected position information as an electric signal.
[0086] Fig. 16 is a diagram showing an example of the functional configuration of a shutoff command generating unit according to the second embodiment. The difference from the first embodiment is that the shutoff command generating unit 8-2 according to the second embodiment includes a servo-off overcurrent monitoring unit 31, a position response recognizing unit 32, a speed response generating unit 33, a servo command recognizing unit 34, and a servo control determining unit 35, instead of the overcurrent comparing unit 16 shown in Fig. 6.
[0087] In FIG. 16, the speed control unit 10, the current command conversion unit 11, the A-phase current command operation unit 12, and the B-phase current command operation unit 13 in FIG. 6 are omitted, but the interruption command generation unit 8-2 may be provided with these functions.
[0088] The position response recognition unit 32 generates a position response, which is position information indicating the amount of rotation of the motor 200, based on the position information signal from the encoder 202.
[0089] The speed response generating unit 33 generates a speed response, which is the rotation speed of the motor 200, based on the amount of change in the position response per unit time.
[0090] The servo command recognition unit 34 acquires a servo command transmitted from a higher-level system as a servo command input. The servo command may include a servo-on command that permits the motor 200 to be driven, a servo-off command that prohibits the motor 200 from being driven, and the like.
[0091] The servo control determination unit 35 notifies the servo state according to the servo command input from the servo command recognition unit 34, the power supply state from the driving source 300, the presence or absence of an error notification, etc. The servo state may include a state in which driving of the motor 200 is permitted or prohibited.
[0092] The servo-off overcurrent monitoring unit 31 can detect a short circuit in the A-phase driving FET 3 or the / A-phase driving FET 4, which may allow current to flow to the motor 200 despite the servo-off state, and can issue an error notification. Specifically, the servo-off overcurrent monitoring unit 31 can issue an error notification when the speed response is equal to or less than the speed specification value and the current response exceeds the monitoring threshold value for servo-off in the servo-off state.
[0093] The servo-off state may be interpreted as a state in which driving of the motor 200 is prohibited, and as a state in which the A-phase drive command and the / A-phase drive command are off.
[0094] Specifically, the specified speed value may be construed as 90 rpm. Note that the specified speed value may be set to a value other than 90 rpm depending on the type, application, etc. of the motor 200.
[0095] The case where the current response exceeds the monitoring threshold during servo-off may be interpreted as a state where a current response exceeding the rated current is detected. The monitoring threshold during servo-off may be interpreted as a second threshold set to the rated current.
[0096] The rated current may be interpreted as a current value that can be continuously passed through the motor coil 201. Specifically, the rated current may be interpreted as a current value when a unipolar motor, a bipolar motor, or other motors (e.g., an induction motor, a synchronous motor) are operated at a rated voltage and a rated output. The second threshold is not limited to the rated current, and may be any value in the range of 0 or more and less than the rated current. In other words, the second threshold in the second embodiment may be interpreted as any value in the range of 0 or more and less than the rated current.
[0097] 17 is a diagram showing a configuration example of a servo-off overcurrent monitoring unit 31. The difference from the first embodiment is that the servo-off overcurrent monitoring unit 31 includes a second threshold setting unit 21-2 and a short circuit detection unit 22-2 instead of the second threshold setting unit 21-1 and the short circuit detection unit 22-1 shown in FIG.
[0098] The second threshold setting unit 21-2 sets, in a software configuration, a second threshold that is different in value from the first threshold set in the hardware configuration described above. The second threshold may be interpreted as a threshold whose value is smaller than the first threshold. Specifically, the second threshold setting unit 21-2 may set the rated current determined according to the type of the motor 200 as the second threshold.
[0099] The short circuit detection unit 22-2 may detect a short circuit when the detected current exceeds the second threshold under a specific condition. The specific condition may be interpreted as a state in which driving of the motor 200 is prohibited and the speed response of the motor 200 is equal to or lower than a specified value. When the short circuit detection unit 22-2 detects a short circuit, it inputs detection information indicating that a short circuit has been detected to the error notification unit 23.
[0100] Fig. 18 is a flowchart for explaining the operation of the control device according to the second embodiment. Fig. 19 is a diagram for explaining the relationship between the threshold value and a change in current during the operation of the control device according to the second embodiment.
[0101] When the servo-off overcurrent monitor 31 receives the servo state notification, the current response, and the speed response (step S21), it determines whether the servo state is the servo-off state and whether the speed response is equal to or lower than the specified speed value (step S22).
[0102] 19 shows a graph with the horizontal axis representing time and the vertical axis representing the rotation speed of the motor 200, i.e., the speed response, on the left side of the figure. In this graph, a servo-off command is sent from the upper system, and the speed response of the motor 200 changes to a speed specification value or less at a specific time ta. The speed specification value is, for example, 90 [rpm].
[0103] Returning to FIG. 18, in step S22, if the servo is off and the speed response is not equal to or lower than the specified speed value (step S22: NO), the servo-off overcurrent monitoring unit 31 executes the processes in and after step S21.
[0104] When the servo state is the servo-off state and the speed response is equal to or less than the specified speed value (step S22: YES), the servo-off overcurrent monitor 31 judges whether the current response exceeds the second threshold value (step S23). On the right side of Fig. 19, a graph is shown with the horizontal axis representing time and the vertical axis representing current, that is, the A-phase current response. In this graph, the current response less than the second threshold value, which is the rated current, exceeds the second threshold value at time tb, a certain time after the aforementioned time ta.
[0105] 18, if the current response exceeds the second threshold (step S23: YES), the servo-off overcurrent monitoring unit 31 issues an error notification (step S24) and ends the series of processes. If the current response does not exceed the second threshold (step S23: NO), the servo-off overcurrent monitoring unit 31 executes the processes from step S21 onwards.
[0106] Generally, during the deceleration of the motor 200, a current flows in the motor 200 due to the influence of an induced voltage. Therefore, in the second embodiment, by only determining whether or not the current response exceeds the second threshold, there is a risk of erroneously detecting that a short circuit has occurred when a short circuit has not occurred. That is, there is a possibility that a current flows due to the influence of an induced voltage generated by the deceleration of the motor 200 during servo-on. Therefore, by performing the process of step S22 and determining that the motor 200 is in a servo-off state (a state in which there is no current command and the motor 200 is not being driven) and that the motor 200 is rotating at a speed where the influence of the induced voltage is relatively small, it is possible to avoid erroneously detecting a short circuit in the switching element due to the response current flowing due to the induced voltage of the motor 200. Then, by performing the process of step S22 and then the process of step S23, it is possible to detect a short circuit in the switching element because a large current flows in the switching element even in a situation in which the motor 200 is not being driven and the current flowing due to the influence of the induced voltage is small.
[0107] (Action and effect) As described above, according to the control device 100-2 of the second embodiment, when, for example, a transition is made from a servo-on state to a servo-off state, it is possible to detect that the state is servo-off and that the speed response is equal to or less than a specified speed value, thereby suppressing erroneous detection of a short circuit due to the influence of an induced voltage, while detecting a current that would not normally flow through the switching element, thereby detecting a short circuit in the switching element.
[0108] Third embodiment The third embodiment has a basic configuration similar to that of the second embodiment, and therefore differences will be described below. The same reference numerals as those in the second embodiment indicate the same configuration, and the preceding description will be referred to.
[0109] Fig. 20 is a diagram showing the configuration of a control device according to a third embodiment of the present disclosure. The difference from the second embodiment is that a control device 100-3 according to the third embodiment includes a cutoff command generating unit 8-3 instead of the cutoff command generating unit 8-2 shown in Fig. 15. The current detecting unit 5 according to the third embodiment detects, for each phase of the motor 200, the difference between the current flowing through the corresponding switching element and the current of the opposite phase as the detected current.
[0110] 21 is a diagram showing an example of the functional configuration of a shutoff command generating unit according to the third embodiment. The difference from the second embodiment is that the shutoff command generating unit 8-3 according to the third embodiment includes a current command response deviation monitoring unit 36 instead of the servo-off overcurrent monitoring unit 31, the servo command recognizing unit 34, and the servo control determining unit 35 shown in FIG.
[0111] The current command response deviation monitoring unit 36 may execute an error notification when it recognizes that the detected current, which is the current response, is less than the second threshold, which is the zero current determination value, even though the current command is greater than the current specification value, based on the A-phase current response, the B-phase current response, the speed response, the A-phase current command, and the B-phase current command. Specifically, when the detected current falls below the second threshold while the servo is on and the current command is greater than the current specification value, the current command response deviation monitoring unit 36 may detect a short circuit of the switching element and execute an error notification. Whether the servo is on can be determined by the value of the current response. Whether the speed is low can be determined by the value of the speed response.
[0112] The current specification value may be set to a sufficiently large value so that the current response does not drop to near zero due to current ripples. Specifically, ripples (fluctuations) occur in the current flowing through the motor coil due to switching of the drive FETs for each phase for driving the motor 200. This can cause the current response to drop to near zero. Therefore, the reason why the current specification value is set to a sufficiently large value as described above is to prevent the current response from dropping to near zero due to the influence of the ripples (fluctuations) of the current response caused by the switching of the drive FETs for each phase when comparing the current response with a zero current determination value described below, and thus preventing the current response from becoming less than the zero current determination value.
[0113] For example, the specified current value may be set to a value obtained by adding 5% of the rated current to a value obtained by multiplying the ripple current by two (ripple current x 2 + rated current x 0.05).
[0114] The ripple current may be interpreted as an approximate current value when the power supply voltage is applied for half the switching period, for example. The current command response deviation monitor 36 may hold data on the ripple current calculated for each motor type. Note that the ripple current may take into consideration a current ripple that occurs when the inductance of the coil changes due to mutual induction between the coils of each phase depending on the positional relationship between the rotor and stator in the motor.
[0115] The second threshold value, which is the zero current determination value, may be interpreted as a threshold value that is set to a current that is a specific value lower than the rated current determined according to the type of motor 200.
[0116] The current command response deviation monitor 36 may detect a short circuit when the state in which the detected current is below the second threshold continues for a specific time period, which may be, for example, 200 ms.
[0117] 22 is a diagram showing a configuration example of a current command response deviation monitoring unit 36. The difference from the second embodiment is that the current command response deviation monitoring unit 36 includes a second threshold setting unit 21-3 and a short circuit detection unit 22-3 instead of the second threshold setting unit 21-2 and the short circuit detection unit 22-2 shown in FIG.
[0118] The second threshold setting unit 21-3 sets, in a software configuration, a second threshold having a different value from the first threshold set in the hardware configuration described above. The second threshold may be interpreted as a threshold having a smaller value than the first threshold. Specifically, when the first threshold corresponds to the rated current, the second threshold setting unit 21-3 may set, as the second threshold, a threshold set to a current lower than the rated current determined according to the type of the motor 200 by a specific value. The specific value may be interpreted as the rated current×0.9, that is, a current equivalent to 90% of the rated current. The current lower than the rated current by a specific value may be interpreted as the rated current×0.1, that is, a current equivalent to 10% of the rated current.
[0119] The short circuit detection unit 22-3 may detect a short circuit when the detected current falls below the second threshold value while the servo is on and the current command is greater than a specified value. When the short circuit detection unit 22-3 detects a short circuit, it inputs detection information indicating that a short circuit has been detected to the error notification unit 23.
[0120] Fig. 23 is a flowchart for explaining the operation of the control device according to the third embodiment. Fig. 24 is a diagram for explaining the relationship between the threshold value and a change in current during the operation of the control device according to the third embodiment.
[0121] When the current command response deviation monitor 36 receives the speed response and the current response (step S31), it determines whether the speed response is equal to or lower than a specified speed value and whether the current command exceeds a specified current value (step S32).
[0122] 24 shows a graph with the horizontal axis representing time and the vertical axis representing the speed response of motor 200. In this graph, an operation command is transmitted from a higher-level system, and at time tc, the speed response of motor 200 changes to a value equal to or less than the specified speed value.
[0123] A graph with time on the horizontal axis and current on the vertical axis is shown on the right side of Fig. 24. In this graph, the current command is larger than the specified current value, and the current response changes to less than the second threshold at time td, a certain time after the above-mentioned time tc.
[0124] 23, if the speed response is equal to or less than the speed specified value and the current command exceeds the current specified value (step S32: YES), the current command response deviation monitor 36 determines whether the current response is less than a second threshold value, which is a zero current determination value (step S33). By making this determination, a current command exceeding the current specified value is output, and therefore, when the motor 200 is rotating in the servo-on state, a current response that has fallen below the second threshold value can be detected.
[0125] If the current response is less than the second threshold (step S33: YES), the zero current counter is incremented (step S34).
[0126] The current command response deviation monitoring unit 36 determines whether the zero current counter is equal to or greater than a specified value (step S35). Specifically, the current command response deviation monitoring unit 36 determines whether the duration during which the current response is less than the zero current determination value exceeds a specific time T (e.g., 200 ms), which is a specified value.
[0127] If the zero current counter is equal to or greater than the specified value (step S35: YES), the current command response deviation monitor 36 issues an error notification (step S36) and ends the series of processes. That is, the current command response deviation monitor 36 issues an error notification when it recognizes that the current response less than the zero current judgment value continues for a certain period of time even though the current command is greater than the specified value.
[0128] If the zero current counter is not equal to or greater than the specified value (step S35: NO), the current command response deviation monitor 36 does not issue an error notification, and repeats the processes from step S31 onwards.
[0129] In step S32, if the speed response is not below the speed specified value or the current command does not exceed the current specified value (step S32: NO), the current command response deviation monitoring unit 36 clears the zero current counter (step S37) and repeats the processing from step S31 onwards.
[0130] In step S33, if the current response is not less than the second threshold (step S33: NO), that is, if the current response exceeds the zero current determination value, the current command response deviation monitoring unit 36 clears the zero current counter (step S37) and repeats the processing from step S31 onwards.
[0131] 10 described above, a case where the A-phase drive FET, which performs on / off operation while the / A-phase drive FET is off, is short-circuited, but it is also possible to detect a short circuit when the / A-phase drive FET is short-circuited while the A-phase drive FET is on / off. A specific example will be described below with reference to FIGS. 25 and 26.
[0132] (Unipolar type: A-phase drive FET on / off operation and / A-phase drive FET short circuit) 25 and 26 are diagrams for explaining the current that flows when a switching element is short-circuited. Fig. 25 shows the current that flows when the / A-phase drive FET, which was fixed off, is short-circuited while the A-phase drive FET is in on-off operation. In this case, current can flow through both the A-phase coil and the / A-phase coil. The current that flows through each coil is smaller than the current that flows without passing through each coil due to the winding resistance of the motor 200, that is, the resistance component of the A-phase coil or the / A-phase coil. The state of this current will be described in detail with reference to Fig. 26.
[0133] The upper part of Fig. 26 shows the A-phase current, / A-phase current, and A-phase current command that flow before and after the / A-phase drive FET 4 shown in Fig. 25 is short-circuited. The vertical axis represents current, and the horizontal axis represents time. The A-phase current command is shown by a thick solid line, the / A-phase current is shown by a normal solid line, and the / A-phase current is shown by a dotted line. The lower part of Fig. 26 shows the state of the A-phase drive FET 3 and the state of the / A-phase drive FET 4.
[0134] The operation from time t1 to time t4 is similar to the operation from time t1 to time t4 described with reference to FIG.
[0135] When the / A phase drive FET 4, which had been fixed off until then, is short-circuited at time t4' after a certain time has elapsed since time t4, the / A phase coil is grounded, and a current flows through the / A phase coil. In addition, since the A phase current response is the difference between the A phase current and the / A phase current, the A phase current response, which was equal to the A phase current before the short circuit, does not follow the A phase current command due to the influence of the current flowing through the / A phase coil. Therefore, in order to make the A phase current response follow the A phase current command, the A phase drive FET 3 is turned on, and a current flows through both coils. When current flows through both coils, the inductance components of the coils are cancelled out, and the current flowing through the A phase coil rises rapidly from time t4' and saturates when it reaches a specific value. The specific value may be interpreted as a value approximately equal to a value determined based on the winding resistance and power supply voltage of the A phase coil.
[0136] The current flowing through the / A-phase coil drops rapidly from time t4' as the inductance components of the two coils are cancelled out, and saturates when it reaches a specific value, which may be interpreted as being approximately equal to a value determined based on the winding resistance of the / A-phase coil and the power supply voltage.
[0137] The A-phase current response, which is expressed by the difference between these currents after the short circuit occurs, becomes a value significantly lower than the A-phase current command, as shown by the dashed line. Specifically, the A-phase current response is significantly lower than the A-phase current response detected before the short circuit occurs, and is approximately 0 [A]. When the short circuit shown in FIG. 26 occurs and current flows in both a specific phase and its reverse phase, the current response of the specific phase becomes a very small value near zero, making it difficult to detect with the above-mentioned hardware configuration. However, by using the zero current judgment threshold as the second threshold, it is possible to detect a short circuit that is difficult to detect with the first threshold. In addition, the short circuit that can be detected by setting the zero current judgment threshold as the second threshold is not limited to the short circuit shown in FIG. 26, and also includes, for example, a case where both the A-phase drive FET 3 and the / A-phase drive FET 4 are short-circuited. This is because the current response of the specific phase can become near zero even when both the drive FET of the specific phase and the drive FET of the reverse phase are short-circuited.
[0138] The reason why the A-phase drive FET 3 continues to be on after time t4' is that the A-phase current response is smaller than the A-phase current command at time t4', so the A-phase current control unit 2 continues to keep the A-phase drive FET 3 on so that the A-phase current response reaches the A-phase current command.
[0139] (Action and effect) As described above, the control device 100-3 according to the third embodiment can detect a short circuit in a switching element by detecting that the current response is near zero (less than the second threshold value=zero current determination value) even though the current command is larger than the specified current value. In other words, the control device 100-3 can detect a short-circuit state of a switching element in which current flows through both the A-phase coil and the / A-phase coil (i.e., when both the A-phase driving FET 3 and the / A-phase driving FET 4 are short-circuited, or when one is short-circuited and the other is on).
[0140] In addition, according to the control device 100-3, by determining whether the duration of the state in which the current response is less than the second threshold value exceeds a specific time T, which is a prescribed value, it is possible to prevent erroneous detection of the occurrence of a short circuit even if a low current state occurs suddenly due to fluctuations in the power supplied from the driving source 300, fluctuations in the load on the motor 200, etc.
[0141] (Fourth embodiment) The fourth embodiment has a basic configuration similar to that of the first embodiment, and therefore differences will be described below. The same reference numerals as those in the first embodiment indicate the same configuration, and the preceding description will be referred to.
[0142] Fig. 27 is a diagram showing the configuration of a control device according to a fourth embodiment of the present disclosure. The difference from the first embodiment is that a control device 100-4 according to the fourth embodiment includes a cutoff command generating unit 8-4 instead of the cutoff command generating unit 8-1 shown in Fig. 1, and further includes a drive source current detecting unit 9.
[0143] The driving source current detection unit 9 detects the current supplied from the driving source 300 to the motor 200, and inputs the detected driving source current to the cutoff command generation unit 8-4. The driving source current may be interpreted as the amount of current consumed by the motor 200.
[0144] The cutoff command generating unit 8-4 generates a drive-source cutoff command based on the drive-source current, the A-phase current response, and the overcurrent detection signal. The configuration of the cutoff command generating unit 8-4 will be specifically described with reference to Fig. 28.
[0145] Fig. 28 is a diagram showing an example of the functional configuration of a shutoff command generating unit according to the fourth embodiment. The difference from the first embodiment is that the shutoff command generating unit 8-4 according to the fourth embodiment includes a drive source current recognizing unit 37, a drive source power estimating unit 38, a motor command power estimating unit 39, a motor response power estimating unit 40, and a power comparing unit 41 instead of the overcurrent comparing unit 16 shown in Fig. 6.
[0146] Drive source current recognition unit 37 converts the analog value of drive source current using an AD converter into a digital value of drive source current that can be handled by drive source power estimation unit 38, and inputs it to drive source power estimation unit 38. The analog value of drive source current may be interpreted as an analog value of the amount of current consumed by motor 200.
[0147] Based on the driving source current, driving source power estimation unit 38 estimates the power consumed by motor 200. Specifically, based on the current supplied from driving source 300 to motor 200, driving source power estimation unit 38 estimates driving source power, which is the power supplied from driving source 300 to motor 200.
[0148] The motor command power estimating unit 39 estimates the motor command power, which is the power required to drive the motor 200 , based on the current command for the motor 200 from the speed control unit 10 .
[0149] Based on the detected current, the motor response power estimation unit 40 estimates the motor response power, which is the power used to drive the motor 200. Specifically, the motor response power estimation unit 40 takes the A-phase current response from the A-phase current recognition unit 14 and the B-phase current response from the B-phase current recognition unit 15 as the detected currents, and estimates the motor response power based on the detected currents.
[0150] When the power difference between the driving source power estimated by the driving source power estimation unit 38 and the response power estimated by the motor response power estimation unit 40 is equal to or greater than a power threshold, the power comparison unit 41 may detect a short circuit and execute an error notification. The power threshold may be interpreted as a power deviation specified value that specifies a specific deviation width from the driving source power to the response power. When the power difference is equal to or greater than the power threshold, it means that the motor response power is too small compared to the power supplied to the motor 200. In this case, for example, both the A-phase drive FET 3 and the / A-phase drive FET 4 are short-circuited, or one of the A-phase drive FET 3 and the / A-phase drive FET 4 is short-circuited while the other is on, and the response power may be near zero. That is, due to the influence of a short circuit of a switching element, the driving source power consumed by the motor 200 may be large, but the response power may be near zero. Even when the response power is near zero in this way, the power comparison unit 41 can detect a short circuit by determining that the power difference from the response power is equal to or greater than the power threshold.
[0151] The power comparison unit 41 may detect a short circuit and execute an error notification when the power difference between the driving source power estimated by the driving source power estimation unit 38 and the motor command power estimated by the motor command power estimation unit 39 is equal to or greater than a power threshold. The power threshold may be interpreted as a power deviation specified value that specifies a specific deviation width from the driving source power to the motor command power. When the power difference is equal to or greater than the power threshold, it means that the power supplied to the motor 200 is too large compared to the motor command power. For example, in a servo-off state, the command power is zero, but the driving source power consumed by the motor 200 is large due to the effect of a short circuit in the switching element. Therefore, the power comparison unit 41 can detect a short circuit by determining that the power difference from the motor command power is equal to or greater than the power threshold. In addition, when a switching element is short-circuited while the motor 200 is being controlled by a predetermined current command in the servo-on state, a relatively large current flows in response to the current command, and the power consumed by the motor 200 is large. Therefore, the power comparator 41 can detect the short circuit by determining that the power difference with respect to the motor command power is equal to or greater than the power threshold value.
[0152] 29 is a diagram showing an example of the configuration of a power comparison unit. The difference from the first embodiment is that a power comparison unit 41 includes a power threshold setting unit 21-4 and a short circuit detection unit 22-4 instead of the second threshold setting unit 21-1 and the short circuit detection unit 22-1 shown in FIG.
[0153] The power threshold setting unit 21-4 sets, by software configuration, a power threshold whose value is different from the first threshold set by the above-mentioned hardware configuration.
[0154] Specifically, the power threshold setting unit 21-4 may set a power deviation specified value that specifies a specific deviation width from the driving source power to the response power, as the power threshold. Also, the power threshold setting unit 21-4 may set a power deviation specified value that specifies a specific deviation width from the driving source power to the motor command power, as the power threshold.
[0155] The short circuit detection unit 22-4 may detect a short circuit when the power difference between the driving source power estimated by the driving source power estimation unit 38 and the response power estimated by the motor response power estimation unit 40 is equal to or greater than a power threshold. When the short circuit detection unit 22-4 detects a short circuit, it inputs detection information indicating that a short circuit has been detected to the error notification unit 23.
[0156] Furthermore, short circuit detection unit 22-4 may detect a short circuit when a power difference between the driving source power estimated by driving source power estimation unit 38 and the motor command power estimated by motor command power estimation unit 39 is equal to or greater than a power threshold. When short circuit detection unit 22-4 detects a short circuit, it inputs detection information indicating that a short circuit has been detected to error notification unit 23.
[0157] FIG. 30 is a first flowchart for explaining the operation of the control device according to the fourth embodiment.
[0158] When the power comparator 41 receives the driving source power and the response power (step S41), it determines whether or not the power difference between the driving source power and the response power is equal to or greater than a power threshold (step S42).
[0159] If the power difference is equal to or greater than the power threshold (step S42: YES), the power comparator 41 increments the response power mismatch counter (step S43).
[0160] The power comparator 41 determines whether the response power mismatch counter is equal to or greater than a specified value (step S44). Specifically, the power comparator 41 determines whether the time during which the power difference is equal to or greater than the power threshold value exceeds a specific time (e.g., 200 ms) that is a specified value.
[0161] In step S44, if the response power mismatch counter is equal to or greater than the specified value (step S44: YES), the power comparator 41 issues an error notification (step S45) and ends the series of processes. In other words, if the state in which the power difference is equal to or greater than the power threshold continues for a specific time, the power comparator 41 detects a short circuit and issues an error notification.
[0162] If the response power mismatch counter is not equal to or greater than the specified value (step S44: NO), the power comparator 41 does not issue an error notification, and repeats the processes from step S41 onwards.
[0163] In step S42, if the power difference is not equal to or greater than the power threshold (step S42: NO), the power comparator 41 clears the response power mismatch counter (step S46) and repeats the processes from step S41 onwards.
[0164] FIG. 31 is a second flowchart for explaining the operation of the control device according to the fourth embodiment.
[0165] When the power comparison unit 41 receives the driving source power and the motor command power (step S51), it determines whether or not the power difference between the driving source power and the motor command power is equal to or greater than a power threshold value (step S52).
[0166] If the power difference is equal to or greater than the power threshold (step S52: YES), the power comparing unit 41 increments the command power mismatch counter (step S53).
[0167] The power comparator 41 determines whether the command power mismatch counter is equal to or greater than a specified value (step S54). Specifically, the power comparator 41 determines whether the time during which the power difference is equal to or greater than the power threshold value exceeds a specific time (e.g., 200 ms) that is a specified value.
[0168] In step S54, if the command power mismatch counter is equal to or greater than the specified value (step S54: YES), the power comparison unit 41 issues an error notification (step S55) and ends the series of processes. In other words, if the state in which the power difference is equal to or greater than the power threshold continues for a specific time, the power comparison unit 41 detects a short circuit and issues an error notification.
[0169] If the command power mismatch counter is not equal to or greater than the specified value (step S54: NO), the power comparing unit 41 does not issue an error notification, and repeats the processes from step S51 onwards.
[0170] In step S52, if the power difference is not equal to or greater than the power threshold (step S52: NO), the power comparing unit 41 clears the command power mismatch counter (step S56) and repeats the processes in and after step S51.
[0171] (Action and effect) As described above, according to the control device 100-4 of the fourth embodiment, by comparing the difference between the drive source power and the response power with a power threshold, it is possible to detect a short circuit in a switching element even when the motor response power is close to zero with respect to the power supplied to the motor 200.
[0172] In addition, according to the control device 100-4, by comparing the difference between the drive source power and the motor command power with a power threshold, it is possible to detect a short circuit in a switching element even when the power consumed by the motor 200 is greater than the command power of the motor 200.
[0173] In this way, if a short circuit is detected based on the magnitude of the power difference, the power supply to the motor 200 can be stopped by issuing an error notification, thereby preventing the motor 200 from burning out due to excessive current continuing to flow through the motor coil 201 in a short circuit state.
[0174] Furthermore, by detecting a short circuit using power as in the fourth embodiment in addition to detecting a short circuit using current as in the first to third embodiments, the accuracy of detecting a short circuit can be improved.
[0175] The control devices according to the second to fourth embodiments are also applicable to motors other than the unipolar type, which may include a bipolar type motor and a three-phase AC motor.
[0176] <Additional Notes> The features of the present invention are as follows. (Appendix 1) a current detection unit that detects currents flowing through a plurality of switching elements that drive a unipolar motor; a first threshold setting unit that sets, by a hardware configuration, a first threshold for detecting an overcurrent state by comparing the first threshold with a detection current that is a current detected by the current detection unit; a second threshold setting unit that sets a second threshold, the second threshold being different in value from the first threshold, by a software configuration; a short circuit detection unit that detects a short circuit in the plurality of switching elements according to a comparison result between the second threshold value and the detection current; A control device comprising:
[0177] (Appendix 2) The control device described in Appendix 1, wherein the short circuit detection unit detects the short circuit when the detected current exceeds the second threshold value which is set to the smaller of an upper limit current indicating an upper limit of a current detectable by the current detection unit and an expected current which is a current expected to flow through the motor based on a winding resistance and a power supply voltage of the motor.
[0178] (Appendix 3) The control device according to claim 1 or 2, wherein the short circuit detection unit detects the short circuit when a state in which the detected current exceeds the second threshold continues for a specific time.
[0179] (Appendix 4) The control device according to any one of appendices 1 to 3, wherein the short circuit detection unit detects the short circuit when the detected current exceeds the second threshold value, which is set to a rated current determined in accordance with a type of the motor, when the rotation speed of the motor is equal to or lower than a specified speed value in a state in which driving of the motor is prohibited.
[0180] (Appendix 5) the current detection unit detects, for each phase of the motor, a difference between a current flowing through a corresponding switching element and a current of a reverse phase thereof as the detection current; The control device according to any one of appendixes 1 to 4, wherein the short circuit detection unit detects the short circuit when the detected current falls below the second threshold value, which is set to a current that is a specific value lower than a rated current determined according to the type of the motor, when a current command for the motor is greater than a specified current value determined according to the type of the motor.
[0181] (Appendix 6) 6. The control device according to claim 1, wherein the short circuit detection unit detects the short circuit when a state in which the detection current is lower than the second threshold continues for a specific time.
[0182] (Appendix 7) a driving source power estimation unit that estimates driving source power, which is power supplied from the driving source to the motor, based on a current supplied from the driving source to the motor; a motor response power estimation unit that estimates a motor response power, which is power used to drive the motor, based on the detected current; Equipped with The control device according to any one of claims 1 to 6, wherein the short circuit detection unit detects the short circuit when a difference between the drive source power and the motor response power is equal to or greater than a power threshold.
[0183] (Appendix 8) a driving source power estimation unit that estimates driving source power, which is power supplied from the driving source to the motor, based on a current supplied from the driving source to the motor; a motor command power estimation unit that estimates a motor command power, which is power required to drive the motor, based on a current command of the motor; Equipped with The control device according to any one of claims 1 to 7, wherein the short circuit detection unit detects the short circuit when a difference between the drive source power and the motor command power is equal to or greater than a power threshold.
[0184] Although one embodiment of the present invention has been described above, the present invention is not limited to the above, and it goes without saying that the present invention can be implemented in various modified forms without departing from the spirit and scope of the present invention. [Explanation of symbols]
[0185] 2 A phase current control section 5 Current detection section 6 Overcurrent detection section 7 A-phase current converter 8-1, 8-2, 8-3, 8-4 Shutoff command generation section 9 Drive source current detection section 10 Speed control section 11 Current command conversion unit 12 A phase current command operation section 13 B phase current command operation section 14 A phase current recognition section 15 B phase current recognition section 16 Overcurrent comparison section 17 Overcurrent detection signal recognition section 18 Overcurrent signal processing section 19 Error Reporting Section 20 Drive source cutoff operation unit 21-1, 21-2, 21-3 Second threshold setting unit 22-1, 22-2, 22-3, 22-4 Short circuit detection section 21-4 Power threshold setting section 23 Error notification section 31 Servo-off overcurrent monitoring section 32 Location response recognition unit 33 Speed response generator 34 Servo command recognition unit 35 Servo control judgment section 36 Current command response deviation monitor 37 Drive source current recognition unit 38 Driving source power estimation unit 39 Motor command power estimator 40 Motor response power estimation unit 41 Power comparison section 51 A-phase current detection section 52 B-phase current detection section 61 Comparator 62 First threshold setting unit 71 Operational Amplifiers 100-1, 100-2, 100-3, 100-4 Control device 200 Motor 201 Motor coil 202 Encoder 300 Power Source
Claims
1. a current detection unit that detects currents flowing through a plurality of switching elements that drive a unipolar motor; a first threshold setting unit that sets, by a hardware configuration, a first threshold for detecting an overcurrent state by comparing the first threshold with a detection current that is a current detected by the current detection unit; a second threshold setting unit that sets a second threshold, the second threshold being different in value from the first threshold, by a software configuration; a short circuit detection unit that detects a short circuit in the plurality of switching elements according to a comparison result between the second threshold value and the detected current; A control device comprising:
2. 2. The control device according to claim 1, wherein the short circuit detection unit detects the short circuit when the detected current exceeds the second threshold value, which is set to the smaller of an upper limit current indicating an upper limit of a current that can be detected by the current detection unit and an expected current that is a current that is expected to flow through the motor based on a winding resistance and a power supply voltage of the motor.
3. The control device according to claim 2 , wherein the short circuit detection unit detects the short circuit when a state in which the detected current exceeds the second threshold continues for a specific time.
4. 2. The control device according to claim 1, wherein the short circuit detection unit detects the short circuit when the detected current exceeds the second threshold value, which is set to a rated current determined according to a type of the motor, when the rotation speed of the motor is equal to or lower than a specified speed value while driving of the motor is prohibited.
5. the current detection unit detects, for each phase of the motor, a difference between a current flowing through a corresponding switching element and a current of a reverse phase thereof as the detection current; 2. The control device according to claim 1, wherein the short circuit detection unit detects the short circuit when the detected current falls below the second threshold value, which is set to a current that is a specific value lower than a rated current determined according to the type of the motor, when a current command for the motor is greater than a specified current value determined according to the type of the motor.
6. The control device according to claim 5 , wherein the short circuit detection unit detects the short circuit when a state in which the detected current is lower than the second threshold continues for a specific time.
7. a driving source power estimation unit that estimates driving source power, which is power supplied from the driving source to the motor, based on a current supplied from the driving source to the motor; a motor response power estimation unit that estimates a motor response power, which is power used to drive the motor, based on the detected current; Equipped with The control device according to claim 1 , wherein the short circuit detection unit detects the short circuit when a difference between the drive source power and the motor response power is equal to or greater than a power threshold value.
8. a driving source power estimation unit that estimates driving source power, which is power supplied from the driving source to the motor, based on a current supplied from the driving source to the motor; a motor command power estimation unit that estimates a motor command power, which is power required to drive the motor, based on a current command of the motor; Equipped with The control device according to claim 1 , wherein the short circuit detection unit detects the short circuit when a difference between the drive source power and the motor command power is equal to or greater than a power threshold value.
Citation Information
Patent Citations
Motor control device
JP2014143782A
Motor drive unit
JP4652017B2
