Robot system and method of detecting deformation of end effector

Patent metadata

Field	Value
Publication number	US-10279485-B2
Application number	US-201415538938-A
Country	US
Kind code	B2
Filing date	Dec 22, 2014
Priority date	Dec 22, 2014
Publication date	May 7, 2019
Grant date	May 7, 2019

Abstract

A robot system includes a robotic arm having a wrist in a tip-end part thereof, the wrist being rotatable on a rotational axis extending in a given direction, an end effector attached to the wrist, and a deformation detecting device configured to detect deformation of the end effector by using a target pin having a target part where a given detection part of the end effector reaches. The target part has an indicate function to indicate that the detection part reaches the target part. The deformation detecting device includes a search part configured to control the robotic arm so that the detection part touches the target pin to search for the target part, and detect that the detection part reaches the target part based on the indicate function, and a deformation detecting part configured to compare an assumed position of the detection part when the detection part reaches the target part with a given reference position, and detect the deformation of the end effector.

First claim

What is claimed is:

1. A robot system, comprising:
a robotic arm having a wrist in a tip-end part thereof, the wrist being rotatable on a rotational axis extending in a given direction;
an end effector attached to the wrist; and
a deformation detecting device configured to detect deformation of the end effector by using a target pin having a target part where a detection area of the end effector reaches, the target having an indicate function to indicate that the detection area reaches the target, and
the deformation detecting device including:
a processor configured to:
control the robotic arm so that the detection part touches the target pin to search for the target part, and detect that the detection part reaches the target part based on the indicate function; and
compare an assumed position of the detection part when the detection part reaches the target part with an assumed position of a reference part when the reference part reaches the target part, and detect the deformation of the end effector.

2. The robot system of claim 1 , wherein,
the target part is formed, in order to demonstrate the indicate function, in a shape in which a touched position of the end effector to the target pin changes locally, when the end effector is moved along the target pin in the given direction, while touching the target pin,
the deformation detecting device controls the robotic arm so that the detection part is moved along the target pin in the given direction while touching the target pin, to search for the target part, and
the deformation detecting device detects that the detection part reaches the target part based on a local change in the touched position of the detection part to the target pin.

3. The robot system of claim 1 , wherein,
the target pin is formed, as the shape where the touched position of the end effector to the target pin changes locally, to continuously have a constant diameter part with a constant diameter and a varying diameter part with a varying diameter in the given direction, and a boundary between the constant diameter part and the varying diameter part constitutes the target part,
the deformation detecting device acquires positional information on the detection part when the detection part touches the target pin while swinging the end effector on the rotational axis,
the deformation detecting device performs the acquisition at a plurality of locations while displacing the end effector toward the varying diameter part from the constant diameter part in the given direction to search for the target part, and
the deformation detecting device detects that the detection part reaches the target part based on an angular displacement on the rotational axis derived from the plurality of positional information acquired.

4. The robot system of claim 1 , wherein the deformation detecting device is configured to, when the deformation of the end effector is detected, determine whether the deformation is correctable by an adjustment of at least one of the position and posture of the robotic arm, and correct the deformation when the deformation is correctable.

5. The robot system of claim 1 , wherein the reference position is, when the deformation detecting device controls the robotic arm so that the reference part that is different from the detection part of the end effector touches the target pin to search for the target part, and detects that the reference part reaches the target part based on the indicate function, an assumed position of the reference part.

6. The robot system of claim 5 , wherein,
the deformation of the end effector is torsional deformation of the end effector,
the detection part and the reference part are defined in tip-end parts of the end effector, and on one side and the other side of the centerline of the end effector, and
the deformation detecting device compares the assumed position of the detection part in the given direction when the detection part reaches the target part with the assumed position of the reference part in the given direction when the reference part reaches the target part to detect the deformation of the end effector.

7. The robot system of claim 5 , wherein,
the deformation of the end effector is bending deformation of the end effector,
one of the detection part and the reference part is defined in the tip-end part of the end effector, and the other is defined in a root part of the end effector, and
the deformation detecting device compares the assumed position of the detection part in the given direction when the detection part reaches the target part with the assumed position of the reference part in the given direction when the reference part reaches the target part to detect the deformation of the end effector.

8. The robot system of claim 5 , wherein,
the deformation of the end effector is rotational deformation of the end effector,
one of the detection part and the reference part is defined in a root part of the end effector, and the other is defined in the tip-end part of the end effector or between the tip-end part and the root part of the end effector, and
the deformation detecting device compares the assumed position of the detection part in a plane perpendicular to the given direction when the detection part reaches the target part with the assumed position of the reference part in the plane perpendicular to the given direction when the reference part reaches the target part to detect the deformation of the end effector.

9. The robot system of claim 1 , wherein the reference position is the assumed position of the detection part that is not deformed, when the deformation detecting device controls the robotic arm so that the non-deformed detection part of the end effector touches the target pin to search for the target part, and detects that the non-deformed detection part reaches the target part based on the indicate function.

10. A method of detecting deformation of an end effector in a robot system comprising a robotic arm having a wrist in a tip-end part thereof, the wrist being rotatable on a rotational axis extending in a given direction, the end effector attached to the wrist, and a deformation detecting device, the deformation detecting device detecting the deformation of the end effector by using a target pin having a target part where a given detection part of the end effector reaches, the target part having an indicate function to indicate that the detection part reaches the target part, the method comprising:
controlling, using a computer, the robotic arm so that the detection part touches the target pin to search for the target part;
detecting that the detection part reaches the target part based on the indicate function; and
comparing an assumed position of the detection part when the detection part reaches the target part an assumed position of a reference part when the reference part reaches the target part to detect the deformation of the end effector.

11. The method of claim 10 , wherein,
the target part is formed, in order to demonstrate the indicate function, in a shape in which a touched position of the end effector to the target pin changes locally, when the end effector is moved along the target pin in the given direction, while touching the target pin,
the searching for the target part includes controlling the robotic arm so that the detection part is moved along the target pin in the given direction while touching the target pin, to search for the target part, and
the detecting that the detection part reaches the target part includes detecting that the detection part reaches the target part based on a local change in the touched position of the detection part to the target pin.

Assignees

• Kawasaki Heavy Ind Ltd

Inventors

• Nakaya Atsushi
• Okada Hiroyuki
• Yoshida Masaya

Classifications

• H10P72/3302

  Mechanical parts of transfer devices · CPC title

• H10P72/3222

  Loading to or unloading from a conveyor · CPC title

• H10P72/0616

  Monitoring of warpages, curvatures, damages, defects or the like · CPC title

• H10P72/0606

  Position monitoring, e.g. misposition detection or presence detection · CPC title

• B25J9/1692 Primary

  Calibration of manipulator · CPC title