Brake abnormality detection system and brake abnormality detection method for twin-motor driven robot

Abstract

To provide a brake abnormality detection system in a twin motor drive robot, which can accurately detect an abnormality of an exciting brake for a slave shaft in the twin motor drive robot.SOLUTION: This brake abnormality detection system comprises: an operation instruction unit that gives a minute operation instruction to a master shaft 12A in a state where each of servo motors 12A and 12B is excited and each of exciting brakes 11A and 11B of the master shaft and a slave shaft is released; and an abnormality detection unit that detects an operation amount of the slave shaft 12B when the slave shaft is minutely operated following the minute operation instruction of the master slave 12A in a controlled manner, and detects, through comparison with a reference value, an abnormality of the exciting brake 11B of the slave shaft 12B.SELECTED DRAWING: Figure 3

Description

[Technical Field]

[0001] The present invention relates to a brake abnormality detection system and a brake abnormality detection method for a twin-motor driven robot. [Background technology]

[0002] Generally, industrial robots are equipped with motors equipped with brakes, which are used to maintain the robot's position when the motor is cut off.

[0003] The industrial robot also has a vertical articulated robot arm with multiple joints supported on a base. The robot arm is composed of multiple joints connected in sequence. An end effector is attached to the tip of the robot arm. Each joint is provided with a motor with an electromagnetic brake, which is an example of an actuator that rotates the two members connected to it relatively. Note that hereinafter, the electromagnetic brake will be simply referred to as a brake.

[0004] In a motor with a brake, if deposits (such as grease) adhere to the brake's friction plate, the braking torque required for the brake will drop significantly, and when the motor excitation is cut off, the robot, for example, the robot arm, may not be able to maintain its posture. This is a brake abnormality in which the brake does not work properly due to deposits, causing the motor to move even though the brake is operating. It is well known that a brake malfunction may occur when the brake is activated even though the brake is not activated, causing the motor to stop moving.

[0005] There are several known methods for detecting such a brake abnormality. For example, Patent Document 1 discloses a well-known system that diagnoses whether there is an abnormality in the brake based on a position deviation when the motor is excited and the brake is operating, in order to deal with the above-mentioned malfunction in which the brake does not operate even though it is operated.

[0006] Patent Document 2 discloses that, in order to deal with the above-mentioned problem of the brake not working even though it is being operated, the current supplied to the motor is gradually increased while the brake is closed, and the brake torque estimated from that current is compared with a reference angle to diagnose whether there is an abnormality in the brake.

[0007] Furthermore, Patent Document 3 discloses a system that measures the voltage when the brake is released and compares it with a reference value to diagnose whether or not there is a brake abnormality, in order to deal with both of the above-mentioned brake abnormalities. [Prior art documents] [Patent documents]

[0008] [Patent Document 1] Japanese Patent Application Laid-Open No. 2014-010546 [Patent Document 2] Patent No. 6545418 [Patent Document 3] Japanese Patent Application Publication No. 2018-099748 Summary of the Invention [Problem to be solved by the invention]

[0009] Incidentally, when a large torque is required for the rotation shaft of an arm in a robot, for example, there is a configuration in which the rotation of two motors is linked to generate twice the torque. In such a so-called twin-motor driven robot, the abnormality diagnosis systems shown in Patent Documents 1 to 3 cannot be applied to the slave axis.

[0010] This is because a twin-motor drive robot has a master axis (servo motor) to which position commands are given, and a slave axis (servo motor) that follows the master axis, but the slave axis is only current controlled and has no position command, so abnormality detection based on position deviation as in the example above cannot be applied.

[0011] Furthermore, from a control perspective, the master axis and slave axis move simultaneously, and it is not possible to pass current to only one of them. Furthermore, the two are connected via a reducer and the manipulator output shaft, so movement of one axis affects the other. This makes it difficult to diagnose brake abnormalities on the slave axis.

[0012] Therefore, the main object of the present invention is to provide a brake abnormality detection system and a brake abnormality detection method for a twin-motor driven robot that can accurately detect brake abnormalities such as the brake being activated on the slave axis of a twin-motor driven robot, causing the motor to stop moving even though the brake is not activated. [Means for solving the problem]

[0013] The aspects of the present invention that solve the above problems are as follows. <First aspect> A brake abnormality detection system for a twin-motor-driven robot according to one aspect of the present invention is a brake abnormality detection system for a twin-motor-driven robot in which a master axis of a servo motor equipped with an excitation brake and a slave axis of a servo motor equipped with an excitation brake are each connected to a manipulator output axis via a reducer, and the system includes: a motion command unit that issues a micro-motion command to the master axis when each of the servo motors is excited and the excitation brakes of the master axis and the slave axis are each released; and an abnormality detection unit that detects the amount of movement of the slave axis when the slave axis is subjected to micro-motion in controlled accordance with the micro-motion command of the master axis, and compares this with a reference value to detect an abnormality in the excitation brake of the slave axis.

[0014] <Second aspect> In one aspect of the present invention, a method for detecting a brake abnormality in a twin-motor-driven robot is provided in a twin-motor-driven robot in which a master axis of a servo motor equipped with an excitation brake and a slave axis of a servo motor equipped with an excitation brake are each connected to a manipulator output axis via a reducer. With each servo motor excited and the brakes of the master axis and the slave axis respectively released, a micro-motion command is given to the master axis, and the amount of movement of the slave axis when the slave axis is caused to perform a micro-motion in controlled accordance with the micro-motion command of the master axis is detected, and this amount is compared with a reference value to detect an abnormality in the excitation brake of the slave axis. [Effects of the Invention]

[0015] According to the present invention, it is possible to provide a brake abnormality detection system and a brake abnormality detection method for a twin-motor driven robot that can accurately detect brake abnormalities such as the brake being activated on the slave axis of a twin-motor driven robot, causing the motor to stop moving even though the brake is not activated. [Brief explanation of the drawings]

[0016] [Figure 1] FIG. 1 is a schematic explanatory diagram of the excited state of a non-excitation operated motor with a brake. [Figure 2] FIG. 1 is a schematic explanatory diagram of a non-excitation operating type brake-equipped motor in a non-excitation state. [Figure 3] FIG. 1 is a schematic diagram of a connection state in a twin-motor drive robot. [Figure 4] This is a flow chart of the control system. DETAILED DESCRIPTION OF THE INVENTION

[0017] Hereinafter, embodiments of the present invention will be described with reference to the drawings. To facilitate understanding of the description, the same components and steps in the drawings will be denoted by the same reference numerals as much as possible, and redundant description will be omitted.

[0018] First, referring to FIG. 1, a motor with a brake of the non-excitation type will be described. A brake 2 is provided for a motor 1 having an output shaft 3 .

[0019] The brake 2 includes a brake pad 4, an excitation coil 6, and a mechanical spring 5 interposed therebetween.

[0020] When current flows through the excitation coil 6, the brake pad 4 is attracted by the magnetic force of the excitation coil 6, as shown in Figure 1, and the brake pad 4 moves to the release position, causing the output shaft 3 to be released.

[0021] In contrast, when the current to the excitation coil 6 is cut off, the magnetic force of the excitation coil 6 becomes zero, as shown in Figure 2, and the brake pad 4 moves to the clamping position due to the elastic force of the mechanical spring 5, and the output shaft 3 is clamped.

[0022] When a large torque is required for the rotation shaft of a robot arm, two motors can be coupled to generate twice the torque. In this configuration, a pair of non-excitation type brake-equipped motors, as described above, are provided.

[0023] Specifically, for example, as shown in FIG. 3, a servo motor 12A constituting a master axis with a brake 11A constituting the brake 2, and a servo motor 12B constituting a slave axis with a brake 11B constituting the brake 2 are connected to the manipulator output shaft 14 via a reducer 13A and a reducer 13B, respectively.

[0024] 4, for servo motor 12A constituting the master axis, a position command signal is given from control unit 20 to the servo unit, a position calculation is performed, a speed calculation is performed based on the speed command, the actual current value to be applied is calculated, and the current value is given to servo motor 12A as an output to the motor. The current value given to servo motor 12B is determined based on the current value given to servo motor 12A.

[0025] For example, in a control system configured in this manner, the current position from an encoder (rotational position detector) 15A attached to the servo motor 12A and the current position from an encoder (rotational position detector) 15B attached to the servo motor 12B are constantly input into the control unit 20, and target position control is performed.

[0026] An abnormality in the brake 11B of the servo motor 12B that constitutes the slave axis is detected as follows. In a state where the servo motors 12A and 12B are excited and the brakes 11A and 11B are released, as shown in FIG. 4, the motion command unit 21 issues a minute motion command only to the master axis (servo motor 12A).

[0027] As a result, part of the current of the minute movement command flows to the slave axis (servo motor 12B), and the slave axis performs minute movements in a controlled manner following the minute movement command of the master axis. The amount of movement of the slave axis (servo motor 12B) during this minute movement is detected by, for example, an encoder (rotational position detector) 15B, and compared with a reference value of the amount of movement to detect an abnormality. For this purpose, the control unit 20 is provided with an abnormality detection unit 22.

[0028] For example, if the amount of minute movement of the slave axis is greater than a reference value, it is determined that the slave axis brake 11B is not faulty. Also, if the amount of minute movement is 0 or less than the reference value, it is possible to determine that the slave axis brake 11B is not released and that a brake failure has occurred.

[0029] It is desirable that the minute movement command is absorbed by the reducers 13A and 13B and the manipulator output shaft 14 and is at a level that does not have a physical effect on the slave shaft 12B.

[0030] As described above, it is possible to detect brake abnormalities and failures on the slave side of a twin-motor drive robot. In addition, it is possible to prevent the robot from stopping due to a secondary failure caused by the failure. [Industrial Applicability]

[0031] The present invention can be applied to industrial robots such as articulated robots as well as machine tools, and these are also included in the scope of the present invention. [Explanation of symbols]

[0032] 1...motor, 2...excitation brake, 3...output shaft, 4...brake pad, 5...mechanical spring, 6...excitation coil 6, 11A...excitation brake attached to master axis, 11B...excitation brake attached to slave axis, 12A...servo motor (master axis), 12B...servo motor (slave axis), 13A, 13B...reduction gear, 14...manipulator output shaft, 15A, 15B...encoder, 20...control unit, 21...operation command unit, 22...abnormality detection unit, 30...servo unit, X...servo control device

Claims

1. In a brake abnormality detection system for a twin-motor drive robot in which a master axis of a servo motor equipped with an excitation brake and a slave axis of a servo motor equipped with an excitation brake are connected to a manipulator output axis via a reducer, an operation command unit that issues a minute operation command to the master axis in a state in which each of the servo motors is excited and the excitation brakes of the master axis and the slave axis are released; an abnormality detection unit that detects an amount of movement of the slave axis when the slave axis is caused to move slightly in accordance with the minute movement command of the master axis in a controlled manner, and compares the amount of movement with a reference value to detect an abnormality in the electromagnetic brake of the slave axis; A brake abnormality detection system for a twin-motor drive robot, comprising:

2. 2. The brake abnormality detection system for a twin-motor driven robot according to claim 1, wherein the minute movement command is absorbed by the reducer and the manipulator output shaft, and is at a level that does not affect physical tracking of the slave shaft.

3. In a twin-motor drive robot in which a master axis of a servo motor with an excitation brake and a slave axis of a servo motor with an excitation brake are connected to a manipulator output axis via a reducer, a minute movement command is given to the master axis in a state where each of the servo motors is excited and the brakes of the master axis and the slave axis are released, a brake abnormality detection method for a twin-motor driven robot, the method comprising: detecting an amount of movement of the slave axis when the slave axis is caused to perform a micro-movement in controlled accordance with the micro-movement command of the master axis; and comparing the amount of movement of the slave axis with a reference value to detect an abnormality in the electromagnetic brake of the slave axis.

Images