An abnormality detection device for detecting an abnormality in a power transmission mechanism that transmits the rotational force output by an electric motor

The abnormality detection device in power transmission mechanisms uses rotational position detectors to monitor and control electric motors, addressing wear-related failures by detecting abnormalities before they cause breakdowns, ensuring continuous machine operation.

JP7583062B2Active Publication Date: 2024-11-13FANUC LTD
View PDF 7 Cites 0 Cited by

Patent Information

Application Number
JP2022561917
Authority / Receiving Office
JP · JP
Patent Type
Patents
Current Assignee / Owner
Priority Date
2020-11-12
Filing Date
2021-11-08
Publication Date
2024-11-13
Estimated Expiration
2041-11-08

AI Technical Summary

Technical Problem

Existing power transmission mechanisms in machines using electric motors, such as reduction gears in robots, suffer from wear and tear leading to looseness and potential breakdowns, which can cause unexpected failures disrupting production or operation.

Method used

An abnormality detection device using first and second rotational position detectors and an operation control unit to monitor the rotational angles of the input and output shafts, detecting abnormalities in the power transmission mechanism by comparing the angles and controlling the electric motor to maintain positional accuracy, thereby identifying wear and potential failures before they occur.

Benefits of technology

Accurately detects abnormalities in power transmission mechanisms, allowing for proactive maintenance and preventing unexpected breakdowns, thus ensuring continuous operation of machines.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 0007583062000001
    Figure 0007583062000001
  • Figure 0007583062000002
    Figure 0007583062000002
  • Figure 0007583062000003
    Figure 0007583062000003
Patent Text Reader

Abstract

This abnormality detection device is provided with a first encoder for detecting the rotation angle of an input shaft of a decelerator, and a second encoder for detecting the rotation angle of an output shaft of the decelerator. An operation control unit controls a servo motor such that the position acquired from the output of the second encoder corresponds to a position determined by an operation program. A detection unit calculates the angle difference, which is the difference between the rotation angle acquired from output of the first encoder and the rotation angle acquired from output of the second encoder. The detection unit determines whether or not the decelerator is abnormal on the basis of the angle difference.
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to an abnormality detection device that detects an abnormality in a power transmission mechanism that transmits a torque output by an electric motor. [Background technology]

[0002] The torque output from the electric motor is transmitted to another member via a power transmission mechanism, such as a reducer that amplifies the torque output from the electric motor and transmits it to another member.

[0003] When a power transmission mechanism such as a reducer is used for a long period of time, the internal parts deteriorate and break down. In the prior art, it is known to detect an abnormality in the power transmission mechanism by attaching a sensor to the machine to detect the failure or by analyzing a command value output by a control device to drive an electric motor (for example, JP-A-63-145507, JP-A-2013-152166, and JP-A-2006-102889).

[0004] In addition, in the prior art, a control is known in which a rotation angle is obtained from an encoder attached to an electric motor, and a tooth skip of a gear arranged inside a reducer is detected based on the rotation angle (for example, JP 2020-104177 A and WO 2014 / 098008 A). In addition, as a method of using an encoder attached to a motor, a control is known in which an encoder is placed on the output shaft of the reducer to correct a position shift caused by a twist occurring in the reducer (for example, JP 2012-171069 A). [Prior art documents] [Patent documents]

[0005] [Patent Document 1] Japanese Patent Application Laid-Open No. 63-145507 [Patent Document 2] JP 2013-152166 A [Patent Document 3] JP 2006-102889 A [Patent Document 4] JP 2020-104177 A [Patent Document 5] International Publication No. 2014 / 098008 [Patent Document 6] JP 2012-171069 A Summary of the Invention [Problem to be solved by the invention]

[0006] Electric motors and power transmission mechanisms are used in many machines. For example, in a multi-joint robot, a mechanism is known in which a reduction gear reduces the torque output by an electric motor at each joint to rotate a member such as an arm.

[0007] The internal parts of the power transmission mechanism are driven while in contact with each other. The internal parts of the power transmission mechanism may wear out. This results in greater play between the internal parts. For example, wear on gears increases the backlash between the gears. If the wear on the internal parts progresses, the power transmission device will break down and become unusable.

[0008] Machines may be used in production lines that manufacture products. In this case, if the machine suddenly breaks down, it will have a significant impact on the production line in which the machine is used. Or, if an electric motor and a power transmission mechanism are used in a conveyor, if the conveyor breaks down, it will be impossible to carry out the desired conveyance. It is preferable that machines equipped with an electric motor and a power transmission mechanism do not break down at unexpected times. It is preferable to be able to detect an abnormality in the power transmission mechanism before a breakdown occurs that makes the machine unusable. [Means for solving the problem]

[0009] The abnormality detection device according to the first aspect of the present disclosure detects the rotational force output by the electric motor. For other materials The abnormality detection device detects abnormalities in the power transmission mechanism that transmits the power. The torque of the motor is input.a first rotational position detector for detecting a rotation angle of the input shaft; Output rotational force to other components The abnormality detection device includes a second rotational position detector for detecting a rotation angle of the output shaft, and an operation control unit for controlling the operation of the electric motor. The abnormality detection device includes a detection unit for detecting an abnormality in the power transmission mechanism based on the output of the first rotational position detector and the output of the second rotational position detector. The operation control unit controls the electric motor so that a position acquired from the output of the second rotational position detector corresponds to a position defined in the operation program. The detection unit includes a variable setting unit for setting a variable including an angle difference that is a difference between the rotation angle acquired from the output of the first rotational position detector and the rotation angle acquired from the output of the second rotational position detector, based on the output of the first rotational position detector, the output of the second rotational position detector, and the reduction ratio of the power transmission mechanism. The detection unit includes a determination unit for determining whether or not the power transmission mechanism is abnormal based on the variable.

[0010] The abnormality detection device according to the second aspect of the present disclosure detects the rotational force output by the electric motor. For other materials The abnormality detection device detects abnormalities in the power transmission mechanism that transmits the power. The torque of the motor is input. a first rotational position detector for detecting a rotation angle of the input shaft; Output rotational force to other components The abnormality detection device includes a second rotational position detector for detecting a rotation angle of the output shaft, and an operation control unit for controlling the operation of the electric motor. The abnormality detection device includes a detection unit for detecting an abnormality in the power transmission mechanism based on the output of the first rotational position detector. The operation control unit controls the electric motor so that a position acquired from the output of the second rotational position detector corresponds to a position defined in the operation program. The detection unit includes a variable setting unit for setting a variable that does not include the rotation angle acquired from the output of the second rotational position detector, but includes the rotation angle acquired from the output of the first rotational position detector. The detection unit includes a determination unit for determining whether or not the power transmission mechanism is abnormal based on the variable. Effect of the Invention

[0011] According to an aspect of the present disclosure, it is possible to provide an abnormality detection device that accurately detects an abnormality in a power transmission mechanism. [Brief description of the drawings]

[0012] [Figure 1] 1 is a schematic diagram of a robot according to an embodiment. [Diagram 2] FIG. 1 is a block diagram of a robot device according to an embodiment. [Diagram 3] FIG. 2 is an enlarged partial cross-sectional view of a joint of the robot according to the embodiment. [Figure 4] 4 is a graph showing an operation pattern of a servo motor. [Diagram 5] 1 is a graph showing the rotation angle based on the output of an encoder when the reducer is new. [Figure 6] 13 is a graph showing the rotation angle based on the output of the encoder when wear of the gears of the reducer progresses. [Figure 7] FIG. 7 is an enlarged view of part A in FIG. [Figure 8] FIG. 1 is a first enlarged cross-sectional view of the area where the teeth of two gears contact. [Figure 9] FIG. 11 is a second enlarged cross-sectional view of the area where the teeth of the two gears contact. [Figure 10] 13 is a first graph of a variable for determining an abnormality in a reducer versus the number of times a task is performed by a robot apparatus. [Figure 11] 13 is a second graph of the variable versus the number of executions of the task of the robotic device. [Figure 12] 13 is a graph showing an increase in a variable with respect to the number of times a task is performed by a robot device. [Figure 13] 11 is a graph illustrating control for predicting when an abnormality will occur in a reducer based on a change in a variable. [Figure 14] 10 is a graph showing another operation pattern of the servo motor. [Figure 15] 11 is a side view of the robot illustrating an operation for calculating a proportionality constant between the torque acting on the reducer and the torsion angle of the reducer. FIG. [Figure 16] 6 is a graph illustrating control for detecting an abnormality based on the output of a first encoder. [Figure 17] FIG. 17 is an enlarged view of part B in FIG. [Figure 18] 10 is a graph showing a rotation angle in an initial state obtained from an output of a first encoder and a rotation angle after long-term driving. [Figure 19] FIG. 11 is a side view of a machine illustrating another power transmission mechanism according to an embodiment. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0013] With reference to Fig. 1 to Fig. 19, an abnormality detection device for detecting an abnormality in a power transmission mechanism in an embodiment will be described. The power transmission mechanism transmits a rotational force output by an electric motor to another member. The electric motor and the power transmission mechanism are arranged in various machines such as a machine for transporting an object, a machine for moving an object, or a machine for manufacturing an object. In this embodiment, a robot will be taken as an example of the machine and a reducer arranged in a joint of the robot will be taken as an example of the power transmission mechanism and described.

[0014] Fig. 1 is a schematic diagram of a robot device according to the present embodiment. Fig. 2 is a block diagram of the robot device according to the present embodiment. With reference to Figs. 1 and 2, a robot device 5 according to the present embodiment transports a workpiece. The robot device 5 includes a hand 2 as a working tool for gripping the workpiece, and a robot 1 for moving the hand 2. The robot 1 according to the present embodiment is a multi-joint robot including a plurality of joints 18a, 18b, 18c.

[0015] The robot 1 includes a base unit 14 fixed to an installation surface and a swivel base 13 supported by the base unit 14. The swivel base 13 rotates relative to the base unit 14. The robot 1 includes an upper arm 11 and a lower arm 12. The lower arm 12 is supported by the swivel base 13 via a joint unit 18a. The upper arm 11 is supported by the lower arm 12 via a joint unit 18b. The robot 1 includes a wrist 15 connected to an end of the upper arm 11. The wrist 15 is supported by the upper arm 11 via a joint unit 18c. The wrist 15 includes a flange 16 to which the hand 2 is fixed.

[0016] Each of the components, such as the upper arm 11 and the lower arm 12, is formed to rotate around a predetermined drive shaft. The robot 1 of this embodiment has six drive shafts. The robot 1 includes a servo motor 27 and a reducer 30 as electric motors that drive each of the components. In this embodiment, the servo motor 27 and the reducer 30 are provided for each drive shaft.

[0017] The hand 2 in this embodiment includes a hand drive motor 21 that drives the hand 2. The claws of the hand 2 open and close when the hand drive motor 21 is driven. The claws may be formed so as to be operated by air pressure. In addition, any work tool can be attached to the robot device depending on the work to be performed by the robot device.

[0018] The robot device 5 includes a robot control device 4 that controls the robot 1 and the hand 2. The robot control device 4 includes an arithmetic processing device (computer) having a CPU (Central Processing Unit) as a processor. The arithmetic processing device has a RAM (Random Access Memory) and a ROM (Read Only Memory) connected to the CPU via a bus. An operation program 41 created in advance for controlling the robot 1 and the hand 2 is input to the robot control device 4. The robot 1 and the hand 2 are controlled based on the operation program 41.

[0019] The robot control device 4 includes a storage unit 42 that stores predetermined information. The storage unit 42 stores information related to the control of the robot 1 and the hand 2. The storage unit 42 can be configured with a non-transitory recording medium capable of storing information, such as a volatile memory, a non-volatile memory, or a hard disk. The robot control device 4 includes a display device 46 that displays any information related to the robot device 5. The display device 46 can be configured with a display panel such as a liquid crystal display panel.

[0020] The robot control device 4 includes an operation control unit 43 that sends operation commands for the robot 1 and the hand 2. The operation control unit 43 controls the operation of the servo motor 27 and the operation of the hand drive motor 21. The operation control unit 43 corresponds to a processor that operates according to an operation program 41. The operation control unit 43 is formed to be able to read information stored in the storage unit 42. The processor functions as the operation control unit 43 by reading the operation program 41 stored in the storage unit 42 and carrying out the control defined in the operation program 41.

[0021] The operation control unit 43 sends an operation command to the robot driving unit 45 for driving the robot 1 based on the operation program 41. The robot driving unit 45 includes an electric circuit for driving the servo motor 27. The robot driving unit 45 supplies electricity to the servo motor 27 based on the operation command. The operation control unit 43 also sends an operation command to the hand driving unit 44 for driving the hand 2 based on the operation program 41. The hand driving unit 44 includes an electric circuit for driving the hand driving motor 21. The hand driving unit 44 supplies electricity to the hand driving motor 21 based on the operation command.

[0022] In the robot device 5 of this embodiment, a reducer 30 is disposed at a joint of the robot 1 as a power transmission mechanism. The robot device 5 includes an abnormality detection device that detects an abnormality in the reducer 30. The abnormality detection device of this embodiment includes a robot control device 4, a first encoder 23 as a first rotational position detector for detecting a rotation angle of an output shaft of a servo motor 27, and a second encoder 24 as a second rotational position detector for detecting a rotation angle of an output shaft of the reducer 30. In this embodiment, the rotation angle of the output shaft of the servo motor 27 corresponds to the rotation angle of the input shaft of the reducer 30.

[0023] The robot control device 4 includes a detection unit 51 that detects an abnormality in the reducer 30 based on the output of the first encoder 23 and the output of the second encoder 24. The detection unit 51 includes a state acquisition unit 52 that acquires the operation state of the robot. The detection unit 51 includes a variable setting unit 53 that sets a variable for determining an abnormality in the reducer 30. The detection unit 51 includes a determination unit 54 that determines whether or not the reducer 30 is abnormal based on the variable. The detection unit 51 includes an estimation unit 55 that estimates the number of times or driving time of a task that will cause an abnormality in the future. The detection unit 51 includes a torsion angle calculation unit 56 that calculates a torsion angle between the input shaft and the output shaft of the reducer 30 based on the torque applied to the reducer 30.

[0024] The detection unit 51 corresponds to a processor that operates according to the operation program 41. Moreover, each of the units of the state acquisition unit 52, the variable setting unit 53, the determination unit 54, the estimation unit 55, and the torsion angle calculation unit 56 included in the detection unit 51 corresponds to a processor that operates according to the operation program 41. The processor reads the operation program 41 and performs the control defined in the operation program 41, thereby functioning as each unit.

[0025] In this embodiment, a servo motor 27 as an electric motor and a reducer 30 as a power transmission mechanism are arranged in the joint portion 18a between the swivel base 13 and the lower arm 12, out of the multiple joint portions 18a, 18b, and 18c.

[0026] 3 is an enlarged partial cross-sectional view of a joint portion disposed between the swivel base and the lower arm. In the joint portion 18a of this embodiment, the lower arm 12 rotates relative to the swivel base 13. In the joint portion 18a, a servo motor 27 that drives the lower arm 12 relative to the swivel base 13 and a reducer 30 that increases the output torque of the servo motor 27 are disposed.

[0027] The servo motor 27 is fixed to the swivel base 13 by a bolt 29. The servo motor 27 includes an output shaft 28 that protrudes toward the reducer 30 and outputs a rotational force. The reducer 30 includes an input shaft 32 to which the rotational force of the output shaft 28 of the servo motor 27 is input.

[0028] The reducer 30 can reduce the rotational speed of the input shaft 32 of the reducer 30 to increase the rotational torque. The reducer 30 includes a plurality of gears that transmit the rotational force of the input shaft 32, and an output shaft 33 that supports the plurality of gears. The reducer 30 includes a reducer case 31 formed to surround the output shaft 33. The reducer case 31 is formed in a cylindrical shape. The input shaft 32 is rotatably supported by the output shaft 33. The output shaft 33 is supported to rotate relative to the reducer case 31.

[0029] The reducer case 31 is fixed to the swivel base 13 with bolts 37. In addition, the output shaft 33 of the reducer 30 is fixed to the lower arm 12 with bolts 36. The input shaft 32 of the reducer 30 is connected to the output shaft 28 of the servo motor 27. The output shaft 28 and the input shaft 32 rotate around a rotation axis RA. The rotation axis RA is the rotation axis of the joint portion 18a.

[0030] In this example of the reducer 30, the reducer case 31 is stationary. When the input shaft 32 rotates, the output shaft 33 rotates relative to the reducer case 31 due to the transmission of rotational force of the gears. The lower arm 12 rotates together with the output shaft 33. For example, an eccentric oscillating type planetary gear reducer can be used as this type of reducer 30. However, the reducer is not limited to this form, and a reducer having any mechanism for changing the rotational force can be used.

[0031] 2 and 3, a first encoder 23 for detecting the rotational position of an output shaft 28 of the servo motor 27 is attached to the servo motor 27. The rotational position of the output shaft 28 of the servo motor 27 corresponds to the rotational position of the input shaft 32 of the reducer 30. In other words, the first encoder 23 is disposed so as to be able to detect the rotational position of the input shaft 32 of the reducer 30.

[0032] In the robot device 5 of this embodiment, in addition to the first encoder 23, a second encoder 24 for detecting the rotational position of the output shaft 33 of the reducer 30 is arranged. The second encoder 24 has a scale 24a and a detector 24b arranged to face the scale 24a. The scale 24a is fixed to the surface of the lower arm 12. The scale 24a has a shape extending in the circumferential direction with the rotation axis RA as the center.

[0033] The detection unit 24b is supported on the swivel base 13 via a support member 25. In the second encoder 24, a magnetic ring can be used as the scale 24a, and a magnetic sensor can be used as the detection unit 24b. For example, the surface of the scale 24a facing the detection unit 24b can be magnetized with S poles and N poles at regular intervals so that a change in magnetic flux can be detected by the detection unit 24b. The second encoder is not limited to this form, and an optical encoder may also be used.

[0034] In addition, in the second encoder 24 in this embodiment, the scale 24a is attached to the surface of the lower arm 12, but this is not limited to the embodiment. The second encoder can be disposed at any position so as to detect the rotational position of the output shaft of the reducer. For example, the scale may be attached to the output shaft of the reducer. The first encoder and the second encoder may be either an incremental type or an absolute type encoder.

[0035] In this embodiment, the motion control unit 43 controls the rotational position of the servo motor 27 in order to control the position of the robot 1. The position of the robot 1 is, for example, the position of the tool tip point of the work tool. The position of the tip point of the work tool is determined by the positions and orientations of the swivel base 13, lower arm 12, upper arm 11, and wrist 15.

[0036] In general, the rotational position of the servo motor 27 is controlled based on the rotational position output from the first encoder 23. However, there is a rattle between the internal parts of the reducer (such as backlash of gears). In addition, the parts of the reducer may be deformed or distorted because a force accompanying driving is applied to the parts of the reducer. As a result, a twist may occur between the input shaft and the output shaft of the reducer. Therefore, the rotational position of the output shaft 33 of the reducer 30 may deviate from the rotational position of the output shaft 28 of the servo motor 27. In this embodiment, in order to accurately detect the position of the robot 1, a second encoder 24 is provided to detect the rotational position of the output shaft 33 of the reducer 30.

[0037] 2, the operation control unit 43 of this embodiment controls the position and posture of the robot 1 based on the rotational position output from the second encoder 24. The operation control unit 43 generates a position command for the servo motor 27 based on the operation program 41. At this time, the operation control unit 43 acquires the rotational position from the second encoder 24. The operation control unit 43 generates the position command so that the rotational position output from the second encoder 24 corresponds to a position defined in the operation program 41. In this manner, position feedback control can be performed.

[0038] Furthermore, the operation control unit 43 generates a speed command based on the position command. Regarding the speed command, the operation control unit 43 also calculates the rotation speed based on the rotation position output from the second encoder 24. The operation control unit 43 generates the speed command so that the actual rotation speed corresponds to the rotation speed based on the operation program 41. In this manner, speed feedback control can be performed.

[0039] By controlling the position and posture of the robot 1 based on the output of the second encoder 24 that detects the rotational position of the output shaft 33 of the reducer 30, the accuracy of the position and posture of the robot 1 is improved. In addition, the accuracy of the movement path along which the position of the robot 1 moves is improved.

[0040] The detection unit 51 of the abnormality detection device judges abnormalities in parts arranged inside the reducer 30. In particular, the detection unit 51 detects abnormalities due to wear of parts. By operating the robot 1, the gears arranged inside the reducer 30 wear out. Also, the bearings arranged inside the reducer 30 may wear out. For example, if the reducer is provided with rolling bearings, the operation of the robot may wear out the rolling elements or raceways of the rolling bearings.

[0041] Wear of parts increases the rattle between parts. For example, excessive wear of gears can cause teeth to skip, leading to failure of the reducer. Or, excessive wear of parts can make it impossible to accurately control the position and posture of the robot 1. The detection unit 51 of this embodiment detects abnormalities such as increased rattle of parts that occur before a major abnormality such as teeth skipping occurs.

[0042] FIG. 4 shows a graph illustrating one operation pattern of the servo motor in this embodiment. The robot device 5 repeatedly performs the task of transporting a workpiece. The robot 1 changes its position and posture in various patterns. FIG. 4 shows the operation of the servo motor 27 corresponding to one operation of the robot 1. After the servo motor 27 is started at time ts, it reaches a predetermined rotation speed. After being driven at a constant rotation speed, the servo motor 27 stops at time te. In order to detect an abnormality in the reducer 30, such an operation pattern of the servo motor 27 is selected in advance.

[0043] FIG. 5 shows a graph of the rotation angle based on the output of the encoder when the servo motor is driven according to the operation pattern shown in FIG. 4. The operation starts at time ts and ends at time te. The rotation angle indicates the amount of rotation when rotated by the motor. For example, when the output shaft rotates once, the rotation angle is 360°. Over time, the rotation angle obtained from the output of each encoder increases as shown by arrow 92.

[0044] 5 shows the rotation angle based on the output of the first encoder 23 and the rotation angle based on the output of the second encoder 24 during one robot movement. Here, the rotation angle of the input shaft 32 of the reducer 30 is calculated from the rotation position output from the first encoder 23. Next, the rotation angle of the input shaft 32 is divided by the reduction ratio of the reducer 30. Then, it is compared with the rotation angle based on the rotation position output from the second encoder 24. Note that the rotation angle based on the output of the second encoder may be multiplied by the reduction ratio before being compared with the rotation angle based on the output of the first encoder.

[0045] In the first abnormality detection control of the present embodiment, it is determined whether or not there is an abnormality in the reducer 30 based on the output of the first encoder 23 and the output of the second encoder 24. With reference to Fig. 2, the state acquisition unit 52 of the detection unit 51 detects the rotational position output from the first encoder 23 and the rotational position output from the second encoder 24 while the servo motor 27 is being driven. The state acquisition unit 52 stores the acquired rotational positions of the respective encoders in the storage unit 42.

[0046] FIG. 5 shows the rotation angle when the reducer 30 is normal. Here, the rotation angle in the initial state when the reducer 30 is brand new is shown. There is almost no rattle between the parts of the reducer 30. For this reason, if there is almost no twist between the input shaft and the output shaft of the reducer 30, the rotation angle acquired from the output of the first encoder 23 and the rotation angle acquired from the output of the second encoder 24 will be almost the same. In this embodiment, the difference between the rotation angle acquired from the output of the first encoder 23 and the rotation angle acquired from the output of the second encoder 24 is called the angle difference. For example, the angle difference corresponds to a value (θ1-θ2) obtained by subtracting the rotation angle θ2 acquired from the output of the second encoder 24 from the rotation angle θ1 acquired from the output of the first encoder 23. In FIG. 5, there is a slight angle difference Δθ12i in the rotation angle.

[0047] FIG. 6 shows a graph of the rotation angle based on the output of the encoder when wear of the parts of the reducer progresses. FIG. 7 shows an enlarged view of part A in FIG. 6. FIG. 7 is a graph in the vicinity of time ts when measurement of the rotation angle is started. With reference to FIG. 6 and FIG. 7, in this embodiment, the rotation position (phase) output from the second encoder 24 relative to the rotation position (phase) output from the first encoder 23 when there is no wear of the parts is measured in advance. Therefore, it is possible to calculate the amount of change in the angle difference when wear progresses during the period from time ts to time te when the servo motor 27 is rotating.

[0048] Moreover, in this embodiment, the position of the robot 1 is controlled based on the output of the second encoder 24. In the graphs of Fig. 5 to Fig. 7, the rotation angle acquired from the output of the second encoder 24 is set to 0 at a time ts when a predetermined movement of the robot 1 is started.

[0049] When the drive time of the reducer 30 becomes long, parts such as gears or bearings wear out. As a result, the difference between the rotation angle obtained from the output of the first encoder 23 and the rotation angle obtained from the output of the second encoder 24 becomes large. That is, the absolute value of the angle difference becomes large. In FIG. 6 and FIG. 7, an angle difference Δθ12 occurs based on the rotation angle θ1 obtained from the output of the first encoder 23 and the rotation angle θ2 obtained from the output of the second encoder 24. Here, when the angle difference Δθ12 is defined as (θ1-θ2), the angle difference Δθ12 can be a positive number or a negative number depending on the contact state of the gear teeth.

[0050] FIG. 8 shows a first enlarged cross-sectional view of the portion where the teeth of the two gears are in contact. FIG. 9 shows a second enlarged cross-sectional view of the portion where the teeth of the two gears are in contact. FIG. 8 and FIG. 9 are schematic diagrams showing the difference in the contact state of the teeth of the gears facing each other. In FIG. 8 and FIG. 9, the input side gear 71 rotates in the direction shown by the arrow 98. The teeth of the input side gear 71 shown in FIG. 8 are in contact with the teeth of the output side gear 72 on the tooth surface on the side of the rotation direction. On the other hand, in FIG. 9, the teeth of the input side gear 71 are in contact with the teeth of the output side gear 72 on the tooth surface on the opposite side to the rotation direction. The difference in the contact state of these teeth is caused by gravity, inertial force when the robot operates, or other external forces.

[0051] As shown in Fig. 8, when the teeth of the input side gear 71 contact the teeth of the output side gear 72 on the tooth surface on the rotation direction side, in order to obtain the orientation of the output side lower arm 12, the rotation angle θ1 becomes larger than the rotation angle θ2. As a result, the angle difference Δθ12 becomes a positive value. Also, as shown in Fig. 9, when the teeth of the input side gear 71 contact the teeth of the output side gear 72 on the tooth surface on the opposite side to the rotation direction, the rotation angle θ1 becomes smaller than the rotation angle θ2. As a result, the angle difference Δθ12 becomes a negative number.

[0052] The angular difference is not limited to the value (θ1-θ2) obtained by subtracting the rotation angle θ2 obtained from the output of the second encoder 24 from the rotation angle θ1 obtained from the output of the first encoder 23, but may be the value (θ2-θ1) obtained by subtracting the rotation angle θ1 from the rotation angle θ2. Alternatively, the absolute value of the value obtained by subtracting one of the rotation angles obtained from the output of the first encoder 23 and the rotation angle obtained from the output of the second encoder 24 from the other may be used. In this embodiment, an example will be described in which the angular difference Δθ12 is (θ1-θ2) and the gears are in contact as shown in FIG. 8.

[0053] In the first abnormality detection control, an abnormality in the reducer 30 is detected based on a variable including an angle difference. The variable in this embodiment is an evaluation variable for evaluating whether or not the reducer 30 is abnormal. The variable setting unit 53 calculates the angle difference Δθ12 as the first variable. The variable setting unit 53 divides the rotation angle acquired from the output of the first encoder 23 by the reduction ratio of the reducer 30. The variable setting unit 53 calculates the angle difference Δθ12 by subtracting the rotation angle acquired from the output of the second encoder 24 from this rotation angle. Next, the determination unit 54 determines whether or not an abnormality has occurred in the reducer 30.

[0054] The variable setting unit 53 can use the maximum value of the angle difference Δθ12 from time ts to time te as the angle difference Δθ12 used to determine whether or not there is an abnormality. Alternatively, a plurality of times may be set and an average value of the variables at the plurality of times may be used. Furthermore, the angle difference Δθ12 may be converted to an absolute value before calculating the maximum value or average value. In this way, the maximum value or average value when the operation pattern of the servo motor 27 is performed can be used as the variable used to determine whether or not there is an abnormality.

[0055] FIG. 10 shows a graph of variables versus the number of times a robot action is performed. The horizontal axis is the number of times a predetermined action of the robot 1 is performed. The horizontal axis corresponds to, for example, the number of times the servo motor 27 performs the predetermined action shown in FIG. 4. The horizontal axis may also be the driving time during which the robot 1 performs the predetermined action. The vertical axis is a variable for determining whether or not an abnormality has occurred in the reducer 30.

[0056] In the first judgment control of this embodiment, when the variable VX deviates from a predetermined judgment range, the reducer 30 is judged to be abnormal. As the number of executions increases, the variable VX gradually increases. In the example shown in FIG. 10, when the number of executions reaches N, the variable VX exceeds a predetermined judgment value of the variable. The judgment unit 54 judges that an abnormality has occurred when the variable VX exceeds the judgment value. Here, the judgment unit 54 judges that an abnormality has occurred when the number of executions N is completed. For example, when the angle difference Δθ12 as the first variable exceeds the judgment value, the reduction gear 30 can be judged to be abnormal. Or, the judgment unit 54 can judge that wear of the gear is progressing.

[0057] 11 shows another graph of the variable versus the number of times the robot's motion is performed. In the second judgment control of this embodiment, the judgment unit 54 judges that the reducer 30 is abnormal when the rate of change of the variable VX versus the number of times the task is performed falls outside a predetermined judgment range. In this example, the gradient between the variable VX at the number of times (N-1) the task is performed and the variable VX at the number of times N the task is performed is calculated.

[0058] The determination unit 54 determines that the reducer 30 is abnormal when the gradient of the variable VX exceeds a predetermined determination value. That is, the determination unit 54 determines that the reducer 30 is abnormal when the gradient of the straight line 80 exceeds the determination value. For example, the determination unit 54 determines that the reducer 30 is abnormal when the rate of change of the angular difference Δθ12 as the first variable exceeds the determination value. The calculation of the rate of change is not limited to two variables, and the rate of change may be calculated based on three or more variables.

[0059] Also, instead of the number of executions, the drive time during which the robot 1 or the servo motor 27 executes a predetermined operation may be used. In this case, the determination unit can determine that the reducer is abnormal when the rate of change of the variable with respect to the drive time deviates from a predetermined determination range.

[0060] A graph showing the increase in the variable with respect to the number of times the robot's operation is performed is shown in Fig. 12. In the third determination control of this embodiment, similar to the second determination control, an abnormality in the reducer is determined based on the rate of change of the variable with respect to the number of times the task is performed or the driving time.

[0061] The determination unit 54 calculates the increase in the variable VX for each predetermined number of times the operation is performed. Here, the increase in the variable VX is calculated for each 10,000 times the operation of the robot 1 is performed. As the number of times the operation is performed increases, the increase in the variable VX increases. The determination unit 54 determines that the reducer is abnormal when the increase in the variable VX deviates from a predetermined determination range. For example, the determination unit 54 can determine that the reducer 30 is abnormal when the increase in the angle difference Δθ12 for each 10,000 times exceeds a predetermined determination value. In this example, the determination unit 54 can determine that an abnormality has occurred in the reducer when the number of times the operation is performed reaches N times. When calculating the rate of change of the variable with respect to the driving time, the increase in the variable can be calculated for each length of the predetermined driving time.

[0062] Next, a description will be given of the estimation unit 55 of the detection unit 51 according to the present embodiment. The estimation unit 55 performs estimation control to estimate the number of times an operation will be performed or the driving time during which an abnormality will occur in the future, based on the values ​​of variables for the number of times an operation has been performed or the driving time in the past.

[0063] Fig. 13 shows a graph of variables versus the number of times a robot's motion is performed. Fig. 13 is a graph for explaining the control of estimating the number of times an operation that will cause an abnormality is performed by the estimation unit 55. As indicated by an arrow 93, the variable VX increases as the number of times the operation is performed increases. The estimation unit 55 calculates an approximation line 81 indicating the change trend of the variable based on the value of the variable versus the number of times the operation was performed in the past. For example, an approximation line can be calculated for the angle difference Δθ12 as the first variable.

[0064] The estimation unit 55 can generate an approximation line showing a change trend by arbitrary control. In the example shown in Fig. 13, a linear approximation line 81 is generated by the least squares method using all past values ​​of the variables VX. The approximation line is not limited to a straight line, and may be a curved line. When generating an approximation line, a predetermined number of variables may be selected to generate the approximation line.

[0065] The estimation unit 55 estimates the number of times the task is performed when the approximation line deviates from a predetermined judgment range as the number of times the task is performed when an abnormality will occur in the future. In this example, the estimation unit 55 estimates the number of times the task is performed when the approximation line 81 exceeds a predetermined judgment value as the number of times the task will be performed when an abnormality will occur. Note that the estimation unit 55 may use the drive time instead of the number of times the task is performed. That is, the estimation unit may calculate an approximation line showing the change tendency of the variable with respect to the drive time, and estimate the drive time when the approximation line deviates from the judgment range as the drive time when an abnormality will occur.

[0066] 2, information related to the abnormality detected by the detection unit 51 can be displayed on the display 46. An operator can check the information related to the abnormality displayed on the display 46 and plan maintenance or inspection of the reduction gear 30. As a result, it is possible to prevent the reduction gear 30 from suddenly breaking down.

[0067] Next, the variables for determining an abnormality of the reducer 30 will be described. The variable VX is not limited to the angle difference as the first variable, and a variable including the angle difference can be adopted. With reference to FIG. 5 and FIG. 6, the variable setting unit 53 can calculate the difference (Δθ12-Δθ12i) between the angle difference Δθ12i when the reducer 30 is normal and the angle difference Δθ12 of the current reducer 30 as the second variable VX. Alternatively, the variable setting unit 53 can calculate the ratio (Δθ12 / Δθ12i) between the predetermined angle difference when the reducer 30 is normal and the angle difference of the current reducer as the third variable VX. Here, the angle difference in the initial state when the reducer 30 is new is adopted as the predetermined angle difference when the reducer 30 is normal. The variable setting unit 53 can calculate the angle difference when the reducer 30 is new and store it in the storage unit 42.

[0068] Furthermore, the variable setting unit 53 can calculate the difference between the angle difference (Δθ12i) when the reducer 30 is normal and the current angle difference (Δθ12) of the reducer 30 divided by the angle difference when the reducer 30 is normal (Δθ12-Δθ12i) / Δθ12i) as the fourth variable VX.

[0069] For any of the variables, an abnormality in the reducer 30 can be determined by the first determination control based on the value of the variable shown in Fig. 10, the second determination control based on the rate of change of the variable shown in Fig. 11, or the third determination control based on the amount of increase of the variable shown in Fig. 12. Furthermore, the estimation unit 55 can estimate the time when an abnormality will occur by performing the above-mentioned estimation control using each variable.

[0070] FIG. 14 shows another operation pattern of the servo motor for determining whether or not an abnormality occurs in the reducer. In the other operation pattern, the servo motor 27 is temporarily stopped during a period from time ts to time te. In this example, the servo motor 27 is stopped at time th1, and started at time th2. The variable setting unit 53 may calculate a variable based on the output of the encoder during the period during which the servo motor 27 is stopped. For example, when calculating the angle difference Δθ12, which is the first variable, the variable setting unit 53 may calculate the angle difference Δθ12 during the period during which the servo motor 27 is stopped.

[0071] Incidentally, in the second to fourth variables described above, the angle difference when the reducer 30 is normal is included in the variable. For example, in the second variable, the angle difference when the reducer 30 is normal is subtracted from the current angle difference of the reducer 30. This eliminates the influence of torsion in the reducer 30. However, in the first variable, the angle difference when the reducer 30 is normal is not included in the variable. When performing judgment control using the first variable, the influence of torsion in the reducer 30 is included. Next, a description will be given of control that eliminates the influence of torsion in the reducer 30 when using the first variable to judge an abnormality in the reducer 30 or estimate the time when an abnormality will occur.

[0072] 2, the torsion angle calculation unit 56 of the detection unit 51 calculates the torsion angle between the input shaft 32 and the output shaft 33 based on the torque applied to the output shaft 33 of the reducer 30. The relationship between the torque T acting on the output shaft 33 of the reducer and the torsion angle θt in the reducer 30 can be expressed by the following equation using a proportionality constant k. T = k × θt … (1)

[0073] From the above formula (1), the torsion angle θt can be expressed by formula (2). θt = T / k … (2)

[0074] The torque T can be calculated using a pre-calculated inertia and the angular velocity of the servo motor 27 when driving the robot 1. The inertia can be calculated based on the weight and center of gravity of the components of the robot 1 and the weight and center of gravity of the workpiece. When the robot 1 is stopped, the torque T related to the weight of the components for maintaining the position of the robot 1 can be calculated. Alternatively, the torque T may be calculated using the current value of the servo motor 27. That is, the torque applied to the output shaft 28 of the servo motor 27 is calculated using the current value. The torque T can be calculated by multiplying the torque applied to the output shaft 28 by the reduction ratio.

[0075] Next, a method for calculating the proportionality constant k will be described. The relationship between the angle difference Δθ12 based on the output of the first encoder 23 and the output of the second encoder 24 and the rattle component BL such as backlash caused by wear of the gears of the speed reducer 30 is expressed by the following equation (3). Δθ12=θt+BL …(3)

[0076] Next, the worker actually drives the robot 1. An operation is set in which the direction of backlash does not change for the gears inside the reduction gear 30. The angle difference Δθ12 and the torque T are calculated for a plurality of postures of the robot 1 during this operation.

[0077] 15 is a schematic diagram showing the operation of the robot for calculating the proportionality constant between the torque and the torsion angle. Here, the lower arm 12 is rotated at the joint 18a as indicated by the arrow 95. The robot 1 is stopped midway through this rotation operation. That is, the servo motor 27 arranged at the joint 18a is temporarily stopped.

[0078] As shown by arrow 96, when the lower arm 12 rotates from movement point MPa to movement point MPb, the robot 1 is stopped. At movement point MPb, the torque Ta and the angular difference Δθ12a are calculated. Furthermore, as shown by arrow 97, the lower arm 12 is rotated from movement point MPb to movement point MPc, and the robot 1 is stopped. At movement point MPc, the torque Tb and the angular difference Δθ12b are calculated. At the two movement points MPb, MPc, the following equations (4) and (5) hold. Δθ12a=Ta / k+BL …(4) Δθ12b=Tb / k+BL …(5)

[0079] Here, the rattle component BL can be considered to be constant at the moving points MPb and MPc. Based on the equations (4) and (5), the proportionality constant k can be calculated by the following equation (6). k=(Ta-Tb) / (Δθ12a-Δθ12b) …(6)

[0080] By using this method, the proportionality constant k can be obtained in advance for each reducer. The torsion angle calculation unit 56 can calculate the torsion angle θt by using the proportionality constant k, the position and posture of the robot 1 acquired by the state acquisition unit 52, and the angular velocity of the servo motor 27 according to formula (2).

[0081] The variable setting unit 53 can set a value (Δθ12-θt) obtained by subtracting the torsion angle θt from the angle difference Δθ12 based on the output of the first encoder 23 and the output of the second encoder 24 as a variable. The judgment unit 54 can perform the first judgment control to the third judgment control using the calculated variable. By using the variable obtained by subtracting the torsion angle from the angle difference as a variable for judging an abnormality, the influence of torsion in the reducer can be eliminated. An abnormality in the reducer can be judged with high accuracy. Furthermore, the estimation unit 55 can estimate the time when an abnormality will occur using the calculated variable. The estimation unit 55 can more accurately estimate the time when a failure will occur.

[0082] Next, a second abnormality detection control for detecting an abnormality in the reducer 30 in this embodiment will be described. In the second abnormality detection control in this embodiment, an abnormality in the reducer 30 is determined using a variable that does not include a rotation angle obtained from the output of the second encoder 24 but includes a rotation angle obtained from the output of the first encoder 23. The first to third determination controls for determining an abnormality in the reducer 30 are similar to the first abnormality detection control. In addition, the estimation control for estimating the time when an abnormality will occur in the reducer 30 is also similar to the above-mentioned control.

[0083] FIG. 16 shows a graph of the rotation angle versus time to explain the second abnormality detection control in this embodiment. FIG. 16 shows an example in which the servo motor 27 stops during the operation of the robot 1. The vertical axis is the rotation angle based on the output of each encoder. FIG. 17 shows an enlarged view of the graph in the vicinity of the time when the measurement of the rotation angle starts. FIG. 17 is an enlarged view of part B in FIG. 16. In FIG. 16 and FIG. 17, the rotation angle based on the output of the first encoder 23 when the reducer 30 is brand new is shown as the initial state of the reducer 30. Also shown is the rotation angle based on the output of the first encoder 23 when the reducer 30 is driven for a long time and wear has progressed.

[0084] 16 and 17, in this embodiment, the rotational position of the servo motor 27 is controlled based on the rotational position output from the second encoder 24. For this reason, the rotational angle θ2 based on the output of the second encoder 24 when the robot 1 performs a predetermined operation does not change substantially even if the parts of the reducer 30 are worn. In contrast, when the parts of the reducer 30 are worn, the rotational angle θ1 based on the output of the first encoder 23 gradually changes so that the difference between the rotational angle θ1 and the rotational angle θ2 based on the output of the second encoder 24 becomes larger. In the example shown in FIG. 16 and FIG. 17, the rotational angle θ1 increases with respect to the rotational angle θ2.

[0085] In the second abnormality detection control, an abnormality in the reducer 30 is determined based on the rotation angle θ1 acquired from the output of the first encoder 23. In the second abnormality detection control, the variable setting unit 53 sets a variable including the rotation angle θ1 acquired from the output of the first encoder 23. Then, the determination unit 54 determines whether or not the reducer 30 is abnormal in the above-mentioned first determination control to third determination control based on the variable determined by the variable setting unit 53.

[0086] The first variable in the second abnormality detection control is a rotation angle θ1 obtained by dividing the rotation angle acquired from the output of the first encoder 23 by the reduction ratio. The determination unit 54 determines an abnormality in the reducer 30 based on the rotation angle θ1. For example, in the first determination control shown in Fig. 10, it can be determined that the reducer 30 is abnormal when the rotation angle θ1 exceeds a predetermined determination value.

[0087] As the second variable in the second abnormality detection control, a difference Δθ11 between a predetermined rotation angle θ1i acquired from the output of the first encoder 23 when the reducer 30 is normal and a rotation angle θ1 acquired from the current output of the first encoder 23 can be adopted. In this example, a value (θ1-θ1i) obtained by subtracting the rotation angle θ1i when the reducer 30 is normal from the current rotation angle θ1 is adopted as the difference Δθ11. As the predetermined rotation angle based on the output of the first encoder 23 when the reducer 30 is normal, a rotation angle based on the output of the first encoder 23 in an initial state when the reducer 30 is brand new can be adopted. The determination unit 54 determines an abnormality of the reducer 30 based on the difference Δθ11 in the rotation angles. In this way, the amount of change in the rotation angle acquired from the output of the first encoder 23 may be adopted as a variable.

[0088] FIG. 18 shows a graph of the rotation angle based on the output of the first encoder. The rotation angle shown in FIG. 18 is the difference in rotation position (phase) output from the first encoder 23. In the second abnormality detection control, since the determination is based on the output of the first encoder 23, it is not necessary to divide the rotation angle by the reduction ratio. In FIG. 18, the rotation angle is not divided by the reduction ratio. A predetermined rotation angle θ1i' based on the output of the first encoder 23 when the reducer 30 is normal, and a rotation angle θ1' based on the output of the first encoder 23 when wear of the parts has progressed are shown.

[0089] In the second abnormality detection control, the variable setting unit 53 can set the rotation angle θ1' output from the first encoder 23 to the third variable. The judgment unit 54 judges an abnormality of the reducer 30 based on the rotation angle θ1'. Alternatively, the variable setting unit 53 can set the difference (θ1'-θ1i') between the rotation angle θ1i' when the reducer 30 is normal and the current rotation angle θ1' as the rotation angle difference Δθ11' to the fourth variable. The judgment unit 54 judges an abnormality of the reducer 30 based on the rotation angle difference Δθ11'. In this way, in the second abnormality detection control, an abnormality can be judged without using the output from the second encoder.

[0090] In the second abnormality detection control, the difference between the rotation angle when the reducer 30 is normal and the current rotation angle may be a positive or negative value. Furthermore, the difference between the rotation angle when the reducer 30 is normal and the current rotation angle is not limited to the above-mentioned form, and may be a value obtained by subtracting the current rotation angle from the rotation angle when the reducer 30 is normal, or an absolute value obtained by subtracting one rotation angle from the other rotation angle.

[0091] In this embodiment, a device for detecting an abnormality in a reducer in a joint between a swivel base and a lower arm is illustrated, but the present invention is not limited to this embodiment. The abnormality detection device of this embodiment can be applied to detect an abnormality in a reducer in any joint.

[0092] The abnormality detection device of the present embodiment can detect an abnormality in a power transmission mechanism such as a reducer at an early stage. In particular, rattling due to wear of parts can be detected with high accuracy. Or, an abnormality due to deformation of parts can be detected. For example, a maintenance or inspection plan for the reducer can be determined before a failure such as tooth skipping occurs in the reducer. Also, a maintenance or inspection plan for the reducer can be determined before the accuracy of controlling the position and posture of the robot deteriorates. Also, when a second encoder is arranged to control the position of the component members of the machine with high accuracy, an abnormality in the power transmission mechanism can be detected without arranging an additional sensor.

[0093] The abnormality detection device of this embodiment can be applied to any machine having an electric motor and a power transmission mechanism. The power transmission mechanism that transmits the rotational force of the electric motor to another member is not limited to a reducer, and any mechanism that transmits the rotational force of the electric motor can be used. For example, in addition to a mechanism including gears, a belt-driven mechanism, a mechanism including a universal joint, or a link mechanism can be used as the power transmission mechanism. Next, a power transmission mechanism including a pulley and a belt will be described.

[0094] Fig. 19 shows a schematic side view of an electric motor and other power transmission devices. In the example shown in Fig. 19, a belt-driven mechanism is used to supply rotational force to a predetermined part of the machine. The machine includes a servo motor 27 and a power transmission mechanism 59 that transmits the rotational force of the servo motor 27. The servo motor 27 is fixed to a support 67 of a base 60.

[0095] The power transmission mechanism 59 includes an input shaft 63 connected to the output shaft 28 of the servo motor 27, and an output shaft 64 that transmits rotational force to other members. The input shaft 63 is supported by supports 67, 68 of the base 60 via a bearing 65. The output shaft 64 is supported by supports 67, 68 of the base 60 via a bearing 66.

[0096] A pulley 61 is attached to the input shaft 63. A pulley 62 is attached to the output shaft 64. A belt 69 is engaged with the pulleys 61 and 62. When the servo motor 27 is driven, the belt 69 moves in the direction indicated by the arrow 94. The rotational force of the input shaft 63 is transmitted to the output shaft 64 by the belt 69. The rotational speed changes based on the size of the pulleys 61 and 62.

[0097] In order to detect the rotation angle of the input shaft 63 of the power transmission mechanism 59, a first encoder 23 is attached to the servo motor 27. Also, in order to detect the rotation angle of the output shaft 64 of the power transmission mechanism 59, a second encoder 24 is attached to the output shaft 64.

[0098] In the power transmission mechanism 59, for example, deterioration of the belt 69 may cause the phase of the output shaft 64 to deviate from the phase of the input shaft 63. For example, bending of the belt 69 may cause the rotation angle of the input shaft 63 to deviate from the rotation angle of the output shaft 64. Or, wear may occur in the bearings 65, 66. For such a power transmission mechanism 59 as well, the abnormality detection device can detect an abnormality in the power transmission mechanism 59 by performing control similar to the first abnormality detection control and the second abnormality detection control described above. Also, by performing the estimation control described above, it is possible to estimate the time when an abnormality will occur.

[0099] The above-mentioned embodiments can be combined as appropriate. In each of the above-mentioned drawings, the same or equivalent parts are given the same reference numerals. Note that the above-mentioned embodiments are examples and do not limit the invention. In addition, the embodiments include modifications of the embodiments shown in the claims. [Explanation of symbols]

[0100] 4 Robot control device 23 First Encoder 24 Second Encoder 27 Servo motor 28 Output shaft 30 Reducer 32 Input shaft 33 Output shaft 41 Operation Program 43 Motion control section 51 Detection unit 53 Variable setting section 54 Judgment section 55 Estimation part 56 Torsion angle calculation section 59 Power transmission mechanism 63 Input shaft 64 Output shaft 65,66 Bearings 81 Approximation line

Claims

1. An abnormality detection device for detecting an abnormality in a power transmission mechanism that transmits a rotational force output by an electric motor to another member, a first rotational position detector for detecting a rotation angle of an input shaft to which a rotational force of an electric motor of the power transmission mechanism is input; a second rotational position detector for detecting a rotation angle of an output shaft that outputs a rotational force of the power transmission mechanism to another member; An operation control unit that controls the operation of the electric motor; a detection unit that detects an abnormality in the power transmission mechanism based on an output of the first rotational position detector and an output of the second rotational position detector, the operation control unit controls the electric motor so that a position acquired from an output of the second rotational position detector corresponds to a position defined in an operation program; The detection unit includes a variable setting unit that sets a variable including an angular difference that is the difference between a rotation angle obtained from the output of the first rotational position detector and a rotation angle obtained from the output of the second rotational position detector based on the output of the first rotational position detector, the output of the second rotational position detector, and a reduction ratio of the power transmission mechanism, and a judgment unit that judges whether or not the power transmission mechanism is abnormal based on the variable.

2. The abnormality detection device according to claim 1 , wherein the variable setting unit sets the angle difference as the variable.

3. 2 . The abnormality detection device according to claim 1 , wherein the variable setting unit calculates, as the variable, a difference or a ratio between the current angular difference of the power transmission mechanism and the predetermined angular difference when the power transmission mechanism is normal.

4. 2. The abnormality detection device according to claim 1, wherein the variable setting unit calculates, as the variable, a value obtained by dividing a difference between the current angular difference of the power transmission mechanism and the predetermined angular difference when the power transmission mechanism is normal, by the predetermined angular difference when the power transmission mechanism is normal.

5. the detection unit includes a torsion angle calculation unit that calculates a torsion angle between an input shaft and an output shaft based on a torque applied to a power transmission mechanism, The abnormality detection device according to claim 2 , wherein the variable setting unit calculates, as the variable, a value obtained by subtracting a twist angle from the angle difference.

6. An abnormality detection device for detecting an abnormality in a power transmission mechanism that transmits a rotational force output by an electric motor to another member, a first rotational position detector for detecting a rotation angle of an input shaft to which a rotational force of an electric motor of the power transmission mechanism is input; a second rotational position detector for detecting a rotation angle of an output shaft that outputs a rotational force of the power transmission mechanism to another member; An operation control unit that controls the operation of the electric motor; a detection unit that detects an abnormality in the power transmission mechanism based on an output of the first rotational position detector, the operation control unit controls the electric motor so that a position acquired from an output of the second rotational position detector corresponds to a position defined in an operation program; The abnormality detection device includes a variable setting unit that sets a variable that does not include a rotation angle obtained from the output of the second rotational position detector, and a judgment unit that judges whether or not the power transmission mechanism is abnormal based on the variable.

7. The abnormality detection device according to claim 6 , wherein the variable setting unit calculates, as the variable, a rotation angle obtained by dividing a rotation angle acquired from an output of a first rotational position detector by a reduction ratio.

8. The abnormality detection device according to claim 6 , wherein the variable setting unit sets the variable to a rotation angle output from a first rotation position detector.

9. 7. The abnormality detection device according to claim 6, wherein the variable setting unit calculates, as the variable, a difference between a rotation angle obtained from a current output of the first rotational position detector and a predetermined rotation angle obtained from the output of the first rotational position detector when the power transmission mechanism is normal.

10. The abnormality detection device according to claim 1 , wherein the determination unit determines that the power transmission mechanism is abnormal when the variable deviates from a predetermined determination range.

11. 10. The abnormality detection device according to claim 1 , wherein the determination unit determines that the power transmission mechanism is abnormal when a rate of change of the variable with respect to a number of times the task is performed or a driving time deviates from a predetermined determination range.

12. The detection unit includes an estimation unit that estimates a number of times or a driving time of an operation that will cause an abnormality in the future, 10. The abnormality detection device according to claim 1, wherein the estimation unit calculates an approximation line indicating a change trend of the variable based on the value of the variable relative to the number of times the task was performed or the driving time in the past, and estimates the number of times the task was performed or the driving time when the approximation line deviates from a predetermined judgment range as the number of times the task was performed or the driving time at which an abnormality will occur in the future.

Citation Information

Patent Citations

  • Trouble diagnosis system for machine servo system

    JP1988145507A

  • Abnormality-determining device of speed reducer and abnormality-determining method of speed reducer

    JP2006102889A

  • Shaft torque detection system and abnormality detection system

    JP2008309592A

  • Robot system, robot control apparatus, and robot control method

    JP2012171069A

  • Machine provided with lubrication oil degradation sensor, speed reducer for industrial robot and industrial robot

    JP2013152166A