Human-cooperative robot system

Patent metadata

Field	Value
Publication number	US-10564635-B2
Application number	US-201715472502-A
Country	US
Kind code	B2
Filing date	Mar 29, 2017
Priority date	Mar 30, 2016
Publication date	Feb 18, 2020
Grant date	Feb 18, 2020

Abstract

A robot system capable of reliably detecting contact between a robot or a workpiece and an external object. The robot system includes: a robot including a handling part; a handling force-detection part that detects a handling force applied to the handling part; an operation controller that causes the robot to operate in accordance with the handling force; an external force-detection part that detects an external force acting on the robot; and a contact force-calculation part that calculates a contact force by subtracting the handling force from the detected external force.

First claim

The invention claimed is:

1. A human-cooperative robot system configured to work in cooperation with an operator, the system comprising:
a robot including a handle; and
a processor configured to:
calculate a handling force applied to the handle, based on an output signal from a first force sensor provided at the handle,
operate the robot in accordance with the calculated handling force,

when operating the robot, calculate
a resultant force of all forces acting on, a second force sensor provided at a proximal end side component of the robot, based on an output signal from the second force sensor, and an internal force acting on the second force sensor, based on mass of the robot,
calculate an external force applied to the robot when operating the robot, by subtracting the calculated internal force from the calculated resultant force, the external force being indicative of a sum of
(1) the handling force, and
(2) a contact force applied from an external object to the robot when the robot contacts the object, and

calculate the contact force by subtracting the calculated handling force from the calculated external force.

2. The robot system according to claim 1 , wherein the processor is further configured to carry out filtering to remove a noise component from the output signal of the first force sensor or the second force sensor.

3. The robot system according to claim 1 , wherein the processor is further configured to stop an operation of the robot when the calculated contact force exceeds a predetermined threshold value.

4. The robot system according to claim 3 , wherein the processor is configured to further operate the robot in accordance with the handling force only when a direction of the handling force calculated after the operation of the robot is stopped is a direction in which the contact force can be reduced.

5. The robot system according to claim 1 , wherein the processor is further configured to change an operating speed of the robot in response to the calculated contact force.

6. The robot system according to claim 1 , wherein the processor is further configured to:
calculate a component of the handling force, which acts on the second force sensor due to the handling force, based on the output signal from the first force sensor; and
calculate the contact force by subtracting the calculated component of the handling force from the calculated external force.

7. The robot system according to claim 4 , wherein
the processor is further configured to output
a first alarm upon stopping the operation of the robot, and
a second alarm upon determining that the direction of the handling force does not coincide with an allowable motion direction.

Assignees

• Fanuc Corp

Inventors

• Sato Takashi
• Gu Yihua

Classifications

• G05B2219/40586

  6-DOF force sensor · CPC title

• B25J1/02 Primary

  articulated or flexible · CPC title

• B25J13/085

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

• B25J9/1633

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

• G05B2219/37405

  Contact detection between workpiece and tool, probe, feeler · CPC title