Reducer abnormality determination method, abnormality determination device, and robot system
The invention provides a method and a device capable of precisely and simply extracting data used for abnormality determination and life diagnosis of a drive system of an industrial robot while executing a normal action program. Regarding a torque signal Tf outputted from a motor driver for controlling a motor in accordance with a position command Xs generated based on an operation program of a robot to the motor, a highpass filter is applied after gravity compensating torque and interference torque due to other shafts of the robot are removed from the torque signal Tf, and an abnormality in a reducer is determined based on an extracted oscillating component of the reducer.
1. A reducer abnormality determination method for determining an abnormality in a reducer for amplifying torque generated by a motor and transmitting the torque, the reducer being attached to the motor serving as a drive source for joint shafts of a multi joint robot, the reducer for transmitting the torque of the motor to an arm of the robot, the method comprising:
removing gravity compensating torque and interference torque due to other shafts of the robot from a torque signal outputted from a motor driver for controlling the motor in accordance with a position command generated based on an operation program of the robot to the motor;
applying a highpass filter after the gravity compensating torque and the interference torque due to the other shafts of the robot are removed from the torque signal;
collecting absolute values of the torque signal processed by the highpass filter during a specific period of time defined within a period of time from a timing at which the motor starts rotating via a predetermined steady speed to a timing at which the motor stops;
obtaining an average value of the absolute values collected during the specific period of time; and
determining that the reducer corresponding to the motor is abnormal when a difference between an initial average value of absolute values of the torque of the motor obtained at a time of shipping of the multi joint robot and a latest value of the average value is larger than a preliminary set threshold value in order to perform life diagnosis of the multi-joint robot,
wherein both the initial average value and the latest value are determined by operating the robot using an action program including movement commands including speed commands and position commands to control movement of the robot to perform actions normally performed by the robot.
2. The reducer abnormality determination method according to claim 1 , wherein a cut-off frequency of the highpass filter is changeable.
3. A reducer abnormality determination device for determining an abnormality in a reducer for amplifying torque generated by a motor and transmitting the torque, the reducer being attached to the motor serving as a drive source for joint shafts of a multi joint robot, the reducer for transmitting the torque of the motor to an arm of the robot, the reducer abnormality determination device comprising:
a torque data corrector configured to remove gravity compensating torque and interference torque due to other shafts of the robot from a torque signal outputted from a motor driver for controlling the motor in accordance with a position command generated based on an operation program of the robot to the motor;
a highpass filter is applied after the gravity compensating torque and the interference torque due to the other shafts of the robot are removed from the torque signal; and
an abnormality determinator programmed to:
collect absolute values of the torque signal processed by the highpass filter during a specific period of time defined within a period of time from a timing at which the motor starts rotating via a predetermined steady speed to a timing at which the motor stops;
obtain an average value of the absolute values collected during the specific period of time; and
determine that the reducer corresponding to the motor is abnormal when a difference between an initial average value of absolute values of the torque of the motor obtained at a time of shipping of the multi joint robot and a latest value of the average value is larger than a preliminary set threshold value in order to perform life diagnosis of the multi-joint robot,
wherein both the initial average value and the latest value are determined by operating the robot using an action program including movement commands including speed commands and position commands to control movement of the robot to perform actions normally performed by the robot.
4. The reducer abnormality determination device according to claim 3 , wherein a cut-off frequency of the highpass filter is changeable.
5. A robot system comprising:
a robot control device provided with the reducer abnormality determination device according to claim 3 ; and
a robot controlled by the robot control device.