Robot system judging abnormality of fastened work and abnormality judgment method

Patent metadata

Field	Value
Publication number	US-2016288326-A1
Application number	US-201615068638-A
Country	US
Kind code	A1
Filing date	Mar 14, 2016
Priority date	Mar 31, 2015
Publication date	Oct 6, 2016
Grant date	—

Abstract

A robot system of the present invention has a disturbance torque monitoring part which monitors a disturbance torque of a servo motor which drives rotation about a joint of the robot in accordance with an operating command of a robot operation control part. Further, when a work gripped by the hand is fastened by a work fasting device, the abnormality judging part compares the disturbance torque with a predetermined first threshold value and, when the disturbance torque is over the first threshold value, judges that an abnormality has occurred in the position of the work fastened by the work fastening device.

First claim

What is claimed is:

1 . A robot system comprising
a work fastening device which positions and fastens a work, a robot to which a hand which grips a workpiece is attached, and a control device which controls the work fastening device and the robot, wherein the control device has a robot operation control part which causes the robot to operate to grip a work by the hand and to place the gripped work at a predetermined position of the work fastening device, a disturbance torque monitoring part which monitors a disturbance torque of a motor which drives rotation about a joint of the robot in accordance with an operating command of the robot operation control part, and an abnormality judging part which, when gripping a work by the hand of the robot, compares the disturbance torque with a predetermined first threshold value and, when the disturbance torque is over the first threshold value, judges that an abnormality has occurred in the position of the work fastened by the work fastening device.

2 . The robot system according to claim 1 , wherein
the control device further comprises a frequency analysis part which breaks down a history of disturbance torque of the motor which is monitored by the disturbance torque monitoring part into a plurality of frequency components and extracts a specific frequency component from among the plurality of frequency components, and the abnormality judging part is configured to compare the specific frequency component with a predetermined second threshold value when the work gripped by the hand is fastened by the work fastening device and, when the specific frequency component is over the second threshold value, to judge that damage has occurred at the work fastened by the work fastening device.

3 . The robot system according to claim 1 wherein the work fastening device further comprises a work fastening part which has a seating surface which the outside surface of the work contacts and a work pushing part which has a pushing part which pushes the work against the seating surface.

4 . An abnormality judgment method which judges abnormality of a work which is loaded by a robot into a work fastening device and is fastened by that work fastening device, the abnormality judgment method comprising,
monitoring a disturbance torque of a motor driving rotation about a joint of the robot in response to an operating command to the robot and, when gripping a work by a hand of the robot, arranging it at a predetermined position of the work fastening device, and then fastening the gripped work by the work fastening device, comparing the disturbance torque with a predetermined first threshold value and, when the disturbance torque is over a first threshold value, judging that an abnormality has occurred in the position of the work fastened by the work fastening device.

5 . The abnormality judgment method according to claim 4 further comprising,
when a gripping a work by a hand of the robot, arranging it at a predetermined position of the work fastening device, and then fastening the gripped work by the work fastening device,
breaking down a history of disturbance torque of the motor which is monitored into a plurality of frequency components, extracting a specific frequency component from among the plurality of frequency components, comparing that specific frequency component with a predetermined second threshold value and, when the specific frequency component is over the second threshold value, judging that damage has occurred in the work fastened by the work fastening device.

Assignees

• Fanuc Corp

Inventors

• Furuya Yoshitake

Classifications

• B25J19/061

  with audible signals (audio controls B25J13/003) · CPC title

• B25J9/1633 Primary

  compliant, force, torque control, e.g. combined with position control · CPC title

• Y10S901/02

  Arm motion controller · CPC title

• Y10S901/30

  End effector · CPC title

• B23Q3/002

  Means to press a workpiece against a guide · CPC title