1. Field of the Invention
The present invention relates to a manipulating device aiming at the production of four-degree-of-freedom displacements of a rigid body.
2. Description of the Prior Art
Four-degree-of-freedom displacements were first studied by the German mathematician-mineralogist Arthur Moritz Schönflies (1853-1928), who found that these displacements have the algebraic structure of a group. For this reason, the set of such motions is known to geometers as the Schönflies subgroup of the group of rigid-body displacements. A familiar instance of Schönflies motions is found in the motions undergone by the tray of a waiter: the tray is free to move in all directions, but is prevented from tilting. The displacements comprise three independent translations and one rotation about an axis of fixed orientation with respect to a fixed base.
Schönflies motions are suitable for assembly tasks of the type occurring in the electronics industry. In these tasks, electronic chips having a flat geometry are picked up from a magazine, where they lie in a planar array. The chips are then placed on an electronic board in a planar array as well, the two planes involved being parallel but lying at different levels, the arrays thus having different orientations. These tasks require free translations in the three directions of space plus one free rotation about an axis of orientation fixed with respect to the plane of the magazine. The mechanism realizing these tasks must therefore exhibit a very large stiffness against rotations about two axes normal to the axis of rotation. These features motivate the name SCARA for this type of devices: Selective-Compliance Assembly Robot Arm.
Schönflies-motion generators, or SCARA systems, are not new. The Russian Patent SU921848 of Sep. 25, 1980 to Zharkov et al., discloses a redundant manipulating device that can be used for the generation of Schönflies motions, but through a serial layout of links and motors.
U.S. Pat. No. 4,610,598 issued on Sep. 9, 1986 to Hamada et al. discloses an industrial robot implementing Schönflies motions. The industrial robot has a kinematic chain of a serial manipulator, with the four axes of the Schönflies motions being actuated by motors traveling with the moving links. This mounting of the motors on the moving links imposes a high inertia load on the links, bringing about a low load-carrying capacity and a high flexibility of the structure. The high flexibility prevents high-speed operations because these operations induce structural resonance in flexible structures. As opposed to a serial layout, current industrial trends point at parallel arrays because they allow for a placement of the motors on a fixed base, thereby allowing for lighter, stiffer, and hence, faster structures.
A parallel array of serial chains producing individually Schönflies motions are found in U.S. Pat. No. 4,976,582 issued on Dec. 11, 1990, to Clavel, and in EP patent EP1084802 issued on Mar. 21, 2001, to Company et al., as well as in a number of similar devices appearing in the technical literature. The outcome of the patent to Company et al., like that to Clavel, is that the coordinated motion of various legs coupled to a common moving platform is lacking the rotation required in a Schönflies motion, because the rotations of the Schönflies motions of the individual legs are incompatible since their axes of rotation are nonparallel. In order to produce Schönflies motions of axis normal to all four motor axes, which are all parallel to a given plane, Company et al. resort to a planar linkage carrying the moving platform that hence undergoes Schönflies motions. Various embodiments of this invention have been reported in the Proceedings of the IEEE International Conference of Robotics and Automation in 2001, 2002, and 2003.
U.S. Pat. No. 6,095,011 issued on Aug. 1, 2000, and U.S. Pat. No. 6,301,988 issued on Oct. 16, 2001, both to Brogardh, disclose devices intended to enhance Clavel's patent by having an axis of rotation normal to the coplanar axes of the Schönflies motions of the legs. However, none of these two inventions provides four degrees of freedom of the Schönflies type.
U.S. Pat. No. 6,336,374 issued on Jan. 8, 2002, to Brogardh, discloses an improved version of his previous patents, providing for translations in three directions, as well as rotation around one of the axes. Here, the rotation is provided with a separate motor, installed on a first link of a manipulator with a long and intricate transmission between the motor and the rotating device. In a four-degree-of-freedom embodiment, two motors are installed on a base of the structure, and two are installed on a moving link. Thus, this embodiment represents a relatively complex, heavy and, consequently, slow device.
Several U.S. patents, namely, U.S. Pat. No. 4,437,635 issued on Mar. 20, 1984, to Pham; U.S. Pat. No. 5,746,093 issued on May 5, 1998, to Poglitsch; U.S. Pat. No. 5,397,323 issued on Mar. 14, 1995, to Taylor et al.; U.S. Pat. No. 5,419,674 issued on May 30, 1995 to Chang; U.S. Pat. No. 4,782,726 issued on Nov. 8, 1988 to Ryder et al.; and U.S. Pat. No. 5,931,832 issued on Aug. 3, 1999, to Jensen, disclose a variety of devices, all based on two serial parallelogram linkages, moving in the same plane, thus providing planar two-degree-of-freedom motion. Some of the foregoing inventions provide also additional motion of a base with the help of an additional motor. None of these inventions provides four-degree-of-freedom motions of the Schönflies type.
U.S. Pat. No. 5,536,135 of Jul. 16, 1996 to Robertson discloses a serial device with two orthogonal parallelogram-arrays, but only with two drives, thus allowing for two-degree-of-freedom translations with constant orientation of a tool.
Two four-degree-of-freedom parallel mechanisms, by Rolland, are described in Vol. 67, pp. 831-844 of ASME Journal Dynamic Systems and Control Division, of 1999. These two devices provide Schönflies motions. In one of these mechanisms, dubbed Kanuk, the author suggests to use four linear motors driving lower ends of links along rails. The second mechanism, dubbed Manta, uses three linear motors also driving the lower ends of links along the rails, and a fourth rotation motor installed on one of the links. These two devices thus need a very large space for installation and motion of the legs, providing at the same time a rather small workspace.
Finally, 50 parallel mechanisms capable of generating Schönflies motions were disclosed by Yang et al. in “Structure Synthesis of a 4-dof (3-translation and 1-rotation) Parallel Robot Mechanisms Based on the Units of Single-Opened-Chain”, Proceedings of the ASME 2001 Design Engineering Technical Conferences and Computers and Information in Engineering Conference, DETC2001/DAC-21151, Pittsburgh, Pa., U.S.A. Some of the mechanisms disclosed have legs with a single parallelogram, and the other mechanisms have a configuration without any parallelograms.
It is therefore an aim of the present invention to provide a new manipulating device capable of producing Schönflies, or SCARA, motions.
It is another aim of the present invention to provide a new manipulating device in which motors driving links thereof are fixed to a base so that moving parts can be lighter, thereby allowing for higher velocities and accelerations of an end-effector, a moving platform undergoing Schönflies motions.
It is yet another aim of the present invention to provide a new manipulating device in which four independent motions are produced by motors resting on a base thereof, the motions being transmitted from the motors to an end-effector of the device by at least two legs.
It is a further aim of the present invention to provide a new manipulating device which is capable of producing the motions of SCARA systems with a simple, fully-parallel structure that allows for high operational speeds in order to maximize production throughput.
It is an additional aim of the present invention to provide a new manipulating device that is capable of producing the motions of SCARA systems with a relatively simple parallel structure including as few as two legs, thereby reducing a likelihood of link-interference.
It is another aim of the present invention to provide a device which can be used in the electronics industry and in any other application where high-speed pick-and-place operations are needed, such as in packaging and bottling, the device producing translations in three directions and rotation about an axis of fixed direction.
It is a further aim of the present invention to provide a new manipulating device with four degrees of freedom which can be used in the design of virtual-axis machine tools upon mounting of a workpiece on a rotating table, common in the industry, to provide a fifth degree of freedom.
Therefore, in accordance with the present invention, there is provided a manipulating device for producing Schönflies motions comprising a parallel array of at least two legs, each leg including an actuator unit having first and second ends and producing a pan-tilt motion, each leg also including a passive unit having first and second ends, the first end of the passive unit being coupled to the first end of the actuator unit such that the passive unit reacts to the pan-tilt motion, a base connected to the second end of each actuator unit, all second ends having a constant relative position with respect to one another, and a common end-effector connected to the second end of all passive units such that the common end-effector is provided with a Schönflies motion by the legs, the Schönflies motion being composed of three independent translations and one rotation about an axis of fixed orientation.
Further in accordance with the present invention, there is provided a manipulating device for imparting a four-degree-of-freedom motion to an end-effector, the four-degree-of-freedom motion being composed of three independent translations and one rotation about a first axis of fixed orientation, the manipulating device comprising a parallel array of at least two legs attached to the end-effector, each leg including an actuator unit serially coupled to a passive unit, each actuator and passive units including a turntable adapted to experience a rotation about a second axis parallel to the first axis, each actuator and passive units also including a swing member having a first end attached to the turntable and being adapted to experience a tilt motion so that a second end of the swing member is translated along a perimeter of an imaginary circle lying in a plane parallel to the second axis, and each actuator unit being provided with actuating means to provide the rotation of the turntable thereof and the tilt motion of the swing member thereof such as to produce an actuator motion, the actuator motion of each actuator unit causing a passive motion of the passive unit coupled thereto, the passive motion of the passive unit being composed of the rotation of the turntable thereof and the tilt motion of the swing member thereof, such that a combination of the actuator motion with the passive motion produces a leg motion for the corresponding leg, whereby a combination of the leg motions imparts the four-degree-of-freedom motion to the end-effector.
Having thus generally described the nature of the present invention, reference will now be made to the accompanying drawings, showing by way of illustration a few preferred embodiments thereof and in which:
a, 16b and 16c are side views of possible layouts of the active parallelogram linkage with joint axes thereof lying in: a) a horizontal plane; b) a vertical plane; c) a plane inclined with respect to the horizontal;
a, 17b and 17c are side views of possible layouts of the passive parallelogram linkage with joint axes thereof lying in: a) a horizontal plane; b) a vertical plane; c) a plane inclined with respect to the horizontal;
More specifically, the actuator unit C and the passive unit D of each leg B each produces a set of two-degree-of-freedom displacements: one pan motion, or rotation about an axis parallel to a line L fixed to the base 1 of the leg B, and one tilt motion, or translation along a circle lying in a plane parallel to L (see
As shown in
Thus, the passive units D react to the motions of the actuator units C, the manipulating device A providing as a result a four-degree-of-freedom motion to the moving platform 35: three translations and one rotation about one axis of fixed orientation. The manipulating device A provides a manipulation system with a horizontal end-effector (the moving platform 35) having the motion capability of a SCARA leg, thereby giving such a motion to a gripper 36 installed on the moving platform 35 and grasping rigidly a workpiece or tool 37.
As can be seen in
Referring to
The rotating housing 8, enclosing the differential mechanism, rotates with respect to the base 1, where motors 28 and 29 are mounted. The pairs of motors 28 and 29 of both actuator units C can generally be installed at different levels. However, it is preferable to keep them at the same level in order to obtain a better load balance. In a preferred embodiment, the motors 28,29 are placed as shown in
A driving torque from motor 28 is successively transmitted from a motor shaft 4 to a first gear 3 rigidly attached thereto, then to a second gear 10 meshed with gear 3, to a hollow shaft 11 rigidly attached to gear 10, and then to a bevel lower sun gear 20, rigidly attached to an opposite end of the hollow shaft 11. Similarly, a driving torque of motor 29 is successively transmitted from a motor shaft 21 to a first gear 22 rigidly attached thereto, then to a second gear 12 meshed with gear 22, to a central shaft 5 rigidly attached to gear 12, and then to a bevel upper sun gear 15 rigidly attached to an opposite end of the central shaft 5.
The torque from the bevel sun gears 15,20 is transmitted to bevel planet gears 17 and 17′ which are orthogonally meshed with both sun gears 15,20 to form a differential system, the planet gears 17,17′ being respectively fixed on first and second output shaft 18 and 19. The torque is then transmitted from each of the output shafts 18,19 to a respective one of the driving links 27 through one of the speed reducers 6,9. The two speed reducers 6,9 are of opposite hands, which allows for a balanced driving of the parallelogram linkage 30. This requires that one of the two speed reducers 6,9 include a speed reverser. Also, because of the differential system, a difference of rotation velocity between sun gears 15,20 creates a rotation of the axis of the planet gears 17,17′ around the central shaft 5, which causes the rotating housing 8 to rotate with respect to the base 1.
In order to add structural stability to these transmissions, ends of the motor shafts 4,21 are supported in the support frame 2 by support bearings 13. The hollow shaft 11 of the lower sun gear 20 passes through a bore in the support frame 2, the assembly hollow shaft 11—sun gear 20 being held in place by thrust bearings 16 for additional structural stability. The central shaft 5 passes through the hollow shaft 11 and is supported therein by lower and upper intermediate bearings 23,25. The central shaft 5 is also supported in the base 1 by a lower central bearing 26 and in the rotating housing 8 by an upper central bearing 14.
The above described arrangement makes it possible to transmit motion to both sun gears 15 and 20 from the lower part of each differential mechanism, thereby avoiding interference of the housings 8 of the two actuator units C when the manipulating device A is in motion.
The differential mechanism formed by the two sun gears 15,20 and the two planet gears 17,17′ is supported by: (a) the case of the rotating housing 8; (b) the support frame 2; and (c) planet supports 7. The planet supports 7 are fixed to the rotating housing 8 and restrain the relative displacement of the planet gears 17,17′ to a rotation about their axis of symmetry.
Let ωA and ωB denote the input velocities of the motors 28 and 29, respectively, the output velocity of planet gears 17,17′ around their axes being denoted by ω1. Moreover, the rotation of the axes of the planet gears 17,17′ around the axis of the shaft 5 is denoted by ω2 which is the angular velocity of the housing 8 and constitute the pan motion of the actuator unit C.
The velocities ω1 and ω2 are known in the art to be related to those of the motors by
ω1=1/2(KBωB−KAωA)NS/NP
ω2=1/2(KAωA+KBωB)
where KA is the reduction ratio of the gear train between motor 28 and the hollow shaft 11; KB is the reduction ratio of the gear train between motor 29 and the central shaft 5; NS is the number of teeth of the sun gears 15,20 and NP is the number of teeth of the planet gears 17,17′. In general, KA and KB need not be equal. However, it is preferable that KA=KB in order to equally distribute the load between the two motors 28,29.
Furthermore, the rotation of planets 17 and 17′ is transmitted to the driving links 27 via the speed reducers 6,9. The driving links 27 then move the active parallelogram linkage 30 of
In operation, the driving links 27 therefore drive the active parallelogram linkage 30 located outside of the housing 8 with an angular velocity ω1/KR, constituting the tilt motion of the actuator unit C. The pan motion of the actuator unit C, as stated above, is denoted by ω2 and constitutes the rotation of the axes of the planet gears 17,17′ around the axis of the shaft 5, which causes the housing 8, and the active parallelogram linkage 30 attached thereto, to rotate. The active parallelogram linkage 30 transfers this combined pan-tilt motion to the base 32 of the passive unit D linked therewith through pin joints. The structure of the parallelogram linkage 30 ensures that the base 32 of the corresponding passive unit D remains parallel to the base 1. The movement of the base 32 causes the pan motion of the passive rotating housing 34 and the tilt motion of the passive parallelogram linkage 33 which is attached to the common moving platform 35 with pin joints. Hence, the collaboration of the legs B causes the common platform 35 to remain parallel to the bases 1 by virtue of the passive parallelogram linkages 33 of all legs.
Now referring to
In this embodiment, a driving torque from motor 28 is successively transmitted from a motor shaft 4 to a first gear 3 rigidly attached thereto, then to a second gear 10 meshed with gear 3, to a hollow shaft 11 rigidly attached to gear 10, to a sun gear 20 rigidly attached to the hollow shaft 11, and then to planet gears 17,17′ meshed with the sun gear 20. The planet gears 17, 17′, in turn, transmit the driving torque to output shafts 18,19 through universal joints 46,47. Similarly, a driving torque from motor 29 is successively transmitted from a motor shaft 21 to a first gear 22 rigidly attached thereto, then to a second gear 12 meshed with gear 22, to a central shaft 5 rigidly attached to gear 12, and then to the planet carrier 8 rigidly attached to the central shaft 5 and playing the role of the housing 8 shown in
Let ωA and ωB denote the input angular velocities of motors 28 and 29, respectively, the common output velocity of the planet gears 17,17′ being given by
while the angular velocity ω2 of the pan motion, identical to the rotation of the planet-carrier 8, is
The angular velocity ω1 producing the tilt motion is the horizontal component ω17-ω2 of the common angular velocity of output shafts 18,19, that is,
If, in particular, N22/N12=N3/N10, then
A number of alternative embodiments of the manipulating device A are possible, including, but not limited to, the embodiments described herein below, with like elements being identified by like reference characters.
Referring to
Referring to
Referring to
Referring to
Referring to
Referring to
Using the intermediate driving link 27 of
Referring to
Referring to
The present invention as described herein offers an extraordinary functional flexibility in its layout, with a large number of other possible embodiments depending on the tasks envisioned. Referring to
Another significant advantage of the present invention is that most of the wiring (control and power supply cables, sensor wires, etc.) ends on the base 1 in the area of installation of the motors 28,29, and need not be attached to the legs B, thus providing for a light structure.
Referring to
The digital hardware includes a central processor 1c, connected to the four servo-drives and sending control signals thereto according to the prescribed control algorithms for the manipulating device A. All other components of the digital hardware described in the following are in communication with the central processor 1c. A monitor 2c and a keyboard 4c are used for online programming and servicing of the device by the operator. Internal memory 5c is used for the functioning of the central processor 1c of the computer, and peripheral memory 6c, which may include a CD drive or any information-storage device, is used for uploading control programs according to the intended task. Finally, an input/output unit 3c is necessary for feedback from each leg B to the control system 1c in operation.
Each servo-drive includes a servo-control unit 7c,8c,9c,10c and a motor 28,29. The role of the servo-control unit 7c,8c,9c,10c is to interpret control signals from the central processor 1c and to implement them into the motion of the motors 28,29. Each actuator unit C of the manipulating device A contains two servo-drives, which produce output motions of the unit. These motions pass through gear trains as described in the embodiments above and move two legs B supporting the common moving platform 35.
A similar or equivalent control system can be used for alternative layouts, including embodiments having three or four legs.
The present invention can be used in a number of industries where high-speed pick-and-place operations are required, including, but not limited to, fabrication and packing of planar electronics components, packaging of various products, and bottling. The present invention can also be used in the design of virtual-axis machine tools by mounting a workpiece on a rotating table, commonly known in the art of machine tooling, to provide a second rotation which can become a fifth degree of freedom when combined with the Schönflies motions of the invention.
It will be appreciated that the present invention is not limited to the specific embodiments described herein, which are merely illustrative. For example, the third and the fourth embodiments can be readily transferred to embodiments characterized by orthogonal planes of motion of the passive parallelograms 33 or the passive parallelogram 33 and the passive single link 44. Other modifications and variations will be readily apparent to those skilled in the art. Accordingly, the scope of the invention is deemed to be in accordance with the claims as set forth below.
This is a continuation of International Patent Application No. PCT/CA2003/001695 filed Nov. 5, 2003, which claims benefit of U.S. Provisional Patent Application No. 60/424,393 filed on Nov. 6, 2002, now abandoned.
Number | Date | Country | |
---|---|---|---|
60424393 | Nov 2002 | US |
Number | Date | Country | |
---|---|---|---|
Parent | PCT/CA03/01695 | Nov 2003 | US |
Child | 11123056 | May 2005 | US |