Method of teaching robot and robot

Patent metadata

Field	Value
Publication number	US-9796086-B2
Application number	US-201514702333-A
Country	US
Kind code	B2
Filing date	May 1, 2015
Priority date	May 1, 2015
Publication date	Oct 24, 2017
Grant date	Oct 24, 2017

Abstract

A method of teaching a robot includes: a swinging step of causing a hand to swing about a predetermined pivot, which is on an axis perpendicular to an optical axis of a sensor beam, to scan a target in a horizontal direction of the sensor beam; a determining step of determining whether or not the target has coincided with a position along a central axis of the hand in its longitudinal direction based on a detection signal of a mapping sensor, the detection signal having changed owing to the swinging of the hand; and a shifting step of, if it is determined in the determining step that the target has not coincided with the position, calculating an offset amount of the hand based on the detection signal of the mapping sensor, the detection signal having changed owing to the swinging of the hand, and causing the hand to shift to either right or left along the optical axis of the sensor beam in accordance with the calculated offset amount.

First claim

The invention claimed is:

1. A method of teaching a robot, the robot including:
a robot arm freely movable at least in two axial directions that are directions in an X-axis and a Y-axis;
a hand mounted to a distal end of the robot arm and including two branching distal end portions that are a first distal end portion and a second distal end portion;
a mapping sensor configured such that a sensor beam travels straight through space between the first and second distal end portions, the mapping sensor detecting whether or not a target has blocked the sensor beam; and a controller configured to control an operation of the robot arm,
the method comprising:
a placing step of placing the target at a taught position;
a first specifying step of causing the hand to advance straight from a predetermined position and specifying a position of the target in a forward-rearward direction in a reference coordinate system of the robot when the target has blocked the sensor beam;
a swinging step of causing the hand to swing about a predetermined pivot, which is on an axis perpendicular to an optical axis of the sensor beam, to scan the target in a horizontal direction by means of the sensor beam;
a determining step of determining whether or not the target has coincided with a position along a central axis of the hand in its longitudinal direction based on a detection signal of the mapping sensor, the detection signal of the mapping sensor having changed due to the swinging of the hand;
a shifting step of, if it is determined in the determining step that the target has not coincided with the position, calculating an offset amount of the hand based on the detection signal of the mapping sensor, the detection signal of the mapping sensor having changed due to the swinging of the hand, and causing the hand to shift to either right or left along the optical axis of the sensor beam in accordance with the calculated offset amount;
a second specifying step of, if it is determined in the determining step that the target has coincided with the position, specifying a position of the target in a right-left direction in the reference coordinate system of the robot; and
a teaching step of teaching the robot a position of the hand, the position corresponding to the taught position, based on the positions of the target specified in the forward-rearward direction and the right-left direction.

2. The method of teaching a robot according to claim 1 , wherein
the swinging step includes causing the hand to swing about the predetermined pivot, which is on the axis perpendicular to the optical axis of the sensor beam, to right and left by a same angle.

3. The method of teaching a robot according to claim 1 , wherein
the determining step includes determining whether or not the target has coincided with the position along the central axis of the hand in its longitudinal direction based on whether or not a value of the detection signal of the mapping sensor indicates symmetry in a predetermined swing angle range whose center is 0 degree.

4. The method of teaching a robot according to claim 1 , further comprising a step of calculating an inclination of the optical axis of the sensor beam relative to an axis in a reference coordinate system of the robot, wherein
the shifting step includes causing the hand to shift along the optical axis of the sensor beam in a manner to maintain the calculated inclination.

5. The method of teaching a robot according to claim 1 , wherein
the placing step includes placing two targets at two taught positions, respectively,
the first specifying step, the swinging step, the determining step, the shifting step, the second specifying step, and the teaching step are performed for each of the two targets, and
the method further comprises an adjusting step of adjusting a deviation in a case of causing the hand to advance straight by a predetermined distance from the taught position of the hand based on relative positions of the specified positions of each of the targets and a design distance between the targets.

6. A robot comprising:
a robot arm freely movable at least in two axial directions that are directions in an X-axis and a Y-axis;
a hand mounted to a distal end of the robot arm and including two branching distal end portions that are a first distal end portion and a second distal end portion;
a mapping sensor configured such that a sensor beam travels straight through space between the first and second distal end portions, the mapping sensor detecting whether or not a target has blocked the sensor beam; and
a controller configured to control an operation of the robot arm, wherein
the controller:
causes the hand to advance straight from a predetermined position, and in a state where the target is placed at a taught position, specifies a position of the target in a forward-rearward direction in a reference coordinate system of the robot when the target has blocked the sensor beam;
causes the hand to swing about a predetermined pivot, which is on an axis perpendicular to an optical axis of the sensor beam, to scan the target in a horizontal direction by means of the sensor beam;
determines whether or not the target has coincided with a position along a central axis of the hand in its longitudinal direction based on a detection signal of the mapping sensor, the detection signal of the mapping sensor having changed due to the swinging of the hand;
if it is determined that the target has not coincided with the position, calculates an offset amount of the hand based on the detection signal of the mapping sensor, the detection signal of the mapping sensor having changed due to the swinging of the hand, and causes the hand to shift to either right or left along the optical axis of the sensor beam in accordance with the calculated offset amount;
if it is determined that the target has coincided with the position, specifies a position of the target in a right-left direction in a reference coordinate system of the robot; and
teaches the robot a position of the hand, the position corresponding to the taught position, based on the positions of the target specified in the forward-rearward direction and the right-left direction.

Assignees

• Kawasaki Heavy Ind Ltd
• Kawasaki Robotics(Usa) Inc
• Kawasaki Robotics (Usa) Inc

Inventors

• Nakaya Atsushi
• Yamaguchi Takao
• Nakahara Hajime
• Chin George

Classifications

• H10P72/0606

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

• H10P72/53

  using optical controlling means · CPC title

• Y10S901/03

  Teaching system · CPC title

• Y10S901/47

  Optical · CPC title

• B25J9/163 Primary

  learning, adaptive, model based, rule based expert control · CPC title