METHOD AND ROBOT INSTALLATION FOR PROGRAMMED CONTROL OF A WORKING TOOL

Abstract: A method and robot installation for programmed control of a working tool to perform processing operations on an object on the basis of preprogrammed tool path data (K) stored (L) in a data memory (U) utilize for this purpose a movable servo-actuated robot arm system (MP) having more than six degrees of freedom. During the programmation said path data are derived in an outer coordinate system (A) without physical connection with the robot arm system. For coordinate transformation to the inner coordinate system associated with the robot arm system, this arm system is considered subdivided into system parts (C, E, H, J) which each has at most six degrees of freedom. Positional data (Q, R, F) are derived and utilized for bringing the programmed control of the working tool in the outer coordinate system at all times in appropriate correlation with the inner coordinate system.

Description: Method and Robot Installation for Programmed Control of a Working Tool 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 time 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 arm system having more than six degrees of freedom. It is trivial to find the position of a tool from its axis coordinates in a given coordinate system, even in case the tool is moved by means of an arm system having more than six degrees of freedom. With such high number of degrees of freedom an over-determinate equation system is however to issue, if the corresponding coordinates for the various motional axes of the arm system are to be determined on the basis of the position of the tool. With programming and operation of a' robot having such arm system, it is conse¬ quently 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. Thus, it is an object of the invention to arrive at 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. This is achieved according to the invention by the features that the stored tool path data are derived in an outer coordinate system without physical connection with the robot arm system, which for coordinate transformation to an inner referance coordinate system associated with the robot arm system is considered subdivided into system parts which are movable with respect to each other and each having 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 coordinate system, being derived and stored in the memory in addition to the programmed tool path data, and utilized, possibly together with directly sensor-derived information as to the positional relation between said inner and outer coordinate systems, 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 associated with the robot arm system. Said tool path data and coordinate transformation data are suitably derived in principally known manner by manual control of the working tool and the robot arm 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*. In this case the programmation is performed according to the invention in the manner that each system part, apart from the system part connected with the inner reference coordinate 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 o'uter coordinate system that the working tool may be guided to performing its intended processing operations by means of said system part which is connected with the inner reference coordinate system, and thus deriving said tool path data in the outer coordinate system and coordinate transformed from said inner reference coordinate 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 servo-actuated system associated with each system part and at all times coordinately 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 coordinate system. Preferably, the outer coordinate system is physically connected with and follows the movements of the object which is subject to said processing operations. The invention also concerns a robot installation for programmed control of a working tool to perform processing operations on an object, the installation comprising a movable servo-actuated robot arm system having more than six degrees of freedom and a data memory for storing preprogrammed tool path data. On this background of principally known prior art the robot installation according to the invention further includes a coordinate transformation module disposed and operatively adapted for deriving and storing in the memory said programmed tool path data defined in an outer coordinate system without physical connection with the robot arm system, which for achieving suitable coordinate transformation to an inner reference coordinate system associated with the robot arm are subdivided into system parts which are movable relative to each other and each has 'at most six degrees of freedom, and 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 coordinate system, and utilizing such positional data, possibly together with directly sensor-derived information as to the positional relation between said inner and outer coordinate systems, as coordinate transformation data for appropriately correlating the programmed control of the working tool in accordance with the stored tool path data defined in the outer coordinate system at all time with the inner coordinate system associated with the robot arm system. In a simple and practically suitable embodiment of 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 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 for coarse-positioning the first-mentioned system part in agreement with said coordinate transformation data and with respect to the object in question, for performing said processing operations. The outer coordinate system is then suitably connected with and follows any movement of the object to be subjected to the processing operations. 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 are interchanged, which implies 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. 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 of 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 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, S5 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 hi , 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 arrows S2 and S3, the pivotal movements being actuated by the 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 SI, 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 movements about the axes SI - S6. The carrier arm BA includes three portions, i.e. a first portion Bl disposed for translational movements back and forth on wall-mounted rails SK along a translational axis S7. On this first portion Bl an intermediate portion B2 is mounted for pivotal movement about a vertical axis S8. This intermediate portion carries in turn the third portion B3 of the carrier arm, which is mounted for pivotal movements about a horizontal axis S9 with respect to the second or intermediate portion B2. 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 nine degrees of freedom, and for the programmation of the movements 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 object to be processed, by manually gui'ding the working tool in the intended move ' ment 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 coarse- positioned in such a way wi h respect to the object that the working tool may be guided in the intended movement pattern 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 - _>ol 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 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 * of the fast movements of the tool, i.e. the jet spray gun in the present case, whereas the heavy and inert carrier arm takes care of the displacement and suitable coarse-positional adjustments of the manipulator arm with respect to the object to be processed. Thus, the part of the robot arm system having the highest 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 on 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 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 for 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¬ ferred to the data store U. During the servo-actuated operation of the robot installation for reproduction of the 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, 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 data, a coordinate transformation from the outer coordinate 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 part with the other system parts.

Claims: PATENT 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, characterized in that the stored tool path data are derived in an outer coordinate system without physical connection with the robot arm system, which for coordinate transformation to an inner referance coordinate system associated with the robot arm system is considered subdivided into system parts which are movable with respect to each other and each having 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 coordinate system, being derived and stored in the memory in addition to the programmed tool path data, and utilized, possibly together with directly sensor-derived information as to the positional relation between said inner and outer coordinate systems, 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 associated with the robot arm system. 2. Method as claimed in claim 1, in wh.ich said tool path data and coordinate transformation data are derived by manually controlling the working tool and the robot arm system during the programmation, characterized in that each system part, apart from the system part connected with the inner reference coordinate 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 coordinate system that the working tool may be guided to performing its intended processing operations by means of said system part which is connected with the inner reference coordinate- system, and thus deriving said tool oath data for storage in the outer coordinate system and coordinate transformed from said inner reference coordinate system. 3. Method as claimed in claim 1, characterized in that 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 servo-actuated system associated with each system part and at all times coordinately 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 coordinate system. 4. Method as claimed in claim 1 - 3, characterized in that the outer coordinate system is physically connected with and follows the movements of the object which is subject to said processing operations. 5. Method as claimed in claim 1 - 4, characterised ' in that the robot arm system is subdivided into at least one system part having comparatively low motional inertia, for the guidance of the working tool, and at least one system part having considerably greater motional inertia and disposed to suitably coarse-positioninq the first system part with respect to the object in question for performing said processing operations. 6. Robot installation for programmed control of a working tool to perform processing operations on an object, the installation comprising a movable servo-actuated robot arm system having more than six degrees of freedom and a data memory for storing preprogrammed tool oath data, characterized in that the robot installation further includes a coordinate transformation module disposed and operatively adapted for derivinq and storinq in the memory said programmed tool path data defined in an outer coordinate system without physical connection with the robot arm system, which for achieving suitable coordinate transformation to an inner reference coordinate system associated with the robot arm are subdivided into system parts which are movable relative to each other and each has at most six degrees of freedom, and 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 utilizing such positional data, possibly together with directly sensor-derived information as to the positional relation between said inner and outer coordinate systems, as coordinate transformation data for appropriately correlating the programmed control of the working tool in accordance with the stored tool oath data defined in the outer coordinate system at all time with the inner coordinate system associated with the robot arm system. 7. Installation as claimed in claim 6, characterized in that the outer coordinate system is physically connected with and follows any movement of the object to be subjected to the processing operations. 8. Installation as claimed in claim 6 or 7, characterized in that the robot arm system is subdivided into at least one first system part having comparatively low motional inertia and beinσ disposed and ooeratively adapted for guiding the working tool in accordance with the stored tool oath data, and at least one second system part having considerably higher motional inertia and being disposed and ooeratively adapted for coarse-positioning the first-mentioned system part in agreement with said coordinate transformation data and with resoect to the object in αuestion, for performing said processing operations. 9. Installation as claimed in claim 8, characterized in that 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. 10. Installation as claimed in claim 9, characterized in that the carrier arm is disposed and operatively adapted for translational movements back and forth along a given motional path, preferably parallell to a pre¬ determined motion of said object, and pivotal movements about two mutually perpendicular axes, e.g. one horizontal and one vertical axis. 11. Installation as claimed in claim 8 or 9, characterized in that the carrier arm is composed of three portions, i.e. one first, inner portion which is disposed for said translational movement, a second intermediate portion which is disposed for said pivotal movement about a vertical axis with respect to the first portion, and a third, outer portion which is disposed for pivotal movement about a horizontal axis with respect to the intermediate portion. 12. Installation as claimed in claim 11, characterized in that the third, outer portion has a slanting section adjacent the horizontal pivotal axis and a horizontal section at the extreme end of said portion and preferably adapted for the mounting of the second system part selectively on the top or bottom side of the horizontal section.

Inventors: HETLAND AMUND, HOEIE ODD TERJE, HETLAND, AMUND, HOEIE, ODD, TERJE
Applicants: TRALLFA ROBOT AS, TRALLFA ROBOT A/S
Application year: 1986
Main classification: B25J9
IPC codes: B25J5, B25J9, G05B19