Login| Sign Up| Help| Contact|

Patent Searching and Data


Title:
A PARALLEL KINEMATIC MANIPULATOR AND A METHOD OF OPERATING THE SAME, INCLUDING PAIRWISE ACTUATORS
Document Type and Number:
WIPO Patent Application WO/2004/056538
Kind Code:
A1
Abstract:
An industrial robot (1) including a parallel kinematic manipulator (2) comprising a stationary platform (2), a movable platform (20), and three arms (6, 7, 10) connecting the stationary platform (2) with the moveable platform (20). Each arm comprising a first arm part (6a, 7a, 10a), a second articulated arm part (6b,7b,10b) 10) and an first actuator (3, 4, 5) for moving the arm (6, 7, 10) in relation to the stationary platform (2). The first arm part (6a) comprises an additional, fourth actuator (21) arranged to tilt the platform (20) around a tilt axis.

Inventors:
BROGAARDH TORGNY (SE)
LUNDBERG IVAN (SE)
WAEPPLING DANIEL (SE)
FENG XIAOLONG (SE)
ROBBERTS OLA (SE)
JOHANSSON JAN (SE)
FRISK MARTIN (SE)
PERSSON JAN-GUNNAR (SE)
Application Number:
PCT/SE2003/002056
Publication Date:
July 08, 2004
Filing Date:
December 22, 2003
Export Citation:
Click for automatic bibliography generation   Help
Assignee:
ABB AB (SE)
BROGAARDH TORGNY (SE)
LUNDBERG IVAN (SE)
WAEPPLING DANIEL (SE)
FENG XIAOLONG (SE)
ROBBERTS OLA (SE)
JOHANSSON JAN (SE)
FRISK MARTIN (SE)
PERSSON JAN-GUNNAR (SE)
International Classes:
B23Q1/54; B25J17/02; (IPC1-7): B25J17/02; B23Q1/44
Domestic Patent References:
WO2003059581A12003-07-24
Foreign References:
US6047610A2000-04-11
DE19710171A11998-09-17
US20040013509A12004-01-22
US6047610A2000-04-11
Attorney, Agent or Firm:
ABB AB (Västerås, SE)
Download PDF:
Claims:
CLAIMS
1. An industrial robot (1) including a parallel kinematic manipulator (2) comprising a stationary platform (2), a movable platform (20), and three arms (6,7, 10) connecting the stationary platform (2) with the moveable platform (20), each arm comprising a first arm part (6a, 7a, 10a), a second articulated arm part (6b, 7b, 10b) 10) and an first actuator (3,4, 5) for moving the arm (6,7, 10) in relation to the stationary platform (2), characterized in that the first arm part (6a) comprises an additional, fourth actuator (21) arranged to tilt the platform (20) around a first tilt axis ().
2. An industrial robot according to claim 1, wherein the second arm (7a) comprises an additional, fifth actuator (22) arranged to tilt the platform (20) around a second tilt axis ().
3. An industrial robot according to claim 1 or 2, wherein the first actuator (3,4, 5) is adapted to rotating movement.
4. An industrial robot according to any of claim 13, wherein the third arm (10a) comprises an additional, sixth actuator (24).
5. An industrial robot according to claim 5, a secondary platform (32) arranged on the movable platform (20) is adapted to be rotated by the sixth actuator (24).
6. An industrial robot according to claim 1, wherein the third articulated arm (lOb) comprises a joint (19B, 30) attached to the movable platform (20).
7. An industrial robot according to claim 7, wherein the joint (19B, 30) is attached in line with joints (17B) and (18B) connecting the articulated arm part (7b) and the movable platform (20).
8. An industrial robot according to claim 7, wherein the joint (19B, 30) is attached in line with joints () and (18B) connecting the articulated arm part (7b) and the movable platform (20).
9. An industrial robot according to any of claim 13, wherein the first actuator (3,4, 5) is adapted to linear movement.
10. An industrial robot according to claim 9, wherein the third articulated arm (410B) comprises a joint (430) attached to the movable platform (20).
11. An industrial robot according to claim 10, wherein the joint (430) is attached in line with joints (417B) and (418B) connecting the articulated arm part (407B) and the movable platform (420).
12. An industrial robot according to claim 10, wherein the joint (430) is attached in line with joints (414B) and (415B) connecting the articulated arm part (407B) to the movable platform (420).
13. A method of operating an industrial robot (1) including a parallel kinematic manipulator (2) comprising a stationary platform (2), a movable platform (20), and three arms (6,7, 10) connecting the stationary platform (2) with the moveable platform (20,420), each arm comprising a first arm part (6a, 7a, 10a), a second articulated arm part (6b, 7b, 10b) and an first actuator (3,4, 5) for moving the arm (6,7, 10) in relation to the stationary platform (2), characterized in that the first arm part (6a) is brought to comprise an additional, fourth actuator (21) adapted to tilt the platform (20) around a first tilt axis (), the second arm (7a) is brought to comprise an additional, fifth actuator (22) arranged to tilt the platform (20) around a second tilt axis () such that upon tilting the platform (20) is brought to tilt about an arbitrary axis () obtaining five degrees of freedom.
14. A method according to claim 13, wherein the first actuator (3,4, 5) is brought to rotational movement.
15. An method according to claim 13, wherein an additional, sixth actuator (24) comprised in the third arm (10a) is brought to rotational movement.
16. An method according to claim 15, wherein the sixth actuator (24) is brought to rotate a secondary platform (32) arranged on the movable platform (20) obtaining six degrees of freedom.
17. A method according to claim 13, wherein the first actuator (3,4, 5) is brought to linear movement.
18. Use of the industrial robot according to any of claims 112 to perform the method according to any of claim 1317 for accurate compensation of its movements due to the movements of the stationary platform 2.
19. Use of the industrial robot according to claim 17, wherein the stationary platform is arranged on a ship.
Description:
A parallel kinematic manipulator and a method of operating the same, including pairwise actuators TECHNICAL FIELD The present invention relates to an industrial robot, inclu- ding a manipulator and a control unit having means for auto- matically operating the manipulator. The manipulator compri- ses a parallel kinematic manipulator including at least three arms, each comprising a link arrangement. The three link arrangements together carry, directly or indirectly, a working platform member arranged to execute the function aimed at.

The determination"parallel kinematic manipulator", PKM, is defined as a manipulator comprising a first stationary element, a second movable element (platform) and at least three arms. Each arm comprises a supporting first arm part and a second arm part, the latter consisting of a link arrangement connected to the movable platform. Each first arm part is actuated by a driving means preferably arranged on the stationary element to reduce the moving mass. These link arrangements transfer forces due to actuation of the supporting first arm parts when manipulating the movable platform.

BACKGROUND OF THE INVENTION The well-known robot type named SCARA robot is a serial kinematic manipulator primarily used for moving and rotating objects without changing the inclination of the objects. The manipulator comprises kinematic links coupled in series.

These robots normally have four degrees of freedom in the x, y-, z-directions and (pz (rotation of the object about an axis parallel to the z-axis). For manipulating the object in the xy-plane, two arms coupled in series and working in the xy-plane are used. In order to achieve a movement in the z- direction a linear movement device is used. This device is arranged either after the arms coupled in series or before

the arms coupled in series. In the first case the arms coupled in series must move the drive assembly for the z- movement and in the latter case the drive assembly for the z-movement must move the arms coupled in series. The drive assembly for the (pz-movement will always be located at the extreme end of the kinematic chain of the robot.

Several of the properties concerning the SCARA-robot are improved with a robot, which manipulates an object through working in parallel, i. e. a parallel kinematic manipulator, PKM. According to the statements above, a serial kinematic robot comprises a large mass and thus becomes compliant with low mechanical natural frequencies, the accuracy is limited and large motor torques are required for accomplishing high acceleration, jerk and speed movements possible.

A parallel kinematic robot is a design offering a high degree of load capacity, high stiffness, high natural frequencies and low weight. Three arms working in parallel are required to obtain manipulation of a platform in three degrees of freedom, i. e. the x, y and z-directions in a Cartesian system of coordinates. Six arms working in parallel are required to obtain manipulation of a platform in all six degrees of freedom, i. e. the x, y, z directions and the rotation angle/inclination of an object arranged on the platform.

Ideally, an object ought to be manipulated by a total of six separate links, which transfer only compressive and tensile forces to the manipulated object to obtain a stiff and accurate manipulation. Generally, the PKM comprises three up to six first arm parts. As an example, a manipulator with four arms designed for four degrees of freedom has second arm parts sharing the six separate links. This is only possible with certain combinations of the links, as for example, 2/2/1/1 or 3/1/1/1. 2/2/1/1 means that two suppor- ting first arm parts are connected to the respective second arm part, which comprises two links and another two suppor-

ting first arm parts are connected to the respective second arm part, which comprises a single link.

A known manipulator is manipulating a platform, which remains with unchanged inclination in the whole working area. The robot has three supporting first arm parts, each connected to a second arm part, in kinematic parallelism.

From this robot, it is known to arrange a total of six links optionally distributed on three first arm parts according to the combinations 2/2/2 or 3/2/1.

A known device for relative movement of a first element in relation to a second element according to the combination 2/2/2 is disclosed in the international application WO 99/58301. The three arms each comprise a supporting first arm part connected to a second arm part, which includes a link arrangement. The first element is described as sta- tionary and the second element is manipulated in the x-, y- and z-direction by driving means. Each link arrangement is connected to a supporting first arm part and to the second element, respectively, by means of joints of 2 or 3 degrees of freedom. Each driving means comprises a stationary por- tion and a rotating portion, where the stationary portion is included in the first, stationary element. Using the refer- ence numbers in the document, each driving means has its rotating portion connected to the first arm parts 6,7 and 8. The driving means 3 is pivoting the first arm part 6 and the driving means 4 is pivoting the first arm part 7 about the same geometrical axis 37. The third driving means 5 is pivoting the first arm part 8 about a geometrical axis 38, which is non-parallel to the pivoting axis 37. The third driving means 5 implies that upon pivoting of the supporting arm part 7 by means of the driving means 4 also the support- ing arm part 8 will accompany as a consequence of the fact that an axis 53 and also a gear wheel 10 will accompany the pivoting movement. Thus, the driving means 4 and 5 must accelerate more and are more heavily loaded compared with the driving means 3. Consequently, this manipulator design

necessitates three different driving means designs with three different drive dimensions. This makes the design more complicated and the manipulator relatively expensive to pro- cess. Another consequence is that the first driving means carries the highest moment of inertia and there will be an uneven distribution of the moment of inertia in the manipu- lator. Moreover, the mechanical natural frequencies will be lower because of the extra mass that axis 2 has to rotate, which gives a less accurate control at higher motion fre- quencies.

A device for relative movement of a first and a second element according to the second combination 3/2/1 is dis- closed in the international application WO 97/33726. The device comprises a manipulator including three arms each arranged to connect a stationary and a movable platform.

Each arm comprises a supporting first arm part and a second arm part connected to each other, where respective second arm part comprises a link arrangement. Three actuators are fixed to the stationary platform and actuate one first arm part each. A first supporting arm part is connected to a second arm part linkage arrangement comprising three links in parallel. Another first arm part is connected to a double link arrangement and still another first arm part is connec- ted to a single link, where all links are connected to the movable platform.

The document US 5,539, 291 shows a parallel kinematic manipu- lator. A stand sustains a biaxial controllable supporting arm part. This arm part supports, in its turn, a second arm part, which sustains a movable object. A first and a third supporting arm pivoting around a common pivot axle are con- nected to the movable object via outer arms comprising belts with the function of a combination between an arm part and a four linkage. The outer arms and the second supporting arm are arranged to transmit compressive and tensile forces as well as torsion moments. The result is a relatively bulky design of a manipulator with a limited operating volume.

Moreover, the shown manipulator comprises less stiffness, lower accuracy and much lower mechanical natural frequencies when compared with a manipulator comprising arm parts trans- mitting only compressive and tensile forces.

SUMMARY OF THE INVENTION In many contexts, for example when mounting gearboxes, cleaning castings, machining engine blocks, grinding turbine blades and vehicle propellers, aligning rockets in coast corvettes, and aligning body parts in orthopedic operations, a robot having five degrees of freedom is required, wherein the two degrees of freedom for orientation only need to have a working range of 45 degrees. In these cases, it is then advantageous not to introduce a separate wrist in a parallel-kinematic robot but to be able to manipulate all the degrees of freedom with the parallel-kinematic mecha- nism. This results in a much lighter robot structure and eliminates all the problems that may arise in having elec- tric motor operation in the vicinity of the object that is to be manipulated. Because of the lighter robot structure, less driving moment is required in the actuators, which provides a lighter robot and increased personal safety due to a smaller movable mass. The smaller movable mass also permits the robot to be manipulated more quickly and with higher precision and, for example during assembly applica- tions, a much more efficient force control may be achieved.

The absence of motors in the vicinity of the manipulated object for orientation thereof enables the robot to work in severe environments, for example in a marine environment or in a foundry environment, and facilitates arranging it for a sterile robot environment in a hospital environment.

In a complete parallel-kinematic robot, a platform is mani- pulated with six articulated rods, each of which only trans- mits forces in an axial direction (no bending moments or torsional movements are obtained in the articulated rods).

To manipulate the position of the platform, the articulated rods are connected in groups to three actuators, either with

two articulated rods in each group (2/2/2 configuration) or with three articulated rods in a fist group, two in a second group and one in a third group (3/2/1 configuration). To also manipulate, at the same time, two orientation angles of the platform, four groups are required with one actuator for each group, and a 2/1/1/1/1 configuration is obtained. For actuators with pivoting arms, five arms are then required, where each arm is connected to one group of articulated rods. However, the large number of arms will result in the robot becoming high and difficult to use in, for example, marine applications or in operating theatres. To circumvent this problem, pairwise actuators are instead introduced according to the device described in this patent applica- tion, said actuators both positioning and angularly adjust- ting an actuator platform on which a group of articulated rods is mounted. In their simples form, the actuators that are used for positioning and that drive groups of two or more articulated rods are supplemented with a rotating actuator which has its axis of rotation essentially perpen- dicular to the swinging plane that is stretched up/created by two of the articulated rods included in the group in question. This will cause the supplementary actuator to parallel-displace two articulated rods relative to each other, hence giving rise to a change in orientation of the manipulated platform.

The control includes a kinematic model of the robot with five degrees of freedom. With this model, the actuator positions (or actuator angles) are calculated as a function of position and orientation of the tool that is mounted on the movable platform. In one program, they are given posi- tions and orientations which the tool is to assume when, for example, milling an engine block for a car. Between these programmed positions with associated orientations, a path for the position and orientation of the tool, with a reso- lution of 0. 01 seconds, is interpolated. With the aid of the kinematic model, the corresponding actuator positions and/or actuator angles are then calculated and supplied to the

servo of each actuator as position references, and by using reference filters and optimum servo algorithms, the tool will carry out its work with a high precision. In addition to a kinematic model, also a dynamic model is required for control of acceleration and deceleration ramps so that the servo reference will always be possible to track with the installed. Furthermore, in force control, an external Cartesian servo pool is required, which ensures that the tool applies the force against the work object that is required for accurate material cutting.

By accurate control of position and orientation of the tool or object that is handled by the robot, different operations can be carried out with high precision and speed. If, in addition, a six-axis force sensor is mounted between the tool/object and the manipulated platform, force and moment can be controlled for precision with respect of 5 DOF force/torque between the tool and the work object. During mounting, this may be used for rapidly sensing the forces and moments that act between, for example, two parts of a gearbox during mounting thereof. These forces and moments may then be rapidly used to give the two parts the correct relative motions for a quick mounting. During machining, the high stiffness of the robot may be directly utilized, for example, for milling a plane of an engine block for a car without the robot yielding to the tool forces. If the robot is used for picking up and aligning a rocket in, for example, a corvette, the robot may be both accurately positioned in the pick-up position and accurately position and orient in the firing position. In addition, because of its stiffness and small movable mass, the robot may accurately compensate its movements for the movements of the ship caused by heavy sea.

As mentioned above, this solution will be more compact, and the weakness in two extra arms for the tilting need not be taken into consideration in the case of a robot having arms.

In addition, the introduction of mechanical end-position

stops and limit switches for shafts axes 4 and 5 will be facilitated. A further advantage is that the working range will be somewhat larger when there is a risk of collision between actuator arms and articulated rods in the case of an arm robot. In the case of a linear robot, the solution will also be less expensive since a rotational actuator is less expensive to install than an extra linear shaft which must have a full working range plus an extra range for tilting in the end positions.

BRIEF DESCRIPTION OF THE DRAWINGS Figure la is a parallel kinematic manipulator according to the invention obtaining five degrees of freedom, Figure 1b and Ic, respectively is a system of coordinates, Figure 2 is the robot I Fig. 1 with an alternative group of articulated links, Figure 3 is a parallel kinematic manipulator according to the invention obtaining six degrees of freedom, Figure 4 is a PKM according to the invention comprising linear actuators, Figure 5 is an alternative parallel kinematic manipulator according to the invention, Figure 6 is the robot in Figure 6 with a changed tilt angle, Figure 7 is the robot in Figure 6 with a changed tilt angle, Figure 8-14 shows the movement pattern of the robot in Figure 15a and 15b, respective is an alternative parallel kinematic manipulator comprising four actuators.

DESCRIPTION OF THE PREFERRED EMBODIMENTS Figure la shows a first version of the parallel-kinematic structure covered by the invention. For positioning the movable platform 20, three parallel connecting structures are used, which are driven by three arms mounted on the rotating actuators 3,4 and 5. These actuators are fixedly mounted on a central column 2 fixed in a floor with the foot 1. The robot may also be turned upside down, whereby the foot is mounted nearest actuator 5. Actuator 3 pivots the arm 6, on which a fourth actuator 21 is mounted. This actu-

ator may rotate the outer arm part 8 about an axis substan- tially concentric with the arm parts 6 and 8. When the arm part 8 is rotated, elements 11 and 12 will pivot. This pi- voting motion causes the link 14 to move relative to the links 15 and 16. The link 14 is mounted on the element 11 with a joint 14A having at least two degrees of freedom and the links 15 and 16 are mounted on the element 12 with the joints 15A and 16A, which also have at least two degrees of freedom each. At their other ends, the links 14,15 and 16 are mounted on the movable platform 20 with the joints 14B, 15B and 16B, which also have at least two degrees of free- dom. With this arrangement, rotations of the arm part 8 with the aid of the actuator 21 will give rise to tilting of the platform 20. In a corresponding way, rotations of the arm part 9 with the actuator 22 will cause tilting of the plat- form 20, but about another tilt axis. Actuator 22 is mounted on the arm part 7, which is rotated around the column 2 by actuator 2. On the arm part 9 the element 13 is mounted, on which the joints 17A and 18A are fixed. At their other ends, the links 17 and 18 are mounted on the platform 20 via the joints 17B and 18B. Also the joints 17A, 17B, 18A and 18B have at least two degrees of freedom. Finally, actuator 5 is used for rotating the arm 10, which is connected to the platform 20 via the joint 19A, the link 19 and the joint 19B. A favourable embodiment is for all the B joints to have two degrees of freedom for pivoting the links in all direc- tions and for all the A joints to have three degrees of freedom.

Since actuator 21 tilts the platform 20 about a tilt axis and actuator 22 tilts it about another tilt axis, these two actuators will make possible tilting of the platform about an arbitrary axis within the tilt working range. This work- ing range is limited by the link geometry and may reach 45 degrees.

The joint 19B is as an alternative attached to the platform 20 in line with the joints 17B and 18B or in line with the

joints 14B and 15B. Each of these alternative gives a well defined reorientation around the Z-axis of the robot.

Figure 1b is a system of coordinates attached on the first arm 6 in Figure la. The X-axis coincides with the link 14, the Y-axis coincides with the axis of rotation of actuator 21 and the Z-axis coincides with the element 11. To make the tilting possible, the link geometry must be arranged such that the element 11 is projectable in the XZ-plane.

Figure lc is the same system of coordinates as in Figure 1b showing the links 14 and 15. To make the tilting possible, the link geometry must be arranged such that the element 11 is projectable in the YZ-plane.

When positioning the platform, the links 15 and 16 will control the orientation of the platform relative to the direction of the element 12. This means that a dependence between the orientation of the platform and the angle of actuator 3 is obtained. To reduce this dependence, the link geometry of the links 15 and 16 may be changed so that these links receive a common joint towards the element 12 accord- ing to Figure 2. Thus, in this figure, both links 15 and 16 are mounted on the joint 23A with three degrees of freedom.

Vectors 100,101, 102,103, 104 and 105 are added to the Figure. Otherwise, the structure in Figure 2 is identical with that in Figure 1.

Figure 3 shows the possibility of'obtaining six degrees of freedom in the described structure. Here, an actuator 24 is mounted on the arm 10, which actuator, via the shaft 10, the V-gear unit with the gear wheels 27 and 28, the cardan joint 28, the link 29, the cardan joint 30 and the shaft 31, pro- vides an infinite rotational working range for the secondary platform 32. In principle the Figure 3 is a robot comprising one actuator in each arm. The actuator 24 is supposed to be comprised within the arm 10. It is showed on the arm to show the principle.

Figure 4 shows how the same concept for tilting the mani- pulated platform may be used in a parallel-kinematic mani- pulator with linear actuators for positioning the platform.

The manipulator here comprises three linear actuators 1,2, 3, which may be of direct-drive type or include some form of transmission for transforming a rotating movement of the motors 4,5 and 6 into linear movements of the vehicles 7,8 and 9. On the vehicle 1, a rotating actuator 19 is mounted, said actuator via the shaft 20 turning the element 10 so as to obtain a tilting movement of the platform 18 via the links 412,413 and 414. In a corresponding way, the rotating actuator 21 is mounted on the vehicle 8 and via the shaft 22, the element 11 and the links 415 and 416 the actuator 21 may bring about a tilting movement of the platform 18 but about a different tilt axis. The vehicle 9 is connected via the link 410 to the platform 18 and is used for positioning thereof. With an arrangement according to Figure 3, however, the link 410 may be used for rotating a secondary platform.

Because the output shaft of the actuator for this rotation may be aligned in a favourable direction, the V-gear unit with the gear wheels 26 and 27 are not needed in this case.

Further, by allowing the links 413 and 414 to share a joint towards the element 10 (broken lines in Fig. 4), the same linkage arrangement as in Figure 2 may be obtained.

Figure 5 shows a simulation method of the embodiment accor- ding to Figure 1 but with actuator 5 mounted at the bottom in the column 2 to obtain a free working range below the roof in an installation for handling rockets in a military marine application. In addition, the joint 19B is mounted in the lower part of the movable platform 20.

Figures 6 and 7 show the robot at two different tilt angles of the platform. The robot structure is the same as in Figure 5. The movement pattern of the robot according to Figure 5 is illustrated in the Figures 8-14.

Figure 15a and 15b, respective is an alternative parallel kinematic manipulator comprising four actuators.