BRAKE ABNORMALITY DETECTION SYSTEM AND BRAKE ABNORMALITY DETECTION METHOD IN TWIN-MOTOR-DRIVEN ROBOT

Abstract

An operation controller configured to give a fine operation command to a master shaft in a state in which servomotors are excited and respective excitation brakes of the master shaft and the slave shaft are released, and an abnormality detector configured to perform detection of an abnormality of the excitation brake of the slave shaft by detecting an operation amount of the slave shaft that is obtained when the slave shaft is finely operated in accordance with the fine operation command to the master shaft in a controlled manner, and comparing the operation amount with a reference value are included.

Claims

1. A brake abnormality detection system in a twin-motor-driven robot including a master shaft of a servomotor equipped with an excitation brake, and a slave shaft of a servomotor equipped with an excitation brake, which are connected with a manipulator output shaft via respective decelerators, the brake abnormality detection system comprising: an operation controller configured to give a fine operation command to the master shaft in a state in which the servomotors are excited and the respective excitation brakes of the master shaft and the slave shaft are released; and an abnormality detector configured to perform detection of an abnormality of the excitation brake of the slave shaft by detecting an operation amount of the slave shaft that is obtained when the slave shaft is finely operated in accordance with the fine operation command to the master shaft in a controlled manner, and comparing the operation amount with a reference value.

2. The brake abnormality detection system in a twin-motor-driven robot according to claim 1, wherein the fine operation command is at a level of being absorbed into the decelerators and the manipulator output shaft, and not causing the slave shaft to perform physical following.

3. A brake abnormality detection method in a twin-motor-driven robot including a master shaft of a servomotor equipped with an excitation brake, and a slave shaft of a servomotor equipped with an excitation brake, which are connected with a manipulator output shaft via respective decelerators, the brake abnormality detection method comprising: giving a fine operation command to the master shaft in a state in which the servomotors are excited and the respective excitation brakes of the master shaft and the slave shaft are released; and performing detection of an abnormality of the excitation brake of the slave shaft by detecting an operation amount of the slave shaft that is obtained when the slave shaft is finely operated in accordance with the fine operation command to the master shaft in a controlled manner, and comparing the operation amount with a reference value.

Description

BRIEF DESCRIPTION OF DRAWINGS

[0023] FIG. 1 is a diagram illustrating an overview of an excited state of a non-excitation actuated-type brake-equipped motor;

[0024] FIG. 2 is a diagram illustrating an overview of a non-excited state of a non-excitation actuated-type brake-equipped motor;

[0025] FIG. 3 is a diagram illustrating an overview of a coupled state in a twin-motor-driven robot; and

[0026] FIG. 4 is a flowsheet of a control system.

DETAILED DESCRIPTION

[0027] Hereinafter, an embodiment of the present invention will be described with reference to the drawings. In addition, to facilitate the understanding of description, the same components and steps in the drawings are assigned the same reference signs as far as possible, and the redundant description will be omitted.

[0028] First of all, a non-excitation actuated-type brake-equipped motor will be described with reference to FIG. 1. A brake 2 is provided for a motor 1 having an output shaft 3.

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

[0030] If current flows to the excitation coil 6, as illustrated in FIG. 1, the brake pad 4 is attracted by magnetic force of the excitation coil 6, the brake pad 4 moves up to a release position, and the output shaft 3 enters a released state.

[0031] In contrast to this, if current to the excitation coil 6 is blocked, as illustrated in FIG. 2, magnetic force of the excitation coil 6 becomes 0, the brake pad 4 moves to a clamp position by elastic force of the mechanical spring 5, and the output shaft 3 enters a clamped state.

[0032] There is a configuration of coupling rotations of two motors and generating a double torque in a case where a large torque is required for a rotational shaft of an arm in a robot. In this configuration, a pair of non-excitation actuated-type brake-equipped motors in the above-described example is provided.

[0033] Specifically, for example, as illustrated in FIG. 3, a servomotor 12A provided with a master shaft equipped with a brake 11A constituting the brake 2, and a servomotor 12B constituting a slave shaft equipped with a brake 11B constituting the brake 2 are connected with a manipulator output shaft 14 via a decelerator 13A and a decelerator 13B, respectively.

[0034] Referring also to a control flow of a servo control device X in FIG. 4, as for the servomotor 12A provided with the master shaft, a position command signal is given from a controller 20 to a servo member 30, position calculation is performed, speed calculation is performed based on a speed command, calculation of a current value to be actually given is performed, and the current value is given to the servomotor 12A as an output to the motor. A current value to be given to the servomotor 12B is determined based on the current value to be given to the servomotor 12A.

[0035] For example, in a control system having such a configuration, target position control is performed while a current position information from an encoder (rotational position detector) 15A attached to the servomotor 12A, and a current position information from an encoder (rotational position detector) 15B attached to the servomotor 12B, being momentarily taken into the controller 20.

[0036] Abnormality detection of the brake 11B of the servomotor 12B constituting the slave shaft is performed as follows.

[0037] In a state in which the servomotor 12A and the servomotor 12B are excited and the brakes 11A and 11B are released, as illustrated in FIG. 4, a fine operation command is given from an operation controller 21 only to the master shaft (the servomotor 12A).

[0038] Consequently, a part of current of the fine operation command flows to the servomotor 12B provided with the slave shaft, and the slave shaft finely operates in accordance with the fine operation command to the master shaft in a controlled manner.

[0039] Abnormality detection is performed by detecting an operation amount of the slave shaft (the servomotor 12B) that is obtained when the slave shaft performs the fine operation, using the encoder (rotational position detector) 15B, for example, and comparing the detected operation amount with a reference value of an operation amount. The controller 20 includes an abnormality detector 22 for the detection.

[0040] For example, if a fine operation amount of the slave shaft is larger than the reference value, it is determined that the brake 11B for the slave shaft has no failure.

[0041] Alternatively, if the fine operation amount is 0 or equal to or smaller than the reference value, a brake failure can be determined assuming that the brake 11B for the slave shaft is not released.

[0042] In addition, it is desirable that the fine operation command is at a level of being absorbed into the decelerators 13A and 13B, and the manipulator output shaft 14, and not exerting physical influence on the slave shaft 12B.

[0043] As described above, a slave side brake abnormality and a failure in a twin-motor-driven robot can be detected.

[0044] Moreover, a robot stop caused by a secondary failure attributed to this can be prevented before the robot stop happens.

[0045] The present invention can be applied to a working machine and the like in addition to an industrial robot such as a multijoint robot, and the present invention also includes these as targets.