Robot controlling system

• US 4,659,971 A
• Filed: 08/16/1985
• Issued: 04/21/1987
• Est. Priority Date: 08/16/1984
• Status: Expired due to Term

• Current Assignee: Seiko Instruments & Electronics Ltd. (Seiko Group)
• Original Assignee: Seiko Instruments & Electronics Ltd. (Seiko Group)
• Inventors: Matsuoka, Yoshiharu, Suzuki, Hayao
• Primary Examiner(s): Dobeck, Benjamin
• Application Number:
  US06/766,907
• Time in Patent Office: 613 Days
• Field of Search: 318/568, 318/568 AB, 318/568 B, 901/27-29, 901/16, 364/513
• US Class Current: 318/568.19
• 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/33263 Conversion, transformation of coordinates, cartesian or polar
• CPC Class Codes: G05B 2219/36226 Global selection of grid or circle of points by number, distance, angle
• CPC Class Codes: G05B 2219/36503 Adapt program to real coordinates, software orientation
• CPC Class Codes: Y02P 90/02 Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Abstract

A robot control system comprises a hand movable along a plane according to position command data determined based on an absolute coordinate system arranged along the plane, and rotatable around an axis vertical to the plane according to angular command data determined with respect to a base axis of the absolute coordinate system for working a workpiece at a certain working point thereof with a certain angular position of the hand. Input means inputs working point data representative of the working point in terms of a local coordinate system arranged on the workpiece, angular position data representative of the angular position of the hand at the working point determined with respect to a base axis of the local coordinate system, and position data of the workpiece located along the plane in terms of the absolute coordinate. Calculation means calculates the linear and angular displacements of the local coordinate system relative to the absolute coordinate system according to the position data of the workpiece provided by the input means. First transformation means transforms the local working point data provided by the input means to the absolute position command data according to the calculated linear and angular displacements. Second transformation means transforms the local angular position data provided by the input means to the absolute angular command data according to the calculated angular displacement.

Claims

1. In a robot controlling system at least having means for locating a hand at an arbitrary point along a plane, means for turning said hand in an arbitrary direction about an axis vertical to said plane, and means for actuating said hand according to a hand position coordinate and a hand direction angle stored in a RAM based on a robot absolute coordinate system and a programmed sequence, the improvement comprising:

means defining one local coordinate system according to a plurality of reference points in the robot absolute coordinate system;

means for storing a hand position coordinate of said local coordinate system and a hand direction angle relative to a coordinate standard axis of said local coordinate system at each operating position of the hand;

means for transforming said hand position coordinate of said local coordinate system to said hand position coordinate of the robot absolute coordinate system; and

means for correcting the hand direction angle relative to the coordinate standard axis of said local coordinate system by an angular displacement of the coordinate standard axis of said local coordinate system relative to a coordinate standard axis of the robot absolute coordinate system.

2. The robot controlling system according to claim 1, further comprising;

means defining another local coordinate system;

means for storing said hand position coordinates of said one local coordinate system and said hand direction angle relative to the coordinate standard axis of said one local coordinate system as the identical hand position coordinates of another local coordinate system and as the identical hand direction angle relative to the coordinate standard axis of another local coordinate system;

means for transforming said defined hand position coordinates of said another local coordinate system to hand position coordinates of the robot absolute coordinate system; and

means for correcting said defined hand direction angle relative to the coordinate standard axis of said another local coordinate system by an angular displacement of the coordinate standard axis of said local coordinate system relative to the coordinate standard axis of the robot absolute coordinate system.

3. The robot controlling system according to claim 1 or 2, further comprising;

jogging means for teaching an operating position of the hand to provide the local hand position coordinate; and

means for setting a jogging mode for controlling the hand not to change the angular direction thereof despite changing the position thereof during the jogging operation.

4. The robot controlling system according to claim 1 or 2;

wherein said local coordinate systems comprise an orthogonal coordinate system.

5. The robot controlling system according to claim 1 or 2;

wherein said robot absolute coordinate system comprises an orthogonal coordinate system.

6. The robot controlling system according to claim 1 or 2;

wherein said means defining one local coordinate system defines the one local coordinate system according to an origin of said local coordinate system and another point existing on the coordinate standard axis of said local coordinate system extending along the plane.

7. The robot controlling system according to claim 1 or 2;

wherein said means for storing a hand direction angle relative to a coordinate standard axis of a local coordinate system stores the hand direction angle automatically at the same time when a hand position coordinates of the local coordinate system is stored.

8. The robot controlling system according to claim 1 or 2;

wherein said means for correcting a hand direction angle relative to a coordinate standard axis of a local coordinate system corrects the hand direction angle automatically at the same time when a hand position coordinates of the local coordinate system is transformed to a hand position coordinates of the robot absolute coordinate system.

9. A robot controlling system comprising:

a hand movable along a plane according to position command data determined based on an absolute coordinate system related to the plane, and rotatable around an axis vertical to the plane according to angular command data determined with respect to a base axis of the absolute coordinate system for working a workpiece at a certain working point thereof with a certain angular position of the hand;

input means for inputting working point data representative of the working point in terms of a local coordinate system related to the workpiece, angular position data representative of the angular position of the hand at the working point determined with respect to a base axis of the local coordinate system, and position data of the workpiece located along th plane in terms of the absolute coordinate;

calculation means for calculating linear and angular displacements of the local coordinate system relative to the absolute coordinate system according to the position data of the workpiece provided by the input means;

first transformation means for transforming the local working point data provided by the input means to absolute position command data according to the calculated linear and angular displacements;

second transformation means for transforming the local angular position data provided by the input means to absolute angular command data according to the calculated angular displacement; and

drive means for driving a hand to the working point and the angular position according to the absolute position and angular command data.

10. A robot controlling system according to claim 9;

wherein the hand has means for sequentially working a plurality of workpieces at the same working points thereof with the same angular positions of the hand.

11. A robot controlling system according to claim 10;

wherein the input means has means for providing different position data of the workpieces differently positioned along the plane.

12. A robot controlling system according to claim 11;

wherein the calculation means has means for calculating different linear and angular displacements of the local coordinate systems corresponding to respective ones of the workpieces according to the different position data;

the first transformation means has means for transforming the same local working point data to the different absolute position command data corresponding to respective ones of the workpieces; and

the second transformation means has means for transforming the same local angular position data to the different absolute angular command data corresponding to respective ones of the workpieces according to the different angular displacements.

13. A robot controlling system according to claim 9;

including a plurality of hands having respective absolute coordinate systems for working the same workpiece.

14. A robot controlling system according to claim 13;

wherein the calculation means has means for calculating different linear and angular displacements of the local coordinate system relative to the different absolute coordinate systems corresponding to the different hands;

the first transformation means has means for transforming the same local working point data to the different absolute position command data corresponding to respective ones of the hands according to the different linear and angular displacements; and

the second transformation means has means for transforming the same local angular position data to the different absolute angular command data corresponding to respective ones of the hands according to the different angular displacements.

15. A robot controlling system according to claim 9;

wherein the input means includes jogging means for teaching the working point data to the robot controlling system.

17. A robot controlling system according to claim 9;

including means defining the local coordinate system in the form of a local orthogonal coordinate system, and means defining the absolute coordindate system in the form of an absolute orthogonal coordinate system.

18. A robot controlling system according to claim 17;

wherein the input means includes means for determining the angular position data with respect to one axis of the local orthogonal coordinate system.

19. A robot controlling system according to claim 17;

wherein the input means includes means for determining the position data of the workpiece by a plurality of reference points defined on the workpiece.

21. A robot controlling system according to claim 9;

wherein the second transformation means includes means for adding the calculated angular displacement data to the local angular position data to obtain the absolute angular command data.

16. A robot controlling system according to claim 23;

wherein the jogging means operates to move the hand along the plane but not to rotate the hand around the vertical axis during the teaching operation.

20. A robot controlling system according to claim 27;

wherein the input means includes means defining the reference points in the form of an origin point of the local orthogonal coordinate system and another point existing on one axis thereof.

22. A method for controlling a robot having a hand movable along a plane according to position command data determined based on an absolute coordinate system, and rotatable around an axis vertical to the plane according to angular command data determined with respect to a base axis of the absolute coordinate system for working a workpiece at a certain working point thereof with a certain angular position of the hand;

the method comprising the steps of;

positioning the workpiece along the plane defined by the absolute coordinate system;

providing working point data representative of the working point in terms of a local coordinate system coordinated to the workpiece, angular position data representative of the angular position of the hand at the working point measured with respect to a base axis of the local coordinate system, and position data of the workpiece in terms of the absolute coordinate;

calculating the linear and angular displacements of the local coordinate system relative to the absolute coordinate system according to the position data of the workpiece;

transforming the local working point data to the absolute position command data according to the calculated linear and angular displacements; and

transforming the local angular position data to the absolute angular command data according to the calculated angular displacement.