AU593788B2

AU593788B2 - Programmed control of a working tool

Info

Publication number: AU593788B2
Application number: AU54556/86A
Authority: AU
Inventors: Amund Hetland; Odd Terje Hoie
Original assignee: Trallfa Robot AS
Current assignee: Trallfa Robot AS
Priority date: 1986-02-25
Filing date: 1986-02-25
Publication date: 1990-02-22
Anticipated expiration: 2006-02-25
Also published as: AU5455686A

Description

pp. AU-Al -54556/86 1 pr WORLD INTILLE UAL PROPIklTY ORGANIZATION0J n$ Bureiu INTRNPIN)LS ER THE PATENT COOPERATION TREATY (PCT) (51) International Patent Classification 4 International Publication Number: WO 87/ 04968 9/18, G05B 19/42 Al (43) Iaiternatioiial Publication Date: 27 August 1987 (27,08,87) (21) International Application Number- PCT/N086/00021 Published Witlh international search report.

(22) International Filing Date: 25 February 1986 (25.02.86) In English translation (filed In Norwegian), Applicant (or all designated States except US),TRALL- cumen conwir~ UK~ FA ROBOT A/S [NO/NO]; Postboks 265, N-4341 WmoiSaCts Auda und#t Bryne 8OM 49.

(72) Inventors; and Inventors/Applicants (for US only) .,HETLA ND, Amund N-4063 Yoll HOIE, Odd, w4 is save zr pt***j.

Terje [NO/NO]; Markageilen 44, N-4300 Sandnies

(NO).

(74) Agent: JLK. THORSENS PATENTBUREAU A/S; Postboks 2584 Solli, N-0203 Oslo 2 -8 oCT 1987 (81) Designated States: AU, BE (European patent), BR, DE (European patent), FR (European patent), GB (European patent), IT (European patent), JP, NL (Euro-USRLA pean patent), NO, SE (European patent), US. AUSTRALN (54) Title: METHOD AND ROBOT INSTALLATION FOR PROGRAMMED CONTROL OF A WORKING TOOL

MID

BA

(13)S1 (57) Abstract IA method and robot installation for programmed control of a working tool to perform processing operations on an object on the basis of Oireprogrammed tool path data stored in a data memory utilize for this purpose a movable servo-actuated robot'arm system (MP) having'more than six degrees of freed om. During the programmation said path data are~derivi'd idnot~-codni system ')ithout physical co nnecti on "With the ro~botarm system. For coordinate transf6rination'tG -the innir co8'rdinate system associated with~tlie robot arm system,'this arm systemlis c 6 nsidred'subdivided inA1o system parts*(C, E, H, J) '.'hich ;ach has at" mrost six degres of freedom' Positional data R, F) are derived and utilized for brininig the programmed'cont~rorof the working tool in the outer coordinate system at all times in appropriate correlation with the- Thver coordinrite system.

a it -p 1 "Method and.Robot Installation for Programmed Control of a Working Tool" *see *e The~ present invention is related to a method and a robot installation for programmed control of a working tool to perform processing operations on an object by means of a servo-actuated robot arm system.

When such arm system not merely is to take care of the required tool movements with respect to the object, but also to bring and maintain the working tool and its motive means at all times in appropriate position with respect to the object in question, which possibly also may be in motion, it may in practice often be necessary or suitable to utilize a robot aim system having more than six degrees of freedom.

It is simple to find the position of a tool from its axis co-ordinates in a given co-ordinate system, even in case the tool is moved by means of an arm system having more than six degrees of freedom. With such h .gh number of degrees of freedom an over-determinate equation system is required if the corresponding co-ordinates for the various motional axes of the arm system are to be determined on the basis of the position of the tool. With 25 programming and operation of a robot having such arm system, it is consequently necessary to use unconventional methods for deriving and storing the necessary positional and motional data for the working tool and the various parts of the robot arm system.

According to the invention, there is provided a method for programmed control of a working tool to perform processing operations on an object by means of a movable servo-actuated robot arm system having more than six degrees of freedom and on the basis of preprogrammed tool path data stored in a data memory and representing 000 0

S.

S

SS

0@ C

SC

CO S 5S 55 >4 C U,

V

K

~Vk1 r y 1 S S 6650 5S 0 0S@ 6 *0 0 605 S

S.

S

OSSA

00 S S

S

the movements of the tool and/or the object relative to each other when performing said processing operations, characterized in that the stored tool path data are derived in an outer co-ordinate system without physical connection with the robot arm~ system, which for coordi~nate transformation to an inner reference co-ordinate system associated with the robot arm system is considered subdivided into system parts which are movable with respect to each other and which have at most six degrees of freedom, the positional data for each system part, apart from one system part which is connected with the inner reference co-ordinate system, being derived and stored in the memory in addition to the programmed tool path data, and utilized, with or without directly sensor- 15 derived information as to the positional relation between said inner and outer co-ordinate systems, as co-ordinate transformation data for appropriately correlating the programmed control of the working tool on the basis of the stored totl path data in the outer co-ordinate system at all times with the inner reference co-ordinate system associated with the robot arm system.

The tool path data and co-ordinate transformation data are suitably derived in principally known manner by manual control of the working tool and the robot arm 25 system during the programmation. Such control may take place by continuous manual guidance along the intended motional paths with passivated servo-system or by manually controlled positional. adjustments point by point of said servo-system along said motional paths.

30 In this case the programmation is performed according to the invention in the manner that each system part, apart fromr the system part connected with the inner reference co-ordinate system, for the derivation and storage of its positional data during the manual control at all times is individually placed in such positional relation to the outer co-ordinate system that the working S SO 65 5

S.

eS

S

SSSS Se

S

5.

S S S

S.

SS S *5 S SC

I.

I

27 0 0 *0 0 tool may be guided to performing its intended processing operations by means of said system part which is connected with the inner reference co-ordinate system, and thus deriving said tool path data in the outer coordinate system and co-ordinate transformed from said inner reference co-ordinate system.

For reproduction of the manually programmed movements of the working tool and the robot arm system the positional data stored in the memory during the performance of the processing operations of the working tool are supplied to their respective individually associated system parts for the control of a servoactuated system associated with each system part and at all times co-ordinately transformed to the outer coordinate system in accordance with the data in question, at the same time as the stored tool path data are supplied to that system part which is connected with the inner reference co-ordinate system.

Preferably, the outer co-ordinate system is physically connected with and follows the movement of the object which is subject to said processing operations.

Further according to the invention, there is provided a robot installation for programmed control of a working tool to perform processing operations on an object, the installation comprising a movable servoactuated robot arm system having more than six degrees of freedom and a data memory for storing preprogrammed tool path data representing the movements of the tool and/or the object relative to each other when performing said 30 processing operations, characterised in that the robot installation includes a co-ordinate transformation module disposed and operative for deriving and storing in the memory said programmed tool data defined in an outer coordinate system without physical connection with the robot arm system, which for achieving suitable cO-ordinate transformation to an inner reference co-

SS

S

OS

OS S

SO

05

I

4 ordinate system associated with the robot arm is subdivided into system parts which are movable relative to each other and each of which has at most six degrees of freedom, and which co-ordinate transformation module is disposed and operative for deriving by means of sensor devices and storing in the memory positional data for each system part, apart from one system part which is connected with the inner reference co-ordinate system, and for utilizing such positional data, with or without directly sensor-derived information as to the positional relation between said inner and outer co-ordinate systems, as co-ordinate transformation data for appropriately correlating the programmed control of the working tool in accordance with the stored tool or object 15 path data defined in the outer co-ordinate system at all times with the inner co-ordinate system associated with the robot arm system.

In a simple and practically suitable embodiment of Soo the robot installation according to the invention the robot arm system is subdivided into at least one first system part having comparatively low motional inertia and ease being disposed and operatively adapted for guiding the working tool in accordance with the stored tool path data, and at least one second system part having considerably higher motional inertia and being disposed o* for coarse-positioning the first-mentioned system part in agreement with said co-ordinate transformation data and with respect to the object in question, for performing i said processing operations. The outer co-ordinate system 6°i 6. 30 is then suitably connected with and follows any movement i of the object to be subjected to the processing operations. i Regarding the above method and installation according to the invention, it would be evident that the present invention also comprises the analogue case in which the positions of the working tool and the object ©0 7 4a are interchanged, which ap lies that the working tool is essentially stationary in operation, whereas the object is moved with respect to the tool in such a way and in agreement with the stored tool path data and co-ordinate transformation data that the object is subjected to the intended processing operations.

The invention will now be described in more detail with reference to the accompanying drawings, on which Figure 1 shows a robot arm system according to the invention and having nine degrees of freedom.

s S* /0 *O

S..S

E9

S*

S

Figure 2 is a combined flow and block diagram illustrating the various process steps included in the programming or teaching of a robot installation according to the invention.

Figure 3 is another combined flow and block diagram, which shows the distribution and utilization during the operation of the robot installation, of the stored tool path data and coordinate transformation data derived during the programmation.

The illustrated servo arm system in Fig. 1 consists of a carrier arm BA in three portions and having three degrees of freedom, as well as a manipulator arm MP mounted on the carrier arm and designed for controlled movement o' a working tool having six degrees of freedom. At its extreme end the manipulator arm is provided with a tool socket VH with a mounting shaft for fixation of a jet spray gun for the 1 painting of motorcars. The mounting shaft is rotatable about its own axis and two further axes which are perpendicular to each other and to the mounting shaft. These rotational axes are schematically indicated by arrows and the designations S4, and S6.

The tool socket VH is mounted on the extreme end of a rigid arm Al, which in turn is pivotably disposed at the one end of a further rigid arm A2, the other end of which is pivotably mounted on a base member A3 for the manipulator arm MP. The axes for the pivotal movements of the arms Al, A2 relative to each other and to the base member A3 are indicated by curved S. arrows S2 and S3, the pivotal movements being actuated by, the *S shown hydraulic cylinders HC.

The base member A3 of the manipulator arm is rotationally mounted on the extreme end of the carrier arm BA for pivotal movements about an axis Sl, which is indicated by a curved arrow in Fig. 1. Thus, the manipulator arm MP as a whole has six degrees of freedom through the described pivotal 4 -0 S6 movements about the axes Sl 56.

The carrier arm BA includes three portions, i.e. a first portion 81 disposed for translational movements back and forth on wall-mounted rails SK along a translational axis 57. On this first portion Bl an intermediate portion 82 is mounted for pivotal movement about a vertical axis SS.

This intermediate portion carries in turn the third portion 83 of the carrier arm, which is mounted for pivotal movements about a horizontal axis S9 with respect to the second or intermediate portion 82. As shown in Fig. 1, this third, outer portion B3 consists of a slanting section adjacent the horizontal pivotal axis and a horizontal section at the extreme end of this portion and serving as platform for pivotable mounting of the base member A3 of the manipulator arm.

Thus, the illustrated robot arm system in Fig. 1 has, totally Snine degrees of freedom, and for the programmation of the m ovements of the working tool and the arm system it is in accordance with the invention considered subdivided in several system parts having each at most six degrees of freedom, i.e.

a first system part having three degrees of freedom and *.consisting of the carrier arm BA, and a second system part *consisting of a manipulator arm MP and having six degrees of freedom. The programmation is then performed in two steps.

:On the one hand tool path data for the working tool is derived 'in an outer coordinate system, which is not physically ,'**.connected with the robot arm system, but rather with the .o bject to be processed, by manually guiding the working tool *in the intended movement pattern with respect to the object.

On the other hand the carrier arm is controlled or guided manually with its three degrees of freedom in such a manner that the manipulator arm at all times is suitably coarsepositioned in such a way with respect to the object that the working tool may be guided in the intended movement pattern A A- I- 4 r i r_-r i i, ~ji ;l ii ;r n~ 7 relative to said object. Through this manually determined movement of the carrier arm positional data for the various motional axes of the carrier arm are derived, and these positional data are stored in a data memory together with the derived tool path data for the working tool.

During the reproduction of the movements which are taught to the robot arm system, the stored positional data for the carrier arm are then utilized as coordinate transformation data for appropriately correlating the programmed control of the working tool on the basis of the stored tool path data in the outer coordinate system at all times with the inner reference coordinate system of the robot arm system, which is physically connected with the manipulator arm MP.

By the fact that the robot arm system on the one hand is controlled by stored tool path data with respect to the object (the outer coordinate system) and on the other hand by the stored positional data for the carrier arm with respect to the same object, the motional pattern of the six-axed manipulator arm MP may be set as the "motional difference" between the intended Dol path and the movement of the carrier arm. In other words, this implies a coordinate transformation between the outer coordinate system and the inner reference coordinate .9oo, system, which is associated with the manipulator arm. Through the fact that the robot arm system is subdivided into an easily movable manipulator arm MP and a solid, but somewhat motionally inert carrier arm, substantial dynamic advantages are achieved. Thus, the easily movable manipulator arm, and in particular the tool socket at its extreme end, takes care a: of the fast movements of the tool, i.e. the jet spray gun in the present case, whereas the heavy and inert carrier arm I takes care of the displacement and suitable coarse-positional i1 adjustments of the manipulator arm with respect to the cbject to be processed.

Thus, the part of the robot arm system having the highest A 0 ,4

I

8 weight and inertia, i.e. the carrier arm, does not need to follow the fine-structural pattern of the tool movement, and possible lag in the servo systems of the carrier arm may easily be compensated by the manipulator arm by means of the coordinate transformation which is performed according to the invention.

Fig. 2 illustrates the basic coordinate transformation principle according to the invention for a robot arm system having an arbitrary number of system parts, of which only the first two C, E and the last ones H, J are shown in the figure, whereas it is indicated that an arbitrary number of further system parts may be included between the parts E and H. Each of the system parts has at most six degrees of freedom, in order that its position is unambiguously defined in an ordinary three-dimentional coordinate system with six motional axes.

During the programmation or teaching of the robot installation the axis positions M for the first system part C are set in the outer coordinate system A. These positional data G for the first system part C are transferred for storage in the memory together with further positional data, as indicated on the right hand side of Fig. 2. At the same time the set position D also influences the next system part E, which is manually adjusted to the axis positions N, as indicated by the corresponding arrow. Positional data R for the system part E are then transferred for storage in similar manner as the positional data G for the system part C, along the arrow line Son the right hand side of Fig. 2. The set position F in the outer coordinate system will then in turn also influence the next system part, which is manually adjusted in the same manner as the system parts C and E.

In similar manner the manual programmed adjustment of the robot arm system continues part by part towards the last but one system part H, which is set to its axis positions 0. The 9 l~jA 4L r- I 9 corresponding positional data S in the outer coordinate system are then transferred together with the positional data for the other system parts along said data bus on the right hand side of Fig. 2 fcr storage L. Tool path data K for the working tool in the outer coordinate system are derived by manually guiding the last system part J and supplied to the data bus for storage L together with the coordinate transformation data for the remaining system parts. The axis positions P for the last system part are then defined, on the one hand by the earlier manually adjusted system parts C, E, H and on the other hand by the directly derived tool path data in the outer coordinate system A.

In Fig. 3 it is shown that all data for storage L are trans- 6@ e ferred to the data store U. During the servo-actuated operation of the robot installation for reproduction of the r: taught or programmed movements of the working tool and the robot arm system, the stored positional data Q, R, S are supplied as coordinate transformation data to the respective associated system parts, i.e. C, E and H, respectively, for appropriate continuous adjustment of the axis positions M, N and 0 of said system parts in the outer coordinate system A, j the mutual actuation between the system parts being indicated by D, F and G.' At the same time the stored tool path data P are supplied from the data store U to the last system part for continuous adjustment of its axis positions P in accordance with these a data, a coordinate transformation from the outer coordinate S* system to the inner reference coordinate system of the robot installation, which is associated with the last system part J, taking place via the conjunction I connecting the last system ij part with the other system parts.

g _J4 r i *07

Claims

1. A method for programmed control of a working tool to perform processing operations on an object by means of a movable servo-actuated robot arm system having more than six degrees of freedom and on the basis of preprogrammed tool path data stored in a data memory and representing the movements of the tool and/or the object relative to each other when performing said processing operations, characterized in that the stored tool path data are derived in an outer co-ordinate system without physical connection with the robot arm system, which for co- ordinate transformation to an inner reference co-ordinate S system associated with the robot arm system is considered subdivided into system parts which are movable with respect to each other and which have at most six degrees 4 e, of freedom, the positional data for each system part, apart from one system part which is con.acted with the inner reference co-ordinate system, being derived and stored in the memory in addition to the programmed tool path data, and utilized, with or without directly sensor- derived information as to the positional relation between ^said inner and outer cO-ordinate systems, as co-ordinate transformation data for appropriately correlating the programmed control of the working tool on the basis of S* the stored tool path data in the outer co-ordinate system at all times with the inner reference co-ordinate system associated with the robot arm system.

2. A method as claimed in Claim 1, in which said tool path data and co-ordinate transformation data are derived by manually controlling the working tool and the robot arm system during programming, in which each system part, apart from the system part connected with the inner reference co-ordinate system, for the derivation and S1 11 storage of its positional data during the manual covitrol at all times is individually placed in such position relation to the outer co-ordinate system that the working tool may be guided to perform its intended processing operations by means of siad system part which is connected with the inner reference co-ordinate system, and thus deriving said tool path data for storage in the outer co-ordinate system and the co-ordinate transformed from said inner reference co-ordinate system.

3. A method as claimed in Claim 1, in which the positional data stored in the memory during the performance of the processing operations of the working tool are supplied to their respective individually associated system parts for the concrol of a servo- actuated system associated with each system part and at all times co-ordinately transformed to the outer co- ordinate system in accordance with the data in question, at the same time as the stored tool path data are supplied to the system part which is connected with the inner reference co-ordinate system.

4. A method as claimed in any one of Claims 1 to 3, in which the outer co-ordinate system is physically connected with and follows the movements of said other of the object which is subject to said processing operations.

5. A method as claimed in any one of Claims 1 to 4, in which the robot arm system is subdivided into at least one first system part having comparatively low motional inertia, for the guidance of the working tool, and at least one system part having considerably higher motional i inertia and disposed to suitably coarse-position the first system part with respect to the object for performing said processing operations. '07 I 'A -~A 12

6. A robot installation 'or programmed control of a working tool to perform processing operations on an object, the installation comprising a movable servo- actuated robot arm system h z-Itng more than six degrees of freedom and a data memory for storing preprogrammed tool path data representing the movements of the tool and/or the object relative to each other when performing said processing operations, characterised in that the robot installation includes a co-ordinate transformation module disposed and operative for deriving and storing in the memory said programmed tool data defined in an outer co- ordinate system without physical connection with the robot arm system, which for achieving suitable S co-ordinate transformation to an inner reference co- l: ordinate system associated with the robot arm is ?i subdivided into system parts which are movable relative to each other and each of which has at most six degrees of freedom, and which co-ordinate transformation module is disposed and operative for deriving by means of sensor devices and storing in the memory positional data for each system part, apart from one system part which is connected with the inner reference co-ordinate system, and for utilizing such positional data, with or without directly sensor-derived information as to the positional relation between said inner and outer co-ordinate systems, as co-ordinate transformation data for appropriately correlating the programmed control of the i working tool in accordance with the stored tool or object path data defined in the outer cc-ordinate system at all times with the inner co-ordinate system associated with the robot arm system, i

7. An installation as claimed in Claim 6, wherein the outer co-ordinate system is physically connected with and follows any movement of the object to be subjected to the 7 A -t r3 A4 t @9 9 S* bO 0 0@ 0 S S @5 13 processing operations.

8. An installation as claimed in Claim 6 or 7, wherein the robot arm system is subdivided into at least one first system part having comparatively low motional inertia and being disposed and operative for guiding the working tool in accordance with the stored tool path data, and at least one second system part having considerably higher motional inertia and being, disposed and operative for coarse-positioning the first system part in agreement with said co-ordinate transformation data and with respect to the object, for performing said processing operations.

9. An installation as claimed in Claim 8, wherein the first system part is a movable carrier arm having three degrees of freedom and at the extreme end of which the second system part is disposed in the form of a manipulator arm having at most six degrees of freedom.

An installation as claimed in Claim 9, wherein the carrier arm is disposed and operative for translational movements back and forth along a given motional path, and for pivotal movements about two mutually perpendicular axes.

11. An installation as claimed in Claim 10, wherein the carrier arm is disposed and operative for translational movements back and forth along a given motional path parallel to the predetermined motion of said object, and for pivotal movements about two mutually perpendicular axes, namely one horizontal and one vertical axis. i i

12. An installation as claimed in Claim 10 or Claim 11, wherein the carrier arm is composed of three portions comprsing one first, inner portion which is disposed for j 99SS 5 S 9 9 99* 9* 9 55 0 uL" 14 said translational movement, a second intermediate portion which is disposed for said pivotal movement about a vertical axis with respect to the first portions, and a third, outer portion which is disposed for pivotal movement about a horizontal axis with respect to the intermediate portion.

13. An installation as claimed in Claim 12, wherein the j third, outer portion has slanting section adjacent the horizontal pivotal axis and a horizontal section at the extreme end of said portion for mounting the second system part selectively on the top or bottom side of the horizontal section.

14. A method substantially as hereinbefore described with reference to the accompanying drawings. A robot installation substantially as hereinbefore described with reference to the accompanying drawings. Dated this 23rd day of November, 1989 DAVIES COLLISON, Patent Attorneys for S TRALLFA ROBOT A/S 0 00 a so A__