MOTOR CONTROL DEVICE

Abstract

A disclosed motor control device includes: a PI controller which controls a velocity of a motor; an input unit which receives specification information including information of a weight and a center of mass of a tool; a calculation unit which calculates a gravitational torque based on the specification information; a storage which stores the gravitational torque output from the calculation unit and an integral value output from the PI controller, and outputs the gravitational torque and the integral value in response to a break signal; and a selection unit which sets, to the PI controller, the integral value output from the storage, according to a collision sensitivity input from the input unit.

Claims

1. A motor control device comprising: a proportional-integral (PD controller which controls a velocity of a motor; an input unit which receives specification information including information of a weight and a center of mass of a tool; a calculation unit which calculates a gravitational torque based on the specification information; a storage which stores the gravitational torque output from the calculation unit and an integral value output from the PI controller, and outputs the gravitational torque and the integral value in response to a break signal; and a selection unit which sets, to the PI controller, the integral value output from the storage, according to a collision sensitivity input from the input unit.

2. The motor control device according to claim 1, wherein the specification information includes load information, when a determination is made based on the load information of the specification information that the tool is not attached, the selection unit sets, to the PI controller, an unloaded gravitational torque as the integral value, and when a determination is made based on the load information of the specification information that the tool is attached, the selection unit sets, to the PI controller, a loaded gravitational torque as the integral value.

3. The motor control device according to claim 1, wherein the specification information can be arbitrarily set.

4. The motor control device according to claim 2, wherein the specification information can be arbitrarily set.

Description

BRIEF DESCRIPTION OF DRAWINGS

[0012] FIG. 1 illustrates a motor control device according to an embodiment.

[0013] FIG. 2 is a flowchart of an operation of selection unit 32 of the motor control device according to the embodiment.

[0014] FIG. 3 illustrates a method for detecting a collision detection result performed by collision detector 200.

[0015] FIG. 4 illustrates a relationship between collision sensitivity and collision detection torque in a robot.

[0016] FIG. 5 illustrates a relationship between collision sensitivity and set holding torque in a robot.

[0017] FIG. 6 illustrates conventional motor control device 900.

[0018] FIG. 7 illustrates the details of PI controller 901 of conventional motor control device 900.

DESCRIPTION OF EMBODIMENT

[0019] Prior to the description of an embodiment of the present disclosure, a problem in the conventional motor control device will be briefly described.

[0020] Conventional motor control device 900 which has been described with reference to FIG. 6 and FIG. 7 has the following problem. In the conventional motor control device, when brake signal B.sub.SIG is changed from ON to OFF in a state where motor 904 is stationary torque command value T.sub.COM stored in storage 907 is the holding torque of motor 904. However, when motor 904 has stopped suddenly or when motor 904 has been stopped by a collision, torque command value T.sub.COM obtained when brake signal B.sub.SIG stored in storage 907 is changed from ON to OFF is not an appropriate holding torque of motor 904 at such a time. Therefore, when motor 904 has stopped suddenly or when motor 904 has been stopped by a collision in conventional motor control device 900, the gravity shaft bounces or falls when power starts to be supplied to motor 904, which poses a risk that the arm collides with peripheral devices or workers.

[0021] Hereinafter, an embodiment of the present disclosure will be described with reference to FIG. 1 to FIG. 5.

[0022] FIG. 1 illustrates motor control device 21 according to the present disclosure. The case where motor 24 has been attached to robot 100 will be described.

[0023] Encoder 25 detects the position of the rotor of motor 24 at a predetermined sampling period, and transmits detected positional information D1 of motor 24 to converter 26. Converter 26 calculates the rotational velocity of the rotor of motor 24 from the temporal change in positional information D1 transmitted from encoder 25. The rotational velocity calculated by converter 26 is transmitted as feedback velocity V.sub.FB to PI controller 22. Moreover, converter 26 transmits feedback velocity V.sub.FB and positional information D1 to calculation unit 31.

[0024] Calculation unit 31 receives: specification information D2 including information of the weight and the center of mass of a tool; positional information D1 of motor 24; and feedback velocity VFB. Moreover, when robot 100 includes another motor (not illustrated) in addition to motor 24, feedback velocity VFB_2 based on the positional information of the other motor and positional information D1_2 of the other motor are also input to calculation unit 31 from another control block. Calculation unit 31 calculates gravitational torque TG which acts on motor 24, and transmits gravitational torque TG to storage 27.

[0025] PI controller 22 includes proportional component calculation unit 29 and integral component calculation unit 30. Proportional component calculation unit 29 and integral component calculation unit 30 each receive error velocity dV which is the difference between velocity command VCOM and feedback velocity VFB. Integral value VI calculated by integral component calculation unit 30 is added to the value calculated by proportional component calculation unit 29 based on error velocity dV, so that torque command value TCOM is output from PI controller 22 to current controller 23. Storage 27 receives break signal BSIG to be input to breaking device 28, integral value VI output from integral component calculation unit 30, and gravitational torque TG output from calculation unit 31. Storage 27 then stores integrated value VI output from integral component calculation unit 30 and gravitational torque TG. Storage 27 then transmits, to selection unit 32, integral value VI and gravitational torque TG obtained when brake signal BSIG is changed from ON to OFF.

[0026] Selection unit 32 receives integral value VI of torque command value TCOM and gravitational torque TG output from storage 27, and transmits the value set by selection unit 32 to integral component calculation unit 30 of PI controller 22.

[0027] Moreover, the value set when brake signal BSIG is changed from ON to OFF is transmitted from selection unit 32 to integral component calculation unit 30 of PI controller 22.

[0028] Current controller 23 receives torque command value TCOM from PI controller 22. Moreover, current controller 23 receives motor-generated torque TFB. Current controller 23 calculates drive command value DCOM, and supplies current to motor 24 based on drive command value DCOM. In such a manner, current controller 23 controls the driving of motor 24.

[0029] [Operation of Collision Detector 200]

[0030] Next, collision sensitivity will be described with reference to FIG. 1 and FIG. 3. As illustrated in FIG. 3, in the collision detection function, calculation unit 31 calculates, in advance, the torque which originally acts on motor 24 as dynamic torque TD from positional information D1 of motor 24 that can be obtained from encoder 25, information of the velocity and acceleration (here, feedback velocity VFB), and specification information D2 such as the mass of the tool and the robot body. Collision detector 200 then compares, with collision detection threshold Vt, collision detection torque TC which is the difference between motor-generated torque TFB which has actually acted on motor 24 under the control of current controller 23 and dynamic torque TD. Note that collision detection threshold Vt is determined according to collision sensitivity X set in advance. When collision detection torque TC is greater than or equal to collision detection threshold Vt, collision detection result R indicates that a collision has occurred. Moreover, collision sensitivity X can be set by a user. The range of the threshold is set according to the sensitivity, so that a collision is correctly detected while preventing a false detection of a collision.

[0031] Next, a specific example of an operation of collision detector 200 will be described with reference to FIG. 4. In the example illustrated in FIG. 4, when collision detection torque TC (maximum torque ratio) is 20%, if collision sensitivity X is set to 20%, 50%, or 80%, a collision is not detected. In contrast, when collision sensitivity X is set to 100%, a collision is detected. In other words, collision detection threshold Vt is set to a value in a range from greater than or equal to 80% to less than 100% of collision sensitivity X.

[0032] When collision detection torque TC (maximum torque ratio) is 30%, an operation is performed in a similar manner to the operation performed when collision detection torque TC is 20%.

[0033] When collision detection torque TC (maximum torque ratio) is 40%, collision detection threshold Vt is set to a value in a range from greater than or equal to 50% to less than 80% of collision sensitivity X. Hence, for example, when collision sensitivity X is set to 50%, a collision is not detected, but when collision sensitivity X is set to 80%, a collision is detected.

[0034] When collision detection torque TC (maximum torque ratio) is 50%, collision detection threshold Vt is set to a value in a range from greater than or equal to 20% to less than 50% of collision sensitivity X. Hence, for example, when collision sensitivity X is set to 20%, a collision is not detected, but when collision sensitivity X is set to greater than or equal to 50%, a collision is detected.

[0035] FIG. 4 illustrates an example of a relationship between collision sensitivity X and collision detection torque TC. Note that when collision detection threshold Vt is set differently, the relationship between collision detection torque TC and collision sensitivity X is different from FIG. 4. When the collision sensitivity is set to be higher, the frequency of the detection of a collision increases, and when the collision sensitivity is set to be lower, the frequency of the detection of a collision decreases.

[0036] For example, when the collision sensitivity is set to be higher, even if a small impact is made, a collision is detected. In contrast, when the collision sensitivity is set to be lower, a small impact is not considered as a collision.

[0037] Moreover, when a collision torque is detected when power starts to be supplied to motor 24, the magnitude of collision detection threshold Vt is determined according to collision sensitivity X which has been set. Accordingly, it can be said that collision sensitivity X which has been set indicates the accuracy of load information. Note that collision sensitivity X can be arbitrarily set to specification information input unit 300 by a user in advance.

[0038] [Description of Operation of Selection Unit 32]

[0039] Next, an operation of selection unit 32 will be specifically descried with reference to FIG. 1 and FIG. 2. In selection unit 32, when break signal BSIG is changed from ON to OFF (S1), storage 27 receives integral value VI from integral component calculation unit 30 and gravitational torque TG from calculation unit 31 (S2). Next, integral value VI and gravitational torque TG are input to selection unit 32 from storage 27 (S3). Selection unit 32 compares integration value VI and gravitational torque TG which have been input (S4). When the difference between integral value VI and gravitational torque TG is greater than a predetermined value (YES in S4), it is considered that motor 904 has stopped suddenly or motor 904 has been stopped by a collision. Here, an unloaded gravitational torque Ta is output to integral component calculation unit 30 of PI controller 22 (S5).

[0040] Next, when the difference between integral value VI and gravitational torque TG is equal to or less than the predetermined value (NO in S4), selection unit 32 outputs, to integral component calculation unit 30, the gravitational torque corresponding to collision sensitivity X output from specification information input unit 300 (S6 to S8).

[0041] Next, S6 to S8 will be described with reference to FIG. 2 and FIG. 5. When collision sensitivity X is less than 20%, selection unit 32 outputs unloaded gravitational torque Ta to integral component calculation unit 30 of PI controller 22 (S6). When collision sensitivity X is greater than 80%, selection unit 32 outputs loaded gravitational torque Tb to integral component calculation unit 30 of PI controller 22 (S7). When collision sensitivity X is greater than or equal to 20% and less than or equal to 80%, as illustrated in FIG. 5, loaded gravitational torque Tb is output when collision sensitivity X is 80% and unloaded gravitational torque Ta is output when collision sensitivity X is 20%. When collision sensitivity X is greater than or equal to 20% and less than or equal to 80%, selection unit 32 outputs, to integral component calculation unit 30 of PI controller 22, the gravitational torque corresponding to the set sensitivity along the straight line passing through points A and B (S8).

[0042] Note that the user arbitrarily sets collision sensitivity X in advance to specification information input unit 300. Moreover, the user sets load information as specification information D2 in advance to specification information input unit 300. Subsequently, as described above, the user can reset specification information D2 according to collision detection result R of collision detector 200.

[0043] As described above, PI controller 22 uses, as a holding torque, the value input by selection unit 32 to integral component calculation unit 30 according to collision sensitivity X. Therefore, even when motor 24 has stopped suddenly or has been stopped by a collision, it is possible to prevent the gravity shaft from bouncing or falling when break signal BSIC is changed from OFF to ON again (when power starts to be supplied to the motor).

SUMMARY

[0044] Motor control device 21 according to the present disclosure includes PI controller 22, specification information input unit 300, calculation unit 31, storage 27, and selection unit 32.

[0045] PI controller 22 controls the velocity of the motor. Specification information input unit 300 receives specification information D2 including information of the weight and the center of mass of the tool. Calculation unit 31 calculates gravitational torque TG based on specification information D2. Storage 27 stores gravitational torque TG output from calculation unit 31 and integral value VI output from PI controller 22. Storage 27 further outputs gravitational torque TG and integral value VI in response to break signal BSIG. Selection unit 32 sets, to PI controller 22, integral value VI input from storage unit 27, according to collision sensitivity X input from specification information input unit 300.

[0046] Moreover, in motor control device 21 according to the present disclosure, specification information D2 includes load information, and when it is determined based on the load information of specification information D2 that no tool has been attached, selection unit 32 sets, to PI controller 22, unloaded gravitational torque as integral value VI. When it is determined based on the load information of specification information D2 that a tool has been attached, selection unit 32 sets, to PI controller 22, loaded gravitational torque as integral value VI.

[0047] Note that specification information D2 can be arbitrarily set by a user.

INDUSTRIAL APPLICABILITY

[0048] Motor control device 21 according to the present disclosure can prevent the gravity shaft from bouncing or falling when power starts to be supplied to the motor, even when the motor has stopped suddenly or the motor has been stopped by a collision. Hence, motor control device 21 according to the present disclosure is industrially useful.

REFERENCE MARKS IN THE DRAWINGS

[0049] 21 motor control device [0050] 22 PI controller [0051] 23 current controller [0052] 24 motor [0053] 25 encoder [0054] 26 converter [0055] 27 storage [0056] 28 breaking device [0057] 29 proportional component calculation unit [0058] 30 integral component calculation unit [0059] 31 calculation unit [0060] 32 selection unit [0061] 100 robot [0062] 200 collision detector [0063] 300 specification information input unit [0064] 900 motor control device [0065] 901 PI controller [0066] 902 current controller [0067] 903 inverter circuit [0068] 904 motor [0069] 905 encoder [0070] 906 converter [0071] 907 storage [0072] 908 breaking device [0073] 911 proportional component calculation unit [0074] 912 integral component calculation unit [0075] dV error velocity [0076] BSIG break signal [0077] D1 positional information [0078] D2 specification information [0079] DCOM drive command value [0080] Ta unloaded gravitational torque [0081] Tb loaded gravitational torque [0082] TG collision detection torque [0083] TD dynamic torque [0084] TG gravitational torque [0085] TFB motor-generated torque [0086] TCOM torque command value [0087] R collision detection result [0088] VCOM velocity command [0089] VFB feedback velocity [0090] I.sub.FB feedback current [0091] X collision sensitivity [0092] Vt collision detection threshold [0093] VI integral value