COMPLIANCE SYSTEM FOR INDUSTRIAL MANIPULATORS
8ACKGROUND OE 1~: INV~NTION
Field of the Invention.
The invention is directed to industrial manipu-lators. More particularly, the invention is a compliance system which provides a range of compliant control.
Additionally, the invention includes a system for directly and accurately measuring radial and axial deflections in the compliance system in order to provide positional information.
DescriPtion of the Prior Art:
It is an objective in the design and construction of industrial manipulators to mimic limited aspects of various human capabilities in order to improve the posi-tional accuracy of industrial manipulators in such tasks as the mating between two parts, a tool and a part, a part and a fixture, and many other mating pairs. When parts are of an exact nature and the tools and jigs holding them are precisely located, there are no errors in assembly.
However, not all surfaces on a part are held to the same tolerance and often the mating surfaces are not in per-fectly known positions. The design and construction of mechanical manipulators ultimately involves a compromise between manipulator speed, payload capacity and positional accuracy in order to cope with aforedescribed imperfec-tions.
lZ~8~7 It has been known to utilize a compliant deviceas an aid in overcoming the imperfections encountered in mating operations. The compliant device addresses these difficulties by functioning as a multi-axis "float" which accommodates positional and angular misalignments between parts. U.S. Patent 4,098,001 discloses a remote center compliance device which holds a workpiece so that the workpiece can rotate about the point where it engages a mating part. Lateral error and angular error are absorbed independently so that the workpiece is responsive to contact forces during insertion, and realigment with the insertion axis is passively accommodated.
It has also been suggested that sensory feedback utilizing vision or tactile devices be employed to facili-tate the positional accuracy requirements of industrial manipulators. To this end, force sensing apparatus, which involve strain analysis, have been incorporated into compliance devices. An example of a force sensing appar-atus capable -of six degrees of freedom is disclosed in U.S. Patent 4,094,192. However, in industrial applica-tions, the response to the force sensor apparatus by large manipulators is usually not fast enough to prevent large forces from occurring. Therefore, a degree of mechanical compliance is added to make the manipulator system more forgiving.
It is an object of this invention to provide an adjustable compliance which is capable of a range of compliant control.
It is also an object of this invention to provide a compliance system with five and one-half degrees of freedom.
It is yet another object of this invention to produce positional feedback information.
It is yet another object of this invention to provide a compliant device which is capable of a variety of applications requiring a significant range of strength and precision.
SUMMARY OF THE INVFNTION
The invention is a compliance system for an assembler device such as an industrial manipulator or robot. A range of compliant control in an adjustable compliance with five and one-half degrees of freedom includes a first member mounted on the assembler device and a second member to which a gripper or tool is secured.
Interconnecting means restrict axial displacement of the second member away from the first member and biasing means disposed therebetween inhibit axial compression. Biasing means are also provided to inhibit radial displacement of the second member relative to the first member. The axial biasing means are reinforced elastomeric spheres which exhibit monotonically increasing spring stiffness and can be automatically adjusted for stiffness range using a pressurized fluid. Local position sensing of the gripper is provided through an array of linear variable-differential transformers. A dedicated micr~computer provides signal analysis for possible readjustment of the manipulator.
BRIEF DESCRIPTION OF THE DRAWINGS
The above as well as other features and advan-tages of this invention will become apparent through consideration of the detailed description in connection with the accompanying drawings in which:
Figure 1 is a bottom plan view of a compliance system with portions cut away incorporating the features of this invention;
Figure 2 is a section through Figure 1 along lines II-II;
Figure 3 is a section through Figure 1 along lines III-III;
Figure 4 is a simplified schematic representation of the instant compliance system;
Figure 5 is a graph representing the force deflection curve in a compliance device according to this invention;
Figure ~ is a blocX diagram analysis of the positional feedback system of this invention; and Figure 7 is a block diagrammatic illustration of the mechanical programmability system of this invention.
DESCRIPTION OF THE PREFERRED EMBODIM~NT
The invention is a compliance system for indus-trial manipulators and includes a remote center compliance capable of a range of compliance control. Specifically, the positlon of the compliance center is variable to meet differing payload and positional accuracy requirements.
In Figures l through 3, the remote center compliance (R~C) is generally indicated by the reference character 11 and includes a first member 13 which is mounted on the control - arm of an industrial manipulator and a second member 15 to which the gripper device of the manipulator is connected.
A continuous flange 17 is circumferentially disposed about the first member 13 and is normal to the planar component of the first member 13. Interconnecting means l9 extend between the first and second members, 13 and 15 to restrict axial displacement of the second member 15 away from the first member 13 to a predetermined maximum limit. However the interconnecting means 19 do not interfere with the ccmpressive axial displacement of the second member 15 towards the first member 13. A material particularly well suited for use as an interconnecting means is characterized by a high degree of tensile resistivity coupled with compressive flexibility. An example of such a material is a stranded fiber cable commercially available under the trademark "KEVLAR" which is registered to DuPont.
First biasing means are interposed between tha first and second members 13 and 15 to control the afore-mentioned compressive axial displacement. These axial biasing means are elastomeric spheres 21 that resist compression but offer little resistance to lateral dis-placement because of their spherical shape. Each elasto-meric sphere ~1 is a hollow rubber sphere, preferably ,~ reinforced by an outer layer~of flexibl~ cable or fabric lZ~ 8~
such as "KEVLAR" cable and filled with a fluid to maintain the sphere at a predetermined level of stiffness. In other words, the internal pressure of the elastomeric spheres can be varied with a suitable fluid supply in order to change the effective spring stiffness of the spheres. As will be hereinafter more fully explained, the compliance center of the RCC 11 can be modified through a variance of the spring stiffness of the spheres 21. While the fluid utilized to ~ontrol the internal pressure of the spheres 21 can be water or even air, it is preferred that a highly viscous fluid be utilized to provide a damping effect on the movement of the second member 15 relative to the first member 13. While it is preferred that hollow elastomeric spheres be used, solid elastomeric spheres with a fixed rate of stiffness can be used in a passive compliance system.
Second biasing means 23 are disposed between the circumferentially disposed flange 17 and the second member 15 by means of mounting seats 25 and 27. The second biasing means 23 controls radial displacement of the second member 15 relative to the first member 13 and consists of several spherical members which function as fixed rate springs. The spherical members can be solid rubber spheres or hollow spheres pressurized to a prede-termine.d value. Because of the spherical shape, thesecond biasing means 23 offers minimal resistance to relative axial displacement of the first and second members 13 and 15.
Considering Figure 4, it will be readily appre-ciated that the adjustability of the first biasing meansor spheres 21 makes it possible to modify the position of the compliant center with respect to the RCC 11. As a result, a range of compliant control is available in one unit. By way of a brief review, the remote center 29 is a point projected onto the gripper or tool mounted on the second member 15. (For illustrative purposes, the gripper is shown as an elongated member 31.) Since the remote center 29 is known, its behavior under various axial and lateral error conditions is determinable. The location of the remote center 29, a distance l1 from the second member 15, is a function of kx, kb and ~; kx is the shear force, kb is the axial force along an angle defined by ~, and ~
is the angle representing the difference between the disposition of the cable 19 and the Z axis or axial cen-terline "z" of the compliance as projected by line "a".
The specific benefits obtained through the ability to alter the remote center 29 by changing l1 are reflected by an increase to both the range of payloads and positional accuracy which can be accommodated by the single RCC 11. For example, if the industrial manipulator engages a longer and heavier payload, an increase in ll is warranted. Also, an increase in kx and kb is i~dicated.
If the angle ~ remains constant, the length l1 is a func-tion of the ratio kb/kX. The length l1 can thus be increased by either increasing kb or decreasing kx. By increasing kb, there is a collateral benefit in the increase to the bending stiffness of the RCC 11. Such an increase is better suited to the larger forces and moments imposed by a longer and heavier payload.
According to this invention, the value kb of the spherical members which make up the first or axial biasing means 21 can be increased or decreased by adjusting the internal pressure of the spherical members with a suitable fluid supply. As a result, the effective spring stiffness of the spherical members 21 is changed and the position of the remote center 29 is altered.
The force deflection graph of Figure 5 typifies the range of compliant control made available through the apparatus of this invention. Because the force-deflection curve is non-linear, a range of operating stiffness results. The Y axis of the graph reflects an increase in the total load suspended from the RCC 11. By total load it is meant the combination of the gripper and the payload being manipulated thereby. The X axis reflects the amount 8~
of deflection experienced by the RCC 11 per a constant unit of force. Several different load conditions are each reflected through individual origins l~ 2~ 3 and O4.
Each of the origins successively represents an increased value of ~ in the spherical members 21. Thus, for exam-ple, the deflection experienced by the RCC 11 with an increased value of kb and an increased payload at a given level of force is less than the deflection experienced by the RCC 11 with kb at a lesser value and with a smaller payload at the same level of force.- Also, with a constant payload, the value of kb can be manipulated to control the force sensitivity and the degree of de~lectio~ per unit o~
force in the RCC 11.
An additional feature of this invention is position measurement through the RCC 11. As shown in Figures 1 and 6, position information is produced through a series of linear variable-differential transformers (LVDT transducers) 33 and 35. Deflections of the second member 15 relative to the first member 13 of the RCC 11 are measured dire_tly and accurately by the LVDT trans-ducers 33 and 35. At least three LVDT transducers 33 are normal to the first and second members 13 and 15 in order to detect any axial displacement or change in the orienta-tion of the second member 15 relative to the first member 13. The LVDT transducers 35 are disposed between the first and second members 13 and 15 to detect any radial displacement and rotation about the 2 axis therebetween.
The LVDT transducers 33 can be mounted on the second member 15 and a reference member 37 in contact with the cores thereof provided on the first member 13. At least three and preferably four LVDT transducers 35 are utilized to detect radial displacement. The signal from each LVDT
transducer (33 and 35) enters a microcomputer 39 to produce a floating point array and eventually an error signal.
Once the deflections of the compliant point are calculated, explicit commands for modifying the coordinates of the gripper's path can be produced. For example, in a point-~2~3()7 to-point lndustrial manipulator, the modifications take the form of discrete point motions effected through the controller 41.
In Figure 7 a system for the manipulation of the S value of Xb through the pressurization of the several spherical members 21 lends the RCC 11 a degree of mechan-ical programmability. Because a fluid is used to stiffen the compliant spheres, the pressure can be varied auto-matically. The RCC 11 is mechanically mounted between the gripper 31 and the manipulator arm 45. In many applica-tions, the gripper and arm are horizontally oriented relative to the task being performed. When horizontally disposed, the dead weight of the gripper 31 may be suffi-cient to create a force vector gener~lly normal to the Z
axis. As a result, the remote center 29 can deviate from its "null" state, that is, the position of the remote center 29 when the arm 35 and gripper 31 are vertically disposed. Through the individual adjustment of the spher-ical members 21, this deviation of the remote center 29 can be substantially corrected.
The output signals of the LVDT transducers 33 and 35 can be utilized to identify any deviation of the remote center due to the disposition of the gripper. A
processing/control means 47 which is responsive to this output signal, is in communication with a fluid supply means 49 having a pump means and a fluid reservoir.
Separate pump or valve means can be provided to regulate the fluid flow through the separate lines 51 to each elastomeric sphere 21. The fluid supply means 49 ope-ates to either increase or decrease individually the pressure of the fluid in each of the spherical members 21. By adjusting the value of kb through fluid pressure modifica-tion, the remote center 29 is reoriented.
The output signal of the LVDT transducers 33 and 35 can also be utilized to identify the payload being manipulated by the gripper, so that the proper range of compliant control is provided through selective pressuri-zation of the spheres.
~L2 ~ 7 It should be appreciated that in many applica-tions an increase in the physical dimensions of the payload is generally reflected by an increase in weight. ~owever in certain circumstances, the payload length can increase while its weight remains the same or even decreases.
Accordingly, while a sensor means consisting of LVDT
transducers 33 and 35 illustrated herein is responsive to payload weight through deflection of the second member 15, other sensor means responsive to the physical configuration of the payload being manipulated can be utilized in this system. A linear diode array is one example of such a sensor means which can be adapted for use with the mechan-ical programmability system of this invention.
Of course, the RCC 11 need not be provided with the automatic mechanical programmability feature described above. In applications in which the payload is relatively constant, the 1uid pressure of the spherical members 21 can be set to a predetermined level for the duration of that specific application. With a relatively constant payload, solid spherical members, with or without a Kevlar cord reinforcement, can be used.
What has been described is a compliance system for industrial manipulators in which a range of compliant control is available in a single unit. Additionally, the compliance system is instrumented with an LVDT transducer array, which makes possible further position adjustment of the manipulator and gripper through a controller. The adjustable compliance exhibits five and one-half degrees of freedom; only axial expansion is restricted to a prede-termined limit.