焊接機械手的結構設計
焊接機械手的結構設計,焊接,機械手,結構設計
ABSTRACT
A robot arm comprises a first and a second link, the first link having a proximal end and a distal end and the second link having a proximal and a distal end. A fixed pulley, with circumferential surfaces concentric with the first pivot axis is mounted at the proximal end of the first link. A second-link pulley is fixed to the second link for rotation about the second pivot axis. An end effector pulley is fixed to the end effector for rotation about the third pivot axis. A first belt drive is also provided and includes one or more belts connected between the circumferential surfaces of the fixed pulley and the second link pulley so that ratation of the first link relative to the fixed pulley about the first pivot axis causes rotation of the second link about the second pivot axis relative to the first link. One or more idler pulleys is provided and is rotatably mounted to one or both of the links.At least one of the belt drives includes a first belt engaged with the first circumferential surface of an idler pulley and a second belt engaged with the second circumferential surface of the same idler pulley.
16 Claims, 3 Drawing Sheets
1
ROBOT ARM
CROSS REFERENCE TO RELATED
APPLICATION
This application claims the benefit of U.S. Provisional patent application No. 60/122,184 filed on Mar. 1, 1999, the disclosure of which is incorporated by reference.
FIELD OF THE INVENTION
The present invention relates to a robot arm having an end effector located at the remote end of the robot arm maintaming the same orientation regardless of rotational movemenu of the arm. The robot arm also has at least one idler pulley located within one of the links that allow the diameter of the joints to be enlarged so that wires or other elongated components may pass through the interior of the joints.
BACKGROUND OF THE INVENTION
In the semiconductor industry, robot arms have typically been employed to move semiconductor wafers from one location to another. It is desired in the design of a robot arm in the semiconductor industry to have the end effector maintain the same orientation when the arm moves radially inward and outward. As discussed, for example, in U.S. Pat.Nos. 4,299,533 and 5,064,340, robot arms have been provided with two links and an end effector mounted at a distal end of the second link. The proximal end of the first link is mounted coaxially with a pulley, referred to herein as the "fixed" pulley. The proximal end of the second link is pivotally connected to the distal end of the first link. A first belt connects the fixed pulley to a second link pulley at the
proximal end of the second-link, whereas a second belt connects a housing fixed to the distal end of the first link to a pulley on the end effector. If the lengths of the links are equal, and if the pulleys are selected so that the ratio of rotation of the end effective to rotation of the second link is
一關and the ratio of rotation of the second link to rotation of the first link is -2, the end effector will remaining fixed orientation but will move radially when the first link rotates
relative to the fixed pulley.
While this approach is effective, it imposes some serious design constraints. To provide the desired ratios, a relatively large end effector pulley is needed. For the end effector to rotate one-half the rotation of the second link, the pulley at the end effector must be twice as large as the housing on the distal end of the first link. When the pulley at the end effector is large, it adds significant mass to the end of the robot arm, increasing inertia and making it much more difficult to control precisely the movements of the arm.
Also, to provide the desired ratios, the second link pulley and the housing at the distal end of the second link must be of relatively small diameter, i.e., half the diameter of the fixed pulley. This makes it difficult to connect to wires,pneumatic tubes, or other elongated components extending from the first to the second neighboring link through a hollow bore at the exit of the second link pulley and housing.Such wires, tubes and other elongated components are usually part of the control system for controlling the end effector. Thus, it would be desired to create a robot arm with
enough space at the joint between the links so that these wires and tubes can pass through the center of the joint.
The robot arm of the present invention addresses the problems set forth above and is described more fully below.
SUMMARY OF THE INVENTION
In accordance with one embodiment of the present invention, a robot arm comprises a first and a second link,the first link having a proximal end and a distal end and the second link having a proximal and a distal end. The proximal end of the first link is pivotally connected to a base for rotation relative to a first pivot axis. The proximal end of the second link is pivotally mounted to the distal end of the first link and is capable of rotation about a second pivot axis that is parallel to the first pivot axis. An end effector is pivotally connected to the distal end of the second link and is capable of rotation about a third pivot axis which is parallel to the first and second pivot axes. A fixed pulley, with a circumferential surface concentric with the first pivot axis is mounted at the proximal end of the first link. A second-link pulley is fixed to the second link for rotation with the second link about the second pivot axis. The second link pulley has a circumferential surface concentric with the second pivot axis. A housing is provided and is fixed to the first link at its distal end. The housing has a circumferential surface concentric with the second pivot axis. An end effector pulley is fixed to the end effector for rotation about the third pivot axis and the end effector pulley has circumferential surfaces concentric with the third pivot axis. A first belt drive is also provided and includes one or more belts connected between the circumferential surface of the fixed pulley and the circumferential surface of the second-link pulley so that rotation of the first link relative to the fixed pulley about the first pivot axis causes rotation of the second link about the second pivot axis relative to the first link. The first belt drive is arranged to provide a first ratio between the rotation of the first link relative to the fixed pulley and rotation of the second link relative to the fixed pulley. A second belt drive includes one or more belts connected between the circumferential surface of the housing and the circumferential surface of the end effector pulley so that rotation of the second link relative to the first link, about the second pivot
axis, causes rotation of the end effector about the third pivot axis relative to the second link. The second belt drive is arranged to provide a second ratio between the rotation of the second link relative to the first link and rotation of the end effector relative to the second link. One or more idler pulleys are provided and are rotatably mounted to one or both of the links. Each of the idler pulleys define a first and second circumferential surface. At least one of the belt drives includes a first belt engaged with the first circumferential surface of an idler pulley and a second belt engaged with the second circumferential surface of the same idler pulley.
Preferably, the first ratio has a value of -2 where rotation of the first link through an angle 8 causes the second link pulley and the second link to turn through an angle of -26 with respect to the first link. Thus, if the first link travels through a 450 angle counterclockwise, this will result in the second link pulley and the second link turning through an angle of 900 in the clockwise direction relative to the first link.
It is also preferred that the second ratio has a value of ? where rotation of the second link through an angle 0 causes the end effector pulley and the end effector to turn through an angle of -1/z0 with respect to the second link. For example, if the second link turns through an angle of 90
degrees in the clockwise direction, this will result in the end effector pulley and the end effector turning through an angle of 450 in the counterclockwise direction relative to the second link.
Because one or more of the belt drives includes an idler pulley and two belts, the pulley and housing diameters need not be selected as described above in connection with the prior art belt drives. For example, where the robot arm includes a first idler pulley mounted to the first link, the first belt of the first belt drive engages the first circumferential surface of the idler pulley and the circumferential surface of the fixed pulley. The second belt of the first belt drive engages the second circumferential surface of the first idler pulley and the circumferential surface of the second-link pulley.
Also preferably, the robot arm has a second idler pulley mounted to the second link. The second belt drive desirably comprises a first belt extending from the circumferential s surface of the housing to the first circumferential surface of the second idler pulley. The second belt drive desirably further comprises a second belt extending from the second circumferential surface of the second idler pulley to the end effector pulley. Preferably, the ratio of the diameter of the first circumferential surface of the second idler pulley to the diameter of the second circumferential surface of the second idler pulley is more than 1:1 as, for example 2:1. This ratio of more than 1:1 in the second idler pulley allows a relatively smaller end effector pulley on a smaller housing, or both, than what will be provided in the absence of the second idler pulley.
Preferably, the robot arm further includes elongated components and the second link pulley and housing include an internal bore. The elongated components desirably extend from the first link through the bore and into the second link.These elongated components may include wires, fiber optics or pneumatic or hydraulic hoses that are needed to operate the robot arm. The end effector pulley may also include an internal bore, and the elongated components can extend from the second link to the end effector.
Preferably, the robot arm further includes a base and a first rotary motion actuator that is connected to the base of rotation for rotating the first link relative to the fixed pulley about the first pivot axis so as to move the end effector radially as described above. A further rotary motion actuator may be provided for rotating the fixed pulley and the first link so as to swing the entire arm about the first pivot axis.
BRIEF DESCRIPTION OF THE DRAWINGS
FIG. 1 is a perspective view of a robot arm in accordance with one embodiment of the present invention.
FIG. 2 is a cross-sectional elevational view of the robot arm in FIG. 1.
FIG. 3 is a top cross-sectional view of the robot arm of
FIG. 1 with the first link partially shown in phantom.
DE7AILED DESCRIPTION OF THE PREFERRED EMBODIMENT
As shown in FIGS. 1一，a robot arm 10 is mounted to a base 11 and has a first link 12 and a second link 14. The first link has a proximal end 16 and a distal end 18. Likewise, the second link 14 has a proximal end 20 and a distal end 22. The first and second links 12 and 14 are preferably hollow and can be made of metal, plastic or any other suitable material. First link 12 is mounted to base 12 for rotation relative to the base about a first pivot axis 28 of a first joint 24 at the proximal end 16 of the first link 12. A fixed pulley 26 is also mounted for rotation about the first pivot axis 28 at the first joint 24. The fixed pulley 26 includes a circumferential surface 30 (FIG. 3) that is concentric with the first pivot axis 28. Also extending from the first joint 24 is a shaft 32 fixed to the first pulley and a drive pulley 33 fixed to first link 12. Drive pulley 33 is connected to a first rotary motion actuator 35 so that the first actuator can drive the first link in rotation about axis 28. Shaft 32 is connected to a second actuator 37 which can drive the fixed pulley 24 in rotation about the axis 28 concurrently with rotation of the first link 12 or hold the drive pulley fixed against such rotation. The first actuator may include any conventional rotary actuator such as, for example, a stepped motor, a conventional electric motor, or the like. The second actuator may include similar components, or may include a first brake to link the fixed pulley 24 to arm 12 for rotation therewith and a second brake to hold the fixed pulley in a fixed position relative to the housing. The first and second actuators are commanded by a conventional control system (not shown).
The first link 12 and the second link 14 are pivotally connected at a second joint 34. The first and second links 12 and 14 are able to rotate with respect to each other about a second pivot axis 36 that is parallel to the first pivot axis 28. A second-link pulley 38 is mounted on the second joint 34 and has a circumferential surface 40 that is concentric with the second pivot axis 36. The second-link pulley 38 is fixed to the second link 14. A housing 42 is also provided at the second joint 34 and is fixed to the first link 12. The housing 42 also has a circumferential surface 44 that is concentric with the second pivot axis 36.
A third joint 46 is provided at the distal end 22 of the second link 14. An end effector pulley 48 is mounted at the third joint 46 and is able to rotate about a third pivot axis 50. The end effector pulley 48 has a circumferential surface 52 concentric with the third pivot axis 50. An end effector 54 is attached to the end effector pulley 48 and is capable of rotation about the third pivot axis 50. The end effector 54 may include fingers or other fixtures for holding a workpiece to be moved.
A first idler pulley 56 is mounted to the first link 12 between the fixed pulley 26 and second-link pulley 38. The first idler pulley 56 has a first circumferential surface 58 and a second circumferential surface 60. A second idler pulley 62 is mounted to the second link 14 and has a first circumferential surface 64 and a second circumferential surface 66. The first and second idler pulleys 56 and 62 rotate about axes 68 and 69 that are parallel to the first, second and third pivot
axes 28, 36 and 50.
A first belt drive 71 on first link 12 includes a first belt 70 engaging the circumferential surface of the fixed pulley 30 and the first circumferential surface of the first idler pulley 58, and a second belt 72 extending from the second circumferential surface 66 of the first idler pulley 62 to the circumferential surface 40 of the second-linked pulley. A second belt drive 75 on second link 14 includes a first belt 74 extending from the circumferential surface 44 of the housing 42 to the first circumferential surface 64 of the second idler pulley 62. A second belt 76 extends from the second circumferential surface 66 of the second idler pulley 62 to the circumferential surface 52 of the end effector pulley 48. The first and second belts 74 and 76 of the second idler pulley 62 form the second belt drive 75 of the second link. The belts 70, 72, 74 and 76 are preferably belts having
cleats on teeth, of the type commonly referred to as "timing belts" and are held taut to the pulleys. The pulleys have mating teeth on their circumferential surfaces. It should be appreciated by those skilled in the art that the belts can be conventional friction drive belts, v-belts or chains and the
pulleys would be selected accordingly.
In operation, to move the end effector radially, a first actuator 35 causes the first link 12 to rotate about the first pivot axis 28 while second actuator 37 holds the fixed pulley 26 against rotation. Because the fixed pulley 26 is stationary with respect to the first link 12, the rotation of the first link 12 results in the first idler pulley 56 rotating in the opposite direction as the first link 12. As best seen in FIG. 3, if for example the first link is rotated in the counter clockwise direction, the first idler pulley 56 will rotate in the clockwise direction with respect to the first link causing the second belt 72 of the first belt drive to move. The second belt 72 of the first idler pulley 56 is engaged with the second-link pulley 38, which is fixed to the second link 14. The movement of
belt 72 causes clockwise movement of the second-linked pulley 38 so that the second link 14 rotates about the second pivot axis 36 in the clockwise direction relative to the first link 12.
The amount of movement of the second link relative to the first link depends on the overall ratio provided by the first belt drive 71 on the first link. This in turn depends on the ratio of the diameters of the fixed pulley 26 and the second-link pulley 38 as well as the ratio of the diameters, of the first circumferential surface 58 and second circumferential surface 60 of the first idler pulley 56. In the particular embodiment shown, the diameter of the fixed pulley 26 is twice the
diameter of the second-link pulley 38. Thus, whereas the first and second circumferential surfaces 58 and 60 of the first idler pulley 56 have the same diameter, a 450 rotation of the first link 12 in the counter clockwise direction will result in a 900 rotation of the second link 14 in the clockwise
direction relative to the first link 12.
Because the housing 42 is fixed to the first link 12,rotation of second link 14 relating to first link 12 causes the first belt 74 of the second belt drive 75 to move relative to the second link 14. For example, if the second link rotates in the clockwise direction, the first belt 74 of the second idler pulley 62 will move and will turn the second idler pulley 62 in the counter clockwise direction relative to the second link.This moves the second belt 76, engaged with the second circumferential surface 66 of the second idler pulley 62, in the counter clockwise direction. As the second belt 76 of the second belt drive 75 is engaged with the end effector pulley 48, the movement of second belt 76 results in the end effector 54 also turning in the counter clockwise direction relative to second link 14.
As best shown in FIG. 3, the amount of movement of the end Erector 54 relative to the second link 14 depends on the diameters of the circumferential surface 44 of the housing 42, the ratio of diameters of the first and second circumferential surfaces 64 and 66 of the second idler pulley 62 and the diameter of the circumferential surface 52 of the end effector pulley 48. In the particular embodiment illustrated, the ratio of diameters between the circumferential surface 44 of the housing 42 and the first circumferential surface 64 of the second idler pulley 62 is 1:1. Thus, the second link turning 900 in the clockwise direction results in the second idler pulley rotating 900 in the counter clockwise direction.
The diameter of the second circumferential surface 66 of the second idler pulley is 1/z the diameter of the first circumferential surface 64. A 900 rotation of the first circumferential surface 64 will result in a 900 rotation of the second circumferential surface 66 but the linear movement of belt 76 is only 1/z the linear movement of belt 74. Further, the ratio of the diameters of the second circumferential surface 66 of the second idler pulley 62 to the diameter of the circumferential surface 52 of the end effector pulley 48 is 1/za. Thus, if the second idler pulley 62 rotates through 900, the end effector pulley would only rotate 450. Because the end effector 54 is rigidly attached to the end effector pulley 48, the end effector also rotates 450. This arrangement translates a 900 clockwise movement o
收藏