Control device and robot system

Abstract

To provide a control apparatus and a robot system that effectively utilize regenerative electric power in a simple configuration.SOLUTION: The control apparatus includes: a drive circuit unit to which regenerative electric power from a motor is input through a plurality of input / output terminals; a discharge resistance unit which is connected in parallel to the drive circuit unit, and to which the regenerative electric power is input from the drive circuit unit, and which consumes electric power when a voltage value of the regenerative electric power exceeds a threshold value; a second converter circuit unit which is connected in parallel to a first converter circuit unit, converts an alternating current being input through the terminals, into a direct current, and outputs the direct current; a first step-down circuit unit which steps down a voltage of the current being output from the second converter circuit unit, and outputs the stepped down voltage; an energization control circuit unit which is actuated by the direct current being output from the first step-down circuit unit and controls the drive circuit unit; and a regenerative electric power supply unit which is connected to the discharge resistance unit, and has a regenerative diode outputting a direct current of the regenerative electric power to the first step-down circuit unit.SELECTED DRAWING: Figure 3A

Description

[Technical Field]

[0001] The present invention relates to a control device and a robot system. [Background technology]

[0002] In recent years, due to rising labor costs and labor shortages in factories, robots with robotic arms have begun to perform manufacturing, processing, assembly, and other tasks, accelerating the automation of tasks that were previously performed manually. Robots are also required to operate with low power consumption.

[0003] For example, the robot control device for a robot described in Patent Document 1 has a smoothing capacitor that stores regenerative power generated by a motor that drives the robot arm. The regenerative power is stored in the smoothing capacitor and used to drive, for example, a DC fan. [Prior art documents] [Patent documents]

[0004] [Patent Document 1] Japanese Patent Application Laid-Open No. 2006-280076 Summary of the Invention [Problem to be solved by the invention]

[0005] However, the robot control device described in Patent Document 1 is configured to supply the stored regenerative power to a DC fan that consumes power intermittently, so it needs to discharge the power in accordance with the timing of power consumption, which makes the control and configuration complicated. As such, it is difficult to effectively utilize regenerative power with a simple configuration. [Means for solving the problem]

[0006] The control device of the present invention is a control device that controls the driving of a motor of a robot arm, a terminal for supplying power from an AC power source; a plurality of input / output terminals for inputting and outputting power to and from the motor; a first converter circuit unit that converts AC current input from the terminal into DC current and outputs the DC current; a drive circuit section that converts a direct current output from the first converter circuit section into an alternating current and outputs the alternating current to the plurality of input / output terminals, and receives regenerative power from the motor through the plurality of input / output terminals; a discharge resistor unit connected in parallel with the drive circuit unit, receiving the regenerative power from the drive circuit unit, and consuming power when a voltage value of the regenerative power exceeds a threshold value; a second converter circuit unit connected in parallel with the first converter circuit unit and configured to convert AC current input from the terminal into DC current and output the DC current; a first step-down circuit unit that steps down the voltage of the current output from the second converter circuit unit and outputs the resulting voltage; a current control circuit section that operates by the DC current output from the first step-down voltage circuit section and controls the drive circuit section; The power supply unit is characterized by including a regenerative power supply unit having a regenerative diode connected to the discharge resistor unit and outputting the DC current of the regenerative power to the first step-down circuit unit.

[0007] The robot system of the present invention comprises: a robot having a robot arm; The robot arm is characterized by comprising: a control device of the present invention that controls the driving of the robot arm. [Brief explanation of the drawings]

[0008] [Figure 1] FIG. 1 is a diagram showing the overall configuration of a robot system equipped with a control device of the present invention. [Figure 2] FIG. 2 is a block diagram of the robot system shown in FIG. [Figure 3A] FIG. 3A is a circuit diagram of the control device shown in FIG. [Figure 3B] FIG. 3B is a circuit diagram of the comparator shown in FIG. 3A. [Figure 4]FIG. 4 is a diagram showing an example of the relationship between the threshold value of the voltage of the regenerative power from the motor shown in FIG. 1 and the voltage value of the power input to the first step-down voltage circuit unit. [Figure 5] FIG. 5 is a diagram showing an example of the relationship between the threshold value of the voltage of the regenerative power from the motor shown in FIG. 1 and the voltage value of the power input to the first step-down voltage circuit unit. [Figure 6] FIG. 6 is a diagram showing an example of the relationship between the threshold value of the voltage of the regenerative power from the motor shown in FIG. 1 and the voltage value of the power input to the first step-down voltage circuit unit. [Figure 7] FIG. 7 is a modified circuit diagram of the control device shown in FIG. DETAILED DESCRIPTION OF THE INVENTION

[0009] DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS A control device according to the present invention will now be described in detail with reference to preferred embodiments shown in the accompanying drawings. <Embodiment> FIG. 1 is a diagram showing the overall configuration of a robot system equipped with a control device of the present invention. FIG. 2 is a block diagram of the robot system shown in FIG. 1. FIG. 3A is a circuit diagram of the control device shown in FIG. 1. FIG. 3B is a circuit diagram of the comparator shown in FIG. 3A. FIG. 4 is a diagram showing an example of the relationship between the threshold value of the voltage of the regenerative power from the motor shown in FIG. 1 and the voltage value of the power input to the first step-down circuit unit. FIG. 5 is a diagram showing an example of the relationship between the threshold value of the voltage of the regenerative power from the motor shown in FIG. 1 and the voltage value of the power input to the first step-down circuit unit. FIG. 6 is a diagram showing an example of the relationship between the threshold value of the voltage of the regenerative power from the motor shown in FIG. 1 and the voltage value of the power input to the first step-down circuit unit. FIG. 7 is a modified example of the circuit diagram of the control device shown in FIG. 1.

[0010] For ease of explanation, the robot arm 10 will be referred to below as having a base 11 side in FIG. 1 as the "base end" and an opposite side, i.e., an end effector 20 side as the "tip end."

[0011] As shown in FIG. 1, a robot system 100 of the present invention includes a robot 1, a control device 3 that controls the robot 1, and a teaching device 4.

[0012] First, the robot 1 will be described. In this embodiment, the robot 1 shown in FIG. 1 is a single-arm, six-axis vertical articulated robot, and includes a base 11 and a robot arm 10. An end effector 20 can be attached to the tip of the robot arm 10. The end effector 20 may be a component of the robot 1, or may be a separate member from the robot 1, i.e., it does not have to be a component of the robot 1.

[0013] The robot 1 is not limited to the configuration shown in the figure, and may be, for example, a double-arm articulated robot or a horizontal articulated robot.

[0014] The base 11 is a support that drivably supports the robot arm 10 at its base end, and is fixed to, for example, the floor of a factory. The base 11 of the robot 1 is electrically connected to the control device 3 via a relay cable. Note that the connection between the robot 1 and the control device 3 is not limited to a wired connection as shown in FIG. 1, and may be, for example, a wireless connection. The robot 1 and the control device 3 may also be connected via a network such as the Internet.

[0015] In this embodiment, the robot arm 10 has a first arm 12, a second arm 13, a third arm 14, a fourth arm 15, a fifth arm 16, and a sixth arm 17, which are connected in this order from the base 11 side. The number of arms that the robot arm 10 has is not limited to six, and may be, for example, one, two, three, four, five, or seven or more. The size of each arm, such as its overall length, is not particularly limited and can be set as appropriate.

[0016] The base 11 and the first arm 12 are connected via a joint 171. The first arm 12 is rotatable around a first rotation axis that extends parallel to the vertical direction relative to the base 11. The first rotation axis coincides with the normal to the floor surface to which the base 11 is fixed.

[0017] The first arm 12 and the second arm 13 are connected via a joint 172. The second arm 13 is rotatable about a second rotation axis extending horizontally relative to the first arm 12. The second rotation axis is parallel to an axis perpendicular to the first rotation axis.

[0018] The second arm 13 and the third arm 14 are connected via a joint 173. The third arm 14 is rotatable relative to the second arm 13 about a third rotation axis extending horizontally. The third rotation axis is parallel to the second rotation axis.

[0019] The third arm 14 and the fourth arm 15 are connected via a joint 174. The fourth arm 15 is rotatable relative to the third arm 14 around a fourth rotation axis that is parallel to the central axis of the third arm 14. The fourth rotation axis is perpendicular to the third rotation axis.

[0020] The fourth arm 15 and the fifth arm 16 are connected via a joint 175. The fifth arm 16 is rotatable about a fifth rotation axis relative to the fourth arm 15. The fifth rotation axis is perpendicular to the fourth rotation axis.

[0021] The fifth arm 16 and the sixth arm 17 are connected via a joint 176. The sixth arm 17 is rotatable about a sixth rotation axis relative to the fifth arm 16. The sixth rotation axis is perpendicular to the fifth rotation axis.

[0022] The sixth arm 17 is the arm located at the most distal end of the robot arm 10. The sixth arm 17 can be displaced together with the end effector 20 by being driven by the robot arm 10.

[0023] 1 has a gripping portion that can grip a workpiece or a tool. When the end effector 20 is attached to the sixth arm 17, the tip of the end effector 20 becomes the tool center point TCP.

[0024] The robot 1 includes motors M1, M2, M3, M4, M5, and M6 as drive units, and encoders E1, E2, E3, E4, E5, and E6. Motor M1 is built into joint 171 and rotates the first arm 12 relative to the base 11 around the first rotation axis. Motor M2 is built into joint 172 and rotates the first arm 12 and the second arm 13 relatively around the second rotation axis. Motor M3 is built into joint 173 and rotates the second arm 13 and the third arm 14 relatively around the third rotation axis. Motor M4 is built into joint 174 and rotates the third arm 14 and the fourth arm 15 relatively around the fourth rotation axis. Motor M5 is built into joint 175 and rotates fourth arm 15 and fifth arm 16 relatively around the fifth rotation axis. Motor M6 is built into joint 176 and rotates fifth arm 16 and sixth arm 17 relatively around the sixth rotation axis. Each of motors M1 to M6 is a three-phase motor driven by three-phase AC.

[0025] Furthermore, encoder E1 is built into joint 171 and detects the position of motor M1. Encoder E2 is built into joint 172 and detects the position of motor M2. Encoder E3 is built into joint 173 and detects the position of motor M3. Encoder E4 is built into joint 174 and detects the position of motor M4. Encoder E5 is built into fifth arm 16 and detects the position of motor M5. Encoder E6 is built into sixth arm 17 and detects the position of motor M6. Note that "detecting position" here refers to detecting the rotation angle of the motor, i.e., the amount of rotation including forward and reverse, and the angular velocity, and the detected information is referred to as "position information."

[0026] 2, motor drivers D1 to D6 are connected to corresponding motors M1 to M6, respectively, and control the driving of the motors. Motor drivers D1 to D6 are built into joint 171, joint 172, joint 173, joint 174, fifth arm 16, and sixth arm 17, respectively.

[0027] Encoders E1 to E6, motors M1 to M6, and motor drivers D1 to D6 are each electrically connected to the control device 3. Position information of motors M1 to M6 detected by encoders E1 to E6, i.e., the amount of rotation, etc., is transmitted to the control device 3 as an electrical signal. Based on this position information, an energization control circuit unit 74 in the power control circuit 10A of the control device 3 outputs control signals to motor drivers D1 to D6 shown in FIG. 2 to control the energization of motors M1 to M6 and drive motors M1 to M6 as desired. In other words, controlling the robot arm 10 means controlling the operation of first arm 12 to sixth arm 17 of the robot arm 10 by controlling the driving of motors M1 to M6.

[0028] An end effector 20 can be detachably attached to the tip of the robot arm 10. In this embodiment, the end effector 20 is configured as a hand having a pair of claws that can move toward and away from each other and that grip and release a workpiece or tool with each claw. The end effector 20 is not limited to the configuration shown in the figure and may be configured, for example, to have an adsorption portion that grips a workpiece or tool by adsorption with the adsorption portion. The end effector 20 may also be, for example, a polishing machine, grinding machine, cutting machine, spray gun, laser light irradiator, screwdriver, wrench, or other tool.

[0029] Next, the control device 3 and the teaching device 4 will be described. As shown in FIG. 1, in this embodiment, the control device 3 is installed at a location separate from the robot 1. However, this configuration is not limiting, and the control device 3 may be built into the base 11. The control device 3 has a function of controlling the driving of the robot 1, and is electrically connected to the motors M1 to M6, the AC power supply 61, and other parts of the robot. The control device 3 has a control unit 31, a storage unit 32, and a communication unit 33. These units are connected to each other so that they can communicate with each other, for example, via a bus.

[0030] The control unit 31 is configured by, for example, a CPU (Central Processing Unit), and reads and executes various programs such as operation programs stored in the storage unit 32. Signals generated by the control unit 31 are transmitted to each part of the robot 1 via the communication unit 33, and signals from each part of the robot 1 are received by the control unit 31 via the communication unit 33. This allows the robot arm 10 to perform a predetermined task under predetermined conditions.

[0031] The storage unit 32 stores various programs and the like executed by the control unit 31. Examples of the storage unit 32 include a configuration including a volatile memory such as a RAM (Random Access Memory), a non-volatile memory such as a ROM (Read Only Memory), and a removable external storage device.

[0032] The communication unit 33 transmits and receives signals to and from the control device 3 using an external interface such as a wired LAN (Local Area Network) or a wireless LAN. In this case, communication may be performed via a server (not shown), or via a network such as the Internet.

[0033] As shown in FIGS. 1 and 2, the teaching device 4 is a command device for teaching and has a display 40, which is a display unit. This display 40 is also an operation unit that teaches an operation program to the robot arm 10. In other words, it has the function of creating and inputting an operation program. The display 40 is configured with a touch panel, and various operations and information related to teaching are input by an operator operating it with a finger or a touch pen. The display 40 is configured with, for example, a liquid crystal display (LCD), an organic electroluminescence display (OLED), or the like, and can display various screens in color or monochrome. The touch panel type of the display 40 may be either a pressure-sensitive type or a capacitance type.

[0034] The teaching device 4 includes a control unit 41 , a storage unit 42 , and a communication unit 43 . The control unit 41 is composed of at least one processor such as a CPU (Central Processing Unit), and reads and executes various programs, such as teaching programs, stored in the storage unit 42. The control unit 41 also has a function of controlling the operation of the display 40. Specifically, the control unit 41 displays a rectangular operation screen on the display 40, and generates an operation program for the robot 1 based on information input from the operation screen by touching a desired position, etc. The operation program generated by the control unit 41 is stored in the storage unit 42 and transmitted to the control device 3 via the communication unit 43. This makes it possible to specify a program via the control device 3 that causes the robot arm 10 to perform a predetermined task under predetermined conditions.

[0035] The storage unit 42 stores various programs and the like that can be executed by the control unit 41. Examples of the storage unit 42 include a configuration that includes a volatile memory such as a RAM (Random Access Memory), a non-volatile memory such as a ROM (Read Only Memory), a removable external storage device, etc. The storage unit 42 also stores operation programs created by the control unit 41.

[0036] The communication unit 43 transmits and receives signals to and from the control device 3 using an external interface such as a wired LAN (Local Area Network) or a wireless LAN. In this case, communication may be performed via a server (not shown), or via a network such as the Internet. The communication unit 43 transmits information related to the operating program stored in the storage unit 42 to the control device 3. The communication unit 43 can also receive information stored in the storage unit 32 and store it in the storage unit 42.

[0037] Next, the control device 3 of the robot system 100 will be described in detail with reference to FIG. 3A. The control device 3 has a control unit 31, which has a power control circuit 10A. The power control circuit 10A has an input terminal (terminal) 62A, a noise removal capacitor 60A, an inrush current prevention resistor 60B, a first converter circuit 62, a regenerative capacitor 63 electrically connected to the output side of the first converter circuit 62, a drive circuit 64, an input / output terminal 62B, a discharge resistor 65, a potential detection unit 66, a switch 67, a comparator 68, a second converter circuit 71, a power factor correction circuit 72, a first step-down circuit 73, an energization control circuit 74, a second step-down circuit 75, and a regenerative power supply unit 76. Note that the term "connected" includes not only direct connection between terminals but also connection between terminals via wires or the like.

[0038] The AC power supply 61 is, for example, a 200V AC power supply. The power output by the AC power supply 61, i.e., electrical energy, is input to the first converter circuit unit 62 via an input terminal 62A, a noise reduction capacitor 60A, and an inrush current prevention resistor unit 60B. The input terminal 62A is a terminal to which power is supplied from the AC power supply 61 and to which AC current is input. As shown in FIG. 3A , the two input terminals 62A are each connected to a first converter circuit unit 62 (described later) by an electric wire. The electric wire connecting the lower input terminal 62A to the first converter circuit unit 62 is a low-potential electric wire, and the electric wire connecting the upper input terminal 62A to the first converter circuit unit 62 is a high-potential electric wire that has a higher potential than the low-potential electric wire. The two input terminals 62A are also connected to a second converter circuit unit 71 (described later) by an electric wire. The wire connecting the lower input terminal 62A to the second converter circuit unit 71 is a low-potential wire, and the wire connecting the upper input terminal 62A to the second converter circuit unit 71 is a high-potential wire that has a higher potential than the low-potential wire. In this embodiment, the low-potential wires are each connected to a ground.

[0039] The noise reduction capacitor 60A consists of two capacitors connected in series with a ground connected between them. By passing through the noise reduction capacitor 60A, noise in the power output by the AC power supply 61 is removed, enabling a stable power supply.

[0040] The inrush prevention resistor unit 60B is provided on the high-potential electric wire and includes a resistor and a switch that bypasses the resistor, preventing the flow of inrush current. When the control device 3 is started, an excessive current known as an inrush current is generated due to the storage of electricity in the regenerative capacitor 63, etc. Therefore, when the control device 3 is started, the switch is turned OFF, causing the current to flow through the resistor, consuming power and preventing the inrush current from flowing to the first converter circuit unit 62, etc. This improves safety. On the other hand, after the control device 3 is started, power is stored in the capacitor, etc., preventing the generation of an inrush current, so the switch is turned ON, preventing the current from flowing through the resistor, thereby suppressing power consumption by the resistor.

[0041] The first converter circuit 62 is a bridge rectifier circuit using diodes, and converts AC current input from the AC power supply 61 via a noise removal capacitor 60A and an inrush current prevention resistor 60B into DC current and outputs it.

[0042] A regenerative capacitor 63 is connected to the output side of the first converter circuit unit 62. The regenerative capacitor 63 stores regenerative power generated by the motors M1 to M6. The regenerative capacitor 63 also functions as a smoothing capacitor, smoothing the voltage output from the first converter circuit unit 62.

[0043] The drive circuit unit 64 also includes motor drivers D1 to D6. Each of the motor drivers D1 to D6 includes an inverter circuit including six switching elements. Each of the motor drivers D1 to D6 performs PWM control, converts the DC current output from the first converter circuit unit 62 into AC current, which in this embodiment is three-phase AC, and selectively supplies the AC current to the corresponding motors M1 to M6 via the input / output terminals 62B. The motors M1 to M6 also generate regenerative power, which will be described later, and this regenerative power is input to the motor drivers D1 to D6 via the input / output terminals 62B. The magnitude and timing of the power output from the drive circuit unit 64 to each of the motors M1 to M6 are set by the current control circuit unit 74. As shown in FIG. 3A, two terminals of the drive circuit unit 64 are connected to the first converter circuit unit 62 via electric wires. The electric wire connecting the lower terminal of the drive circuit unit 64 to the first converter circuit unit 62 is a low-potential electric wire, and the electric wire connecting the upper terminal of the drive circuit unit 64 to the first converter circuit unit 62 is a high-potential electric wire that has a higher potential than the low-potential electric wire. In this embodiment, the low-potential electric wire is connected to earth.

[0044] Furthermore, the terminals through which the drive circuit unit 64 outputs to the motors M1 to M6 are each an input / output terminal 62B. Power is input and output between the motor drivers D1 to D6 and the motors M1 to M6 via the input / output terminals 62B. As each of the motors M1 to M6 is a three-phase motor, three input / output terminals 62B are provided for each motor.

[0045] By driving motors M1 to M6, the robot arm 10 is driven and displaced, but if an attempt is made to suddenly slow down or stop the displacement of the robot arm 10 by cutting off the power supply to motors M1 to M6, the robot arm 10 will not stop instantly in the middle of its displacement due to its inertia, and a back electromotive force, i.e., regenerative power, will be generated in motors M1 to M6.

[0046] Motors M1 to M6 each independently generate regenerative power. The term "regenerative power" described below refers to the total power of the regenerative power generated by motors M1 to M6.

[0047] The discharge resistor 65 is connected in parallel to the drive circuit 64, and when power supply to the motors M1 to M6 is stopped to decelerate them, that is, when the motors M1 to M6 are regenerated, the discharge resistor 65 converts the regenerative power generated by the motors M1 to M6 into heat and consumes it. Regeneration means that the drive sources such as the motors M1 to M6 are operated so as to generate counter electromotive force when the drive sources are suddenly decelerated, that is, the drive sources are operated as generators.

[0048] When driving motors M1 to M6, the current control circuit 74 operates using power from the AC power supply 61 to control the drive circuit 64, supplying AC, particularly three-phase AC, to motors M1 to M6 at a predetermined timing, frequency, and voltage. When stopping the driving of motors M1 to M6, the current control circuit 74 controls the drive circuit 64 to stop the supply of current to motors M1 to M6. At this time, as described above, counter electromotive force is generated in motors M1 to M6, and this power is stored in the regenerative capacitor 63. When the power exceeds the capacity of the regenerative capacitor 63, the remaining power is converted into heat by the discharge resistor 65, which generates and dissipates heat.

[0049] A switch 67 is connected in series to the discharge resistor section 65. When the switch 67 is in the ON state, power is supplied to the discharge resistor section 65, and when the switch 67 is in the OFF state, power is not supplied to the discharge resistor section 65.

[0050] The potential detection unit 66 detects the potential of the regenerative capacitor 63. A signal corresponding to the detection value detected by the potential detection unit 66 is input to a terminal 69 of a comparator 68.

[0051] Comparator 68 generates a signal to turn switch 67 ON when the voltage value of the regenerated power from motors M1 to M6 exceeds a threshold value. That is, comparator 68 compares the detection result of potential detection unit 66, i.e., the voltage value of the regenerated power, with a set threshold value, and outputs a signal according to the comparison result to switch 67. When the voltage value of the regenerated power is greater than the threshold value, comparator 68 outputs a signal to switch 67 to turn switch 67 ON. On the other hand, when the voltage value of the regenerated power is less than the threshold value, comparator 68 outputs a signal to switch 67 to turn switch 67 OFF. Note that this threshold value will also be referred to as "threshold value B" below. As shown in FIG. 3B, the comparator 68 has a comparator main body 681 that performs a comparison and outputs a signal according to the comparison result, a terminal 69 that connects to the potential detection unit 66, a terminal 70 that connects to the second step-down circuit unit 75 described later, a resistor R1 that is arranged on the wire connecting the comparator main body 681 and the terminal 70, a resistor R2 that is arranged on the wire connecting the area between the comparator main body 681 and the resistor R1 with the wire on the output side of the comparator main body 681 and obtains hysteresis by bypassing the comparator main body 681, a resistor R3 that is arranged on the terminal 70 side of the resistor R1, and a resistor R4 that is arranged on the wire connecting the area between the resistors R1 and R3 with ground.

[0052] The above-described portion of power control circuit 10A, excluding comparator 68, is the "high-power side" circuit to which a relatively high voltage is applied. Next, the "low-power side" circuit of power control circuit 10A to which a lower voltage than the "high-power side" is applied will be described.

[0053] The second converter circuit unit 71 is connected in parallel to the first converter circuit unit 62, and converts AC current input from the AC power supply 61 via the input terminal 62A, noise removal capacitor 60A, and inrush current prevention resistor unit 60B into DC current and outputs it to the power factor correction circuit unit 72. The second converter circuit unit 71 is a bridge rectifier circuit using diodes.

[0054] The power factor correction circuit unit 72 is a circuit for adjusting the power factor of the AC power supply 61 to approach 1. The power factor correction circuit unit 72 also has the function of suppressing high-frequency current generated in the AC power supply 61 to a predetermined value or less to protect the CPU, which will be described later, and other components. The power factor correction circuit unit 72 has an output voltage setting resistor 721 that adjusts the output voltage. By appropriately setting the resistance value of the output voltage setting resistor 721, it is possible to set the voltage output from the power factor correction circuit unit 72 to the first step-down circuit unit 73, i.e., the voltage value of the current input to the first step-down circuit unit 73. Hereinafter, the voltage value of the current input to the first step-down circuit unit 73 will also be referred to as "voltage value A."

[0055] As described above, the control device 3 includes the power factor correction circuit unit 72 that corrects the power factor of the power supplied from the regenerative power supply unit 76 and outputs the power to the first step-down circuit unit 73. This improves the power factor, making it possible to effectively utilize the power from the AC power supply 61, and also makes it easy to set the voltage of the current output to the first step-down circuit unit 73.

[0056] The first step-down circuit unit 73 is a linear or switching DC / DC converter that steps down the input voltage and outputs it to the energization control circuit unit 74 and the second step-down circuit unit 75. The voltage supplied to the energization control circuit unit 74 and the second step-down circuit unit 75 is stepped down to, for example, about 24 V.

[0057] The energization control circuit 74 and the second step-down circuit 75 are connected in parallel. The energization control circuit 74 is a circuit that constitutes part of the control unit 31 described above, and is operated by the DC current output from the first step-down circuit 73 to control the drive circuit 64. That is, the energization control circuit 74 generates a drive signal control and outputs it to the drive circuit 64.

[0058] The second step-down circuit unit 75 has the same configuration and function as the first step-down circuit unit 73, except for the degree of transformation. The second step-down circuit unit 75 further steps down the voltage stepped down by the first step-down circuit unit 73 and supplies it to terminal 70 of the comparator 68 as a comparator power supply voltage. This enables the comparator 68 to operate. The comparator power supply voltage supplied to terminal 70 of the comparator 68 is stepped down to, for example, about 5 V by the second step-down circuit unit 75. The comparator 68 compares the input value from terminal 69 with the input value from terminal 70, and controls the opening and closing of the switch 67. As shown in FIG. 3A , the two terminals of the energization control circuit unit 74 and the second step-down circuit unit 75 are each connected to the second converter circuit unit 71 by electric wires. The electric wires connecting the lower terminals of the energization control circuit unit 74 and the second step-down circuit unit 75 to the second converter circuit unit 71 are low-potential electric wires, and the electric wires connecting the upper terminals of the energization control circuit unit 74 and the second step-down circuit unit 75 to the second converter circuit unit 71 are high-potential electric wires that have a higher potential than the low-potential electric wires. In this embodiment, the low-potential electric wires are connected to earth.

[0059] The regenerative power supply unit 76 has a regenerative diode 761 that outputs DC current of regenerative power generated on the high-voltage side to the first step-down circuit unit 73. The regenerative power that the regenerative power supply unit 76 supplies to the first step-down circuit unit 73 includes direct regenerative power generated in the motors M1 to M6 and regenerative power discharged by the regenerative capacitor 63. In the regenerative power supply unit 76, the input terminal of the regenerative diode 761, i.e., the anode, is connected to the high-potential wire between the output terminal of the first converter circuit unit 62 and the discharge resistor unit 65, and the output terminal of the regenerative diode 761, i.e., the cathode, is connected to the input terminal of the high-potential wire of the first step-down circuit unit 73. The regenerative diode 761 allows the regenerative power to pass in only one direction, that is, from the motors M1 to M6 toward the first step-down circuit unit 73 as shown by arrow A in FIG. 3A, but prevents the passage of current in the reverse direction. In other words, the regenerative power supply unit 76 supplies regenerative power from the high-voltage side to the low-voltage side. The regenerative power supplied by the regenerative power supply unit 76 is input to the first step-down circuit unit 73. The regenerative power supply unit 76 also has an electric wire that connects the low-potential electric wire of the first converter circuit unit 62 with the low-potential electric wire of the second converter circuit unit 71. This makes it possible to equalize the electric potential of the two low-potential electric wires, and as will be described later, this enables the frequency at which regenerative power is supplied to the energization control circuit unit 74 to be further increased, thereby enabling more effective use of the regenerative power.

[0060] In the past, there was no supply unit equivalent to the regenerative power supply unit 76, and the regenerative power was not supplied from the high-voltage side to the low-voltage side, making it impossible to effectively utilize the regenerative power. However, in the present invention, the regenerative power is supplied from the high-voltage side to the low-voltage side, and after being stepped down, is utilized as power to drive the energization control circuit unit 74. The regenerative power is also supplied to the second step-down circuit unit 75 and used to operate the comparator 68. This allows effective utilization of regenerative power in excess of the capacity of the regenerative capacitor 63. In particular, since the energization control circuit unit 74 is a circuit that constantly consumes power while the robot 1 is being driven, utilizing the regenerative power as power to drive the energization control circuit unit 74 eliminates the need for a circuit for discharge control or discharge control that is timed to match the timing of power consumption, thereby enabling effective utilization of the regenerative power with a simple configuration.

[0061] In this way, the control device 3 controls the driving of the motors M1 to M6 of the robot arm 10, and includes an input terminal 62A that supplies power from an AC power source 61, a plurality of input / output terminals 62B that input and output power between the motors M1 to M6, a first converter circuit unit 62 that converts the AC current input from the input terminal 62A into a DC current and outputs it, a drive circuit unit 64 that converts the DC current output from the first converter circuit unit 62 into an AC current and outputs it to the plurality of input / output terminals 62B, and to which regenerative power from the motors M1 to M6 is input from the plurality of input / output terminals 62B, and a drive circuit unit 64 that is connected in parallel with the drive circuit unit 64. The power supply system includes a discharge resistor unit 65 that consumes power when regenerative power is input from a path unit 64 and the voltage of the regenerative power exceeds a threshold B; a second converter circuit unit 71 that is connected in parallel with the first converter circuit unit 62 and converts AC current input from an input terminal 62A into DC current and outputs the DC current; a first step-down circuit unit 73 that steps down the voltage of the current output from the second converter circuit unit 71 and outputs the DC current; an energization control circuit unit 74 that operates with the DC current output from the first step-down circuit unit 73 and controls the drive circuit unit 64; and a regenerative power supply unit 76 that is connected to the discharge resistor unit 65 and has a regenerative diode 761 that outputs the DC current of the regenerative power to the first step-down circuit unit 73. This allows the regenerative power to be used as power for driving the energization control circuit unit 74. Therefore, when reusing regenerative power, the regenerative power can be effectively utilized with a simple configuration while omitting the complicated circuits and controls required in the prior art. As a result, the control device 3 can be driven with low power consumption.

[0062] The robot system 100 also includes a robot 1 having a robot arm 10 and a control device 3 that controls the driving of the robot arm 10. This allows the regenerative power to be used as power for driving the energization control circuit unit 74. This makes it possible to effectively utilize the regenerative power with a simple configuration while omitting the need for a circuit for discharging control in accordance with the timing of power consumption. As a result, the control device 3 can be driven with low power consumption, and energy savings can be achieved in the robot system 100 as a whole.

[0063] In addition, in the regenerative power supply unit 76, an input terminal of a regenerative diode 761 is connected between the first converter circuit unit 62 and the discharge resistor unit 65, and an output terminal of the regenerative diode 761 is connected to an input terminal of the first step-down circuit unit 73. This allows the regenerative power generated in the motors M1 to M6 to be supplied collectively to the first step-down circuit unit 73. Note that the input side of the regenerative diode 761 may be connected to the drive circuit unit 64 or its input side. In this case, it is preferable to provide a regenerative diode 761 corresponding to each of the motors M1 to M6.

[0064] Next, the relationship between the voltage value A of the current input to the first step-down voltage circuit unit 73 and the threshold value B of the voltage value of the regenerative power of the motors M1 to M6 will be described.

[0065] It is preferable that the voltage value A of the current input to the first step-down voltage circuit unit 73 is less than the threshold value B. This makes it possible to reduce the frequency with which a voltage is applied to the discharge resistor unit 65, thereby increasing the frequency with which regenerative power is supplied to the energization control circuit unit 74. This allows for even more effective use of regenerative power.

[0066] Furthermore, the voltage value A has a width, that is, a predetermined range, due to individual differences between elements. The median value of voltage value A is A3, and around A3, the minimum value is A1 and the maximum value is A2. The median value A3 is the setting value set by output voltage setting resistor 721 of power factor correction circuit unit 72. A1 is, for example, about 370V or more and about 380V. A2 is about 385V or more and about 395V.

[0067] Furthermore, the threshold value B also has a width, that is, a predetermined range, due to individual differences between elements. The median value of the threshold B is B3. Centered on B3, the minimum value is B1 and the maximum value is B2. Note that the set value set by the comparator power supply voltage of the comparator 68 is the median value B3. Therefore, the accuracy of the comparator power supply voltage is preferably less than 5%. Also, due to the resistance error of the resistors R1 to R4 of the comparator 68, the threshold B becomes a value deviated from the median value B3. By increasing the resistance accuracy of the resistors R1 to R4, the minimum value B1 can be increased and the maximum value B2 can be decreased. Therefore, the resistance accuracy of the resistors R1 to R4 is preferably less than 1%. B1 is, for example, about 390V or more and about 400V. B2 is about 415V or more and about 425V.

[0068] By satisfying the following relationships for these voltage values, the following effects can be obtained respectively.

[0069] 1. Satisfy the relationship A1 < B1 < A3 < A2 < B2 (see Fig. 4). Thereby, it is possible to have a region where the ranges of the voltage value A and the threshold B do not overlap. Therefore, the frequency of supplying regenerative power to the energization control circuit section 74 can be increased, and the regenerative power can be more effectively utilized.

[0070] 2. Satisfy the relationship A1 < A3 < B1 < A2 < B2 (see Fig. 5). Thereby, the region where the ranges of the voltage value A and the threshold B do not overlap can be further widened. Therefore, the frequency of supplying regenerative power to the energization control circuit section 74 can be further increased, and the regenerative power can be more effectively utilized.

[0071] Note that if the ranges of the voltage value A and the threshold B overlap, low-cost components such as the resistance of the discharge resistor section 65 and the regenerative capacitor 63 can be used.

[0072] 3. Satisfy the relationship A2 ≤ B1 (see Fig. 6). As a result, the ranges of the voltage value A and the threshold value B can be made as wide as possible without overlapping. Therefore, the frequency of supplying regenerative power to the energization control circuit section 74 can be further increased, and the regenerative power can be utilized more effectively. In this case, the difference between A2 and B1 is preferably as small as possible.

[0073] Thus, when the voltage value A and the threshold value B have a predetermined range, the maximum value of the voltage value A is A2, the median value that is the center of the predetermined range of the voltage value A is A3, and the minimum value of the threshold value B is B1, it is preferable to satisfy the relationship A3 < B1 < A2. Thereby, the region where the ranges of the voltage value A and the threshold value B do not overlap can be made wider. Therefore, the frequency of supplying regenerative power to the energization control circuit section 74 can be further increased, and the regenerative power can be utilized more effectively.

[0074] Also, when the voltage value A and the threshold value B have a predetermined range, and the maximum value of the voltage value A is A2 and the minimum value of the threshold value B is B1, it is preferable to satisfy the relationship A2 ≤ B1. Thereby, the region where the ranges of the voltage value A and the threshold value B do not overlap can be made as wide as possible. Therefore, the frequency of supplying regenerative power to the energization control circuit section 74 can be further increased, and the regenerative power can be utilized more effectively.

[0075] Further, the power factor improvement circuit section 72 has an output voltage setting resistor 721 for setting the voltage output to the first step-down circuit section 73, and the resistance accuracy of the output voltage setting resistor 721 is preferably 1% or less. Thereby, A2, which is the maximum value of the voltage value A, can be easily set, particularly decreased. Therefore, it contributes to the voltage value satisfying the relationships 1, 2, and 3 above, and the above effects can be easily obtained.

[0076] The control device 3 also includes a comparator 68 that determines whether or not to supply power to the discharge resistor unit 65 based on threshold value B, and the resistance accuracy of the resistor in the comparator 68 is 1% or less. This makes it easy to set, and particularly to increase, B1, the minimum value of threshold value B. This contributes to the voltage values ​​1, 2, and 3 satisfying the above relationships, making it easy to achieve the above effects.

[0077] In this embodiment, the control circuit 10A includes the power factor correction circuit unit 72. However, as a modified example, as shown in FIG. 7, the control circuit 10A may be configured without the power factor correction circuit unit 72. In this case, the first step-down voltage circuit unit 73 is connected to the second converter circuit unit 71. The output terminal of the regenerative diode 761 of the regenerative power supply unit 76 is connected between the second converter circuit unit 71 and the first step-down voltage circuit unit 73. The first step-down voltage circuit unit 73 is a DC / DC converter such as a flyback converter. Even in this configuration, the regenerative power can be used as power to drive the energization control circuit unit 74.

[0078] Although the control device and robot system of the present invention have been described above with reference to the illustrated embodiments, the present invention is not limited to these. Furthermore, each component of the control device and robot system may be replaced with any structure that can perform the same function. Furthermore, any structure may be added. [Explanation of symbols]

[0079] REFERENCE SIGNS LIST 1...robot, 3...control device, 4...teaching device, 10...robot arm, 10A...power control circuit, 11...base, 12...first arm, 13...second arm, 14...third arm, 15...fourth arm, 16...fifth arm, 17...sixth arm, 20...end effector, 31...control unit, 32...storage unit, 33...communication unit, 40...display, 41...control unit, 42...storage unit, 43...communication unit, 60A...noise elimination Capacitor, 60B... inrush prevention resistor section, 61... AC power supply, 62... first converter circuit section, 62A... input terminal, 62B... input / output terminal, 63... regenerative capacitor, 64... drive circuit section, 65... discharge resistor section, 66... ​​potential detection section, 67... switch, 68... comparator, 681... comparator main body, 69... terminal, 70... terminal, 71... second converter circuit section, 72... power factor correction circuit section, 73... first step-down Circuit section, 74...energization control circuit section, 75...second step-down circuit section, 76...regenerative power supply section, 100...robot system, 171...joint, 172...joint, 173...joint, 174...joint, 175...joint, 176...joint, 721...output voltage setting resistor, 761...regenerative diode, A3...median, B3...median, D1...motor driver, D2...motor driver, D3...motor driver, D4...motor driver, D5...motor driver, D6...motor driver, E1...encoder, E2...encoder, E3...encoder, E4...encoder, E5...encoder, E6...encoder, M1...motor, M2...motor, M3...motor, M4...motor, M5...motor, M6...motor, TCP...tool center point, R1...resistor, R2...resistor, R3...resistor, R4...resistor

Claims

1. A control device that controls the driving of a motor of a robot arm, a terminal for supplying power from an AC power source; a plurality of input / output terminals for inputting and outputting power to and from the motor; a first converter circuit unit that converts AC current input from the terminal into DC current and outputs the DC current; a drive circuit section that converts a direct current output from the first converter circuit section into an alternating current and outputs the alternating current to the plurality of input / output terminals, and receives regenerative power from the motor through the plurality of input / output terminals; a discharge resistor unit connected in parallel with the drive circuit unit, receiving the regenerative power from the drive circuit unit, and consuming power when a voltage value of the regenerative power exceeds a threshold value; a second converter circuit unit connected in parallel with the first converter circuit unit and configured to convert AC current input from the terminal into DC current and output the DC current; a first step-down circuit unit that steps down the voltage of the current output from the second converter circuit unit and outputs the resulting voltage; a current control circuit section that operates by the DC current output from the first step-down voltage circuit section and controls the drive circuit section; a regenerative power supply unit having a regenerative diode connected to the discharge resistor unit and outputting a DC current of the regenerative power to the first step-down circuit unit, The control device according to claim 1, wherein the voltage of the current input to the first step-down voltage circuit is equal to or lower than the threshold value.

2. The voltage and the threshold value of the current input to the first step-down circuit unit have a predetermined range, a maximum value of the voltage of the current input to the first step-down voltage circuit unit is defined as A2, and a median value that is the center of the predetermined range of the voltage of the current input to the first step-down voltage circuit unit is defined as A3; When the minimum value of the threshold value is B1, 2. The control device according to claim 1, wherein the relationship A3<B1<A2 is satisfied.

3. The voltage and the threshold value of the current input to the first step-down circuit unit have a predetermined range, A2 is the maximum value of the voltage of the current input to the first step-down voltage circuit unit, When the minimum value of the threshold value is B1, 2. The control device according to claim 1, wherein the relationship A2≦B1 is satisfied.

4. A control device that controls the driving of a motor of a robot arm, a terminal for supplying power from an AC power source; a plurality of input / output terminals for inputting and outputting power to and from the motor; a first converter circuit unit that converts AC current input from the terminal into DC current and outputs the DC current; a drive circuit section that converts a direct current output from the first converter circuit section into an alternating current and outputs the alternating current to the plurality of input / output terminals, and receives regenerative power from the motor through the plurality of input / output terminals; a discharge resistor unit connected in parallel with the drive circuit unit, receiving the regenerative power from the drive circuit unit, and consuming power when a voltage value of the regenerative power exceeds a threshold value; a second converter circuit unit connected in parallel with the first converter circuit unit and configured to convert AC current input from the terminal into DC current and output the DC current; a first step-down circuit unit that steps down the voltage of the current output from the second converter circuit unit and outputs the resulting voltage; a current control circuit section that operates by the DC current output from the first step-down voltage circuit section and controls the drive circuit section; a regenerative power supply unit having a regenerative diode connected to the discharge resistor unit and outputting a DC current of the regenerative power to the first step-down circuit unit; a power factor correction circuit unit that corrects the power factor of the power supplied from the regenerative power supply unit and outputs the power to the first step-down circuit unit, the power factor correction circuit unit has an output voltage setting resistor that sets a voltage to be output to the first step-down circuit unit, A control device characterized in that the resistance accuracy of the output voltage setting resistor is 1% or less.

5. A control device that controls the driving of a motor of a robot arm, a terminal for supplying power from an AC power source; a plurality of input / output terminals for inputting and outputting power to and from the motor; a first converter circuit unit that converts AC current input from the terminal into DC current and outputs the DC current; a drive circuit section that converts a direct current output from the first converter circuit section into an alternating current and outputs the alternating current to the plurality of input / output terminals, and receives regenerative power from the motor through the plurality of input / output terminals; a discharge resistor unit connected in parallel with the drive circuit unit, receiving the regenerative power from the drive circuit unit, and consuming power when a voltage value of the regenerative power exceeds a threshold value; a second converter circuit unit connected in parallel with the first converter circuit unit and configured to convert AC current input from the terminal into DC current and output the DC current; a first step-down circuit unit that steps down the voltage of the current output from the second converter circuit unit and outputs the resulting voltage; a current control circuit section that operates by the DC current output from the first step-down voltage circuit section and controls the drive circuit section; a regenerative power supply unit having a regenerative diode connected to the discharge resistor unit and outputting a DC current of the regenerative power to the first step-down circuit unit; a comparator that selects whether or not to supply power to the discharge resistor unit based on the threshold value, A control device characterized in that the resistance accuracy of the resistor of the comparator is 1% or less.

6. 6. The control device according to claim 1, wherein the regenerative power supply unit has an input terminal of the regenerative diode connected between the first converter circuit unit and the discharge resistor unit, and an output terminal of the regenerative diode connected to an input terminal of the first step-down circuit unit.

7. a robot having a robot arm; A robot system comprising: the control device according to claim 1 , which controls the driving of the robot arm.

Images