Position teaching method and control apparatus for robot

• US 5,371,836 A
• Filed: 06/14/1990
• Issued: 12/06/1994
• Est. Priority Date: 08/24/1988
• Status: Expired due to Term

• Current Assignee: Matsushita Electric Industrial Company Limited (Panasonic Holdings Corporation)
• Original Assignee: Matsushita Electric Industrial Company Limited (Panasonic Holdings Corporation)
• Inventors: Satoh, Katsuyoshi, Tetsuya, Takafumi, Mitomi, Takashi
• Primary Examiner(s): MacDonald, Allen R.
• Assistant Examiner(s): Davis, George
• Application Number:
  US07/476,426
• Time in Patent Office: 1,636 Days
• Field of Search: 364/513, 395/93, 395/92, 395/80, 395/87, 395/88, 395/82, 395/89, 395/127, 395/83, 219/124.34, 901/4, 901/31, 901/3, 901/10, 901/46
• US Class Current: 700/245
• CPC Class Codes: G05B 19/4182 manipulators and conveyor only
• CPC Class Codes: G05B 19/425 Teaching successive positions by numerical control, i.e. commands being entered to control the positioning servo of the tool head or end effector
• CPC Class Codes: G05B 2219/39124 Grasp common rigid object, no movement end effectors relative to object
• CPC Class Codes: G05B 2219/39138 Calculate path of robots from path of point on gripped object
• CPC Class Codes: Y02P 90/02 Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Abstract

The present invention, by manually operating a robot and memorizing a position of the extremity of the robot, teaches a reference point representing a representative position and orientation on a moving path and a relative position of an operating position of a robot extremity in operation from the above-mentioned reference point, and designate a path of a moving position of the robot extremity in operation by an array of the reference points, and teachings of the moving path and a gripping position can be separated each other, and an accurate and easy teaching is enabled.

Claims

1. An action teaching method for a robot system having a plurality of moveable robot-manipulator adapted to hold a workpiece, comprising the steps of:

manually operating one of said robot-manipulators to said workpiece while at a first area, and determining a first reference point indicative of a relative position and orientation of said workpiece at said first area;

manually operating said robot-manipulators to said work piece while at said first area and determining gripping positions where said plurality of robot-manipulators hold said workpiece while at said first area;

manually operating said one of said robot-manipulators to said workpiece while at a second area and determining a second reference point indicative of a relative position and orientation of said workpiece at said second area;

designating a path of operating positions for said plurality of robot-manipulators by interpolating between arrays respectively having data representing the first and second reference points; and

determining relative gripping positions where said plurality of robot-manipulators hold said workpiece while not at said first area, said relative gripping positions being distinct from said reference points and maintained in a relative position to said reference points while said workpiece is being moved.

2. A method as in claim 1, wherein said each of said first and second reference point is determined by moving said one of said robot-manipulators to at least three positions within said first and second area, respectively, so as to indicate said relative position and orientation of said workpiece.

3. A method as in claim 2, wherein a first of said positions is used to represent said position of said workpiece and a second and third of said positions are used to represent said orientation of said workpiece.

4. A method as in claim 1 wherein each of said robot-manipulators respectively grip different portions of the workpiece, and are commanded to different locations relative to said reference point, where each of said robot-manipulators grip the workpiece at a different location relative to a single reference point.

5. A method as in claim 1 wherein said manually operating steps each include the steps of moving said one of said robot-manipulators to at least two points on the workpiece and storing information about these two points to obtain position and orientation.

6. A method as in claim 1 wherein said manually operating steps each include moving said one of said robot-manipulators to three points on the workpiece at each of said first and second areas, and measuring three dimensional information including position, and two dimensional orientation, from said three points.

7. A control apparatus for a robot system having a plurality of robot-manipulators, comprising:

means for manually operating the robot system,

means for detecting and storing a plurality of positions and orientations of one of said plurality of robot-manipulators while at different locations,

means for calculating and storing a reference point from said plurality of stored positions and orientations;

means for calculating and storing relative states of said plurality of robot-manipulators, indicative of their position and orientation, on the basis of said reference point;

control means, responsive to said stored reference point and relative states, for calculating a desired path of operation over which said robot system is to be operated, and for designating a present reference point as a starting point and a subsequent reference point as an ending point, and

means for controlling said plurality of robot-manipulators so as to hold a workpiece at said starting point by specifying gripping positions relative to said present reference point, and for moving said robot system so as to move between reference points by interpolating between the present reference point and the subsequent reference point, while keeping a relative position between the present reference point and said plurality of robot-manipulators by moving said robot system in a manner so as to maintain an original orientation of said workpiece.

8. A control apparatus of a robot system in accordance with claim 7, wherein the means for calculating and storing a reference point from said plurality of stored positions and orientations includes calculating said reference point from three positions, wherein a first position of said three positions represents the position of the reference point and the other positions represent orientation of the reference point.

9. A control apparatus of a robot system in accordance with claim 7, wherein the means for calculating and storing a reference point from said plurality of stored positions and orientations includes calculating a the reference point from two positions, a first position of said two positions representing the position of the reference point and the other position representing orientation of the reference point.

10. A control apparatus according to claim 7 wherein each of said robot-manipulators holds a side of said workpiece, said control means designating positions of said respective robot-manipulators relative to said reference point.

11. A controllable robot apparatus comprising:

at least two robot-manipulators;

means for manually operating said robot-manipulators;

means for setting a holding position where said robot-manipulators hold a workpiece;

means for detecting and storing a present position and orientation of of each of said robot-manipulators;

means for calculating and storing one of the present position or a relative position with respect to the present position and orientation of one of said robot-manipulators by determining the stored position and orientation as a reference point and for designating the reference point and the relative position, and calculating a desired position of operation of the robot apparatus on the basis of stored information and for operating the robot apparatus, and

means for designating a present reference point and a subsequent reference point, and operating the robot apparatus so as to move between the reference points by interpolating between the present reference point and the subsequent reference point, the movement of said robot apparatus proceeding in a manner so as to maintain an original orientation of said workpiece, allowing for a relative position of the present reference point and each of said robot-manipulators to be maintained so that said robot-manipulators hold the workpiece at the holding position and the reference point stays at its proper position on an interpolated path.

12. A control apparatus according to claim 11 wherein each of said robot-manipulators holds a side of said workpiece, said control means designating positions of said respective robot-manipulators relative to said reference point.

13. A method of operating a robot system possessing a plurality of robot-manipulators, comprising the steps of:

establishing a path from a first position to a second position;

manually moving one of said robot-manipulators to a first area in said first position and moving said one of said robot-manipulators to at least two points within said first area;

calculating a first reference point from said at least two points, said first reference point including at least position information and orientation information;

manually moving said one of said robot-manipulators to a second position and locating said one of said robot-manipulators to at least two points in a second area of said second position and determining position information including position and orientation of said second area from said at least two points to determine a reference point of said second position; and

interpolating a path between said first reference point and said second reference point;

determining positions where said plurality of robot-manipulators hold said workpiece relative to said reference point; and

setting positions of said plurality of robot-manipulators along said path that maintain an original orientation of said workpiece, allowing for a relative position of said robot-manipulators and said reference point to be maintained along said path.

14. A control apparatus according to claim 13 wherein each of said robot-manipulators holds a side of said workpiece, said control means designating positions of said respective robot-manipulators relative to said reference point.