Industrial robot system and control method thereof

Patent metadata

Field	Value
Publication number	US-10011017-B2
Application number	US-201615188989-A
Country	US
Kind code	B2
Filing date	Jun 22, 2016
Priority date	Jul 30, 2015
Publication date	Jul 3, 2018
Grant date	Jul 3, 2018

Abstract

An industrial robot system includes a first deviation calculation unit calculating a first deviation between a first force detection value and a first force estimation value, a first command output unit outputting an operation command, a stop command, a deceleration command, or a deceleration stop command to a robot when a first deviation is larger than a first threshold value, and a fourth command output unit outputting the operation command, the stop command, the deceleration command, or the deceleration stop command according to a deviation pattern when the first deviation includes a common deviation pattern.

First claim

The invention claimed is:

1. An industrial robot system, comprising:
a robot;
a force detection unit detecting an external force applied to the robot;
a force estimation unit estimating, as a force estimation value, an external force applied to the force detection unit from information about an operation of the robot;
a deviation calculation unit calculating a deviation between the force estimation value and a force detection value applied to the robot obtained from information of the force detection unit;
a comparison unit comparing the deviation and a first threshold value; and
a command output unit, wherein
when the comparison unit determines that the deviation is larger than the first threshold value, the command output unit outputs a retraction command, a stop command, a deceleration command, or a deceleration stop command to the robot, and
when the deviation includes at least one deviation pattern, the command output unit outputs an operation command corresponding to the at least one deviation pattern.

2. The industrial robot system according to claim 1 , wherein only when the robot is at a stop or decelerating, the command output unit outputs the operation command corresponding to the at least one deviation pattern.

3. The industrial robot system according to claim 1 , wherein
the force detection unit includes a first force detection unit and a second force detection unit,
the force estimation unit includes:
a first force estimation unit estimating, as a first force estimation value, an external force applied to the first force detection unit from the information about the operation of the robot, and
a second force estimation unit estimating, as a second force estimation value, an external force applied to the second force detection unit from the information about the operation of the robot,

the deviation calculation unit includes:
a first deviation calculation unit calculating a first deviation between the first force estimation value and a first force detection value applied to the robot obtained from information of the first force detection unit, and
a second deviation calculation unit calculating a second deviation between the second force estimation value and a second force detection value applied to the robot obtained from information of the second force detection unit,

the comparison unit includes:
a first comparison unit comparing the first deviation and the first threshold value, and comparing the first deviation and the second deviation, and
a second comparison unit comparing the second deviation and the first threshold value, and comparing the second deviation and the first deviation, and

the command output unit includes:
a first command output unit, wherein when the first comparison unit determines that the first deviation is larger than the first threshold value, or when the first deviation and the second deviation are different by a certain level or more, the first command output unit outputs the stop command, the deceleration command, or the deceleration stop command to the robot, and
a second command output unit, wherein when the second comparison unit determines that the second deviation is larger than the first threshold value, or when the second deviation and the first deviation are different by a certain level or more, the second command output unit outputs the stop command, the deceleration command, or the deceleration stop command to the robot.

4. The industrial robot system according to claim 1 , further comprising:
a storage unit associating and storing
a plurality of deviation patterns having regularity with regard to deviations, and
operation commands of the robot respectively corresponding to the plurality of deviation patterns,

the comparison unit comparing a program of the robot and a current situation of the robot,
wherein
when the comparison unit determines that the program of the robot and the current situation of the robot are different, the command output unit outputs the stop command, the deceleration command, or the deceleration stop command to the robot,
when the deviation is between the first threshold value and a second threshold value smaller than the first threshold value, or when the deviation is larger than the first threshold value, the comparison unit compares the deviation and the plurality of deviation patterns stored in the storage unit, and
when the comparison unit determines that the deviation includes at least one deviation pattern of the plurality of deviation patterns, the command output unit outputs, from among the operation commands stored in the storage unit and respectively corresponding to the plurality of deviation patterns, the operation command corresponding to the at least one deviation pattern included in the deviation.

5. The industrial robot system according to claim 4 , wherein the plurality of deviation patterns stored in the storage unit include at least one of:
a magnitude of the deviation,
a time interval between two consecutive peaks of the deviation,
a direction of the deviation,
a period of time in which the deviation is applied,
an amount of change of the deviation in a unit time, or
a number of times the deviation is applied within a predetermined time.

6. A control method of an industrial robot system, the method comprising:
detecting by a force detection unit an external force applied to a robot of the industrial robot system;
estimating, as a force estimation value, an external force applied to the force detection unit from information about an operation of the robot;
calculating a deviation between the force estimation value and a force detection value applied to the robot obtained from information of the force detection unit;
comparing the deviation and a first threshold value;
when the deviation is determined to be larger than the first threshold value, outputting a retraction command, a stop command, a deceleration command, or a deceleration stop command to the robot; and
when the deviation includes at least one deviation pattern, outputting an operation command corresponding to the at least one deviation pattern.

7. The control method according to claim 6 , wherein only when the robot is at a stop or decelerating, the operation command corresponding to the at least one deviation pattern is output.

8. The control method of the industrial robot system according to claim 6 , wherein
the force detection unit includes a first force detection unit and a second force detection unit attached to the robot,
said detecting is performed by using the first force detection unit and the second force detection unit,
said estimating includes
estimating, as a first force estimation value, an external force applied to the first force detection unit from the information about the operation of the robot, and
estimating, as a second force estimation value, an external force applied to the second force detection unit from the information about the operation of the robot,

said calculating includes
calculating a first deviation between the first force estimation value and a first force detection value applied to the robot obtained from information of the first force detection unit, and
calculating a second deviation between the second force estimation value and a second force detection value applied to the robot obtained from information of the second force detection unit,

said comparing includes comparing
the first deviation and the first threshold value,
the second deviation and the first threshold value, and
the second deviation and the first deviation,

when the first deviation is determined to be larger than the first threshold value, or when the first deviation and the second deviation are determined to b

Assignees

• Fanuc Corp

Inventors

• Matsudaira Tetsuro
• Toda Shuntaro

Classifications

• B25J19/06

  Safety devices · CPC title

• B25J9/1674

  characterised by safety, monitoring, diagnostic · CPC title

• G05B2219/40201

  Detect contact, collision with human · CPC title

• B25J13/085 Primary

  Force or torque sensors (B25J13/082, B25J13/084 take precedence) · CPC title

• B25J9/1602 Primary

  characterised by the control system, structure, architecture · CPC title