Force components sensing apparatus
Field of the Invention
This invention relates to force sensing appara¬ tus which will determine the location, magnitude as well as the direction of a force and which apparatus has particular application in the field of robotics.
Background of the Invention
Robots are, at a very rapid pace, becoming increasingly more important in todays technology as responsive tools performing programmed functions. However, robots are not particularly sensitive to the environments in which they perform. For exam¬ ple, the ability of robots, in their present state of development, to touch and sense an object or a force and report back with reliability, the loca- tion, magnitude and direction of the force applica¬ tion of what it has touched, does not exist. This problem has received considerable attention, re¬ sulting in touch sensors being developed for robo¬ tics as well as many other purposes, but to date they have not been particularly successful.
One of the objects of this invention is to produce a reliable touch sensor device suitable for use in a robot and which would meet the criteria of being able to determine location, magnitude and direction of a force it comes in contact with.
Another object of this invention is to produce a touch sensing device meeting the above criteria and which has the versatility for utilization not only in robotics but outside that field as well'. For
example, such devices have great potential as touch sensitive mechanics for computers and calculators, inter alia.
Position and force indicating systems are not new. Many involve echo signals, light beam inter¬ ruptions, capacitance change, wire contact etc. As pointed out in prior art patents directed to this area, among the different position and or force indicating systems known heretofore, those which operate by the application of pressure applied to a point, the location and magnitude of which is to be determined, generally require a great number of pressure sensors fixedly secured to the surface where the position of the point is to be determined. Generally, the sensors positions correspond to predetermined points on said surface. The number of possible positions which can effectively be deter¬ mined is then, limited to the number of sensors the surface is able to carry. Some of the systems referred to employed conductive wafers sandwiched between two layers of parallel wires laid at right angles to each other to
2 form a NxN matrix of points which produced N outputs. To achieve acceptable accuracy over an area as small as a four inch square, thousands of outputs were necessary.
The invention disclosed U.S. Patent 3,657,475 to Peronneau addressed the problem of the excessive numbers of outputs by developing a position indi¬ cating system for determining the coordinates of a point on a two dimensional surface to which static force is applied. It comprised a rigid plate fixed to the surface by means of at least three spaced
apart sensors. Each sensor delivered an output signal which was proportional to its distance from the point of application of the force. The signals were then processed in an electronic unit generating two voltages which represented the coordinates of the point of application of the force to the surface, as measured with reference to two axes determined by the three sensors.
While the Peronneau invention has been gener¬ ally considered a pioneer in its field, it was limited by the fact that the- input force had to be static and it measured only the coordinates of the point of force on a two dimensional surface and not the magnitude of the force but still was limited to a two dimensional surface.
The invention disclosed in U.S. Patent 4,121,049 to Roeber addressed this problem and resulted in a system which measured both location and magnitude of the force. Roeber employed three spaced sensors, each of which delivered an output signal proportional to both the applied force and the coordinates of the force. The signals were fed into a processor which computed the force and its coordinates. The present invention addresses itself to not only simultaneously determining the coordinates of a force and its magnitude, but its direction as well on a three dimensional surface.
Disclosure of the Invention The invention resides in force sensing appara¬ tus which includes a convex surface of known config¬ uration. A load cell comprising a cross having four
equal length flexible arms with its center attached to a pedestal receives and measures strain resulting from a force applied to the convex surface. A flexible force transmitting member is attached symmetrically to the convex surface and the arms of the cross. At least two strain gauges are secured to each of the arms of the cross in planes normal to each other whereby the force applied to the convex surface and the resultant moments of that force are transmitted to the flexible arms resulting in strain measurable by the gauges. The gauges are connected to a computer which computes location, magnitude and direction of the force.
The flexible force transmitting member may be a frame surrounding the cross and having sides of equal length." The arms of the cross are attached to the mid points of the four sides of the; frame and the four corners of the frame are attached to the convex" surface. The convex surface may be a hollow sphere having a pedestal passing freely into it and termi¬ nating substantially at its center. There may be means to limit the amount of motion of the sphere which therefore limits the amount of strain in the arms of the cross to prevent damage.
Each of the arms of the cross may be construc¬ ted to flex in two planes normal to each other and, in this case, strain gauge mechanism is associated with each plane to measure the stress transmitted to it.
Description of the Drawings
Figures 1 through 3 are schematic diagrams describing a wrench system for force measurement.
Figure 4 is an exploded view of a four sensing apparatus embodying the features of this invention.
Figure 5 is a plan view of a cruciform load cell employed in the apparatus.
Figure 6 is a series of bending moment diagrams for the cruciform load cell. Figure 7 is perspective view of an alternative embodiment of the invention.
Best Mode of Carrying Out the Invention
In order better to understand the invention, a system of force measurement will now be described. - Reference is made, to.Figures 1 through 3 of the drawings. A set of forces and moments acting upon a body can be collectively called a wrench. The range of wrenches 'which may be exerted through a contact between two bodies can be described by a "wrench system. " Such a wrench system is denoted by w=(w1, 2,w3,w4,w_, g) , where w-,w2, and w3 are the forces exerted along the x, y, and z axis respec¬ tively. Similarly w., and w.., wg are the moments about the x, y, and z axis. A point is shown contacting a plate in Figure 1. If the surface is frictionless, the point can only exert a normal force. The wrench system is composed of a single wrench w=(0,0,w3,0,0,0) . If the surface has friction the point can exert forces in all three directions and the wrench system becomes (w, ,w2,w3,0,0,0) , Figure 2.
A line touching a friction surface can produce forces in all three directions and moments in two directions. The wrench system is, therefore, (w1,w2,w3,w4,0,wg) , Figure 2. A planar surface affixed to a plate can exert forces and moments in all directions resulting in a full wrench system (w1,w2,w3,w4,w5,w6) , Figure 2.
The line of action and magnitude of a force exerted on the surface of a sphere can be determined knowing the forces and moments at'the center of the sphere. A force is applied to the sphere at a point x2, y2, z2, as shown in Figure 3. As previously noted, a point force on a frictional surface can exert a wrench with three independent components, w=(w1,w2,w3,0,0,0) , at the point of contact. This wrench system will cause the following system of forces and moments at the center of the sphere:
a1=w1 a2=w2 a3=w3 a4=ylW3"ZlW2
a6=XlW2"ylWl
Where (x. ,y1,z.) are the components of a vector perpendicular to a line of action of the force from the origin of the sensing system to the line of action of the force. Using the above equation the point (x.,y1,z.) can be determined. To find the location contact is now determined by geometry. The line of action passes through the point (x, ,y,,z.,) and through the surface of the sphere. The
coordinates of an arbitrary point along the force's line action will be, d^x-j+nw../ F d2=yl+nw2/ F d3=z1+nw3/ F
where F is the magnitude of the force, a, 2+a22+a32 and n is any arbitrary number. The point (x2,y2,z2) lies the surface of the sphere, defined by x 2+y2+z2=R2. I ≠yf the point (x1,y, z1-L), lies within the sphere, x. +y. +z. R , then the line of action of the force intersects the sphere at two points. The coordinates of the points (x2,y2,z2) are found by substituting the equation of the line of action into the equation of the sphere,
Solving for the unknown variable n and substituting back into the equation will give the two. oints of intersection.. If the force is assumed to be exerted into the sphere, not pulling on it, one of the points can be eliminated. The remaining point will be the coordinates of x2, y?, z2.
Thus, the location, magnitude, and direction of a force exerted through a point contact can all be determined. Using geometric transformation, the force can be represented as a normal and a tangent force.
This can be particularly useful if a sphere or other convex surface of known configuration is to be used for robot fingertips. With this information, a robot finger could determine the normal and the frictional components of the contact force. This knowledge can be useful in control and shape recognition.
A force and tactile sensing apparatus embodying the features of this invention which was designed to perform in accordance with the above explained theory will now be described with reference to Figures 4 through 7.
A force is applied to a convex surface of known configuration which can be defined mathematically. For purposes of illustration that surface will be disclosed as a sphere, as seen in Figure 4, which is" an exploded view of the force sensing apparatus.
The sphere comprises a top or "northern" hemisphere 10 and a lower or "southern" hemisphere 12. The hemispheres are machined from a solid piece of aluminum and are assembled by screwing them to- gether. The lower hemisphere has threads 14 and the upper hemisphere has matching threads not seen. A load cell generally indicated 16, is located within the hollow sphere and is constructed in accordance with features of this invention to measure all six components of force and moment. The load cell has equal length arms and for illustrative purposes only is shown as a cruciform portion 18 but may have three arms or more than four. It will be described in greater detail hereinafter. The cruciform portion or cross is mounted at its center 20 on the upper surface 21 of a pedestal 22 which projects upwardly from a base 24 passing freely through a hole 25 in the lower hemisphere which is larger than the diameter of the pedestal. A stop mechanism to limit the amount of motion of the sphere which therefore limits the amount of strain in the cross is located beneath the cruciform load cell and comprises a second cruciform member 26
having a central plate 28 firmly mounted on the pedestal 22 to prevent rotation. Extending outwardly from the plate 28 in a cruciform con¬ figuration are legs 30. Beneath the legs 30 is a plate 32 secured to the sphere and having a central aperture 33. Limit stops 34 are located on the plate 32 and, when in assembled configuration the legs 30 extend between adjacent pairs of stops 34. Set screws 36 in the stops 34 will engage the legs 30 to limit the twisting motion of the sphere about the pedestal.
A cover plate 42 is also secured to the inside of the sphere below'the load cell and will engage set screws 44 extending upwardly from the cruciform legs 30 to limit the amount of movement of the sphere in the vertical direction so as not to overstrain the load cell.
The load cell comprises, in effect, a flexible cross located within a flexible force transmitting member, see Figure 4. The center of the cross 18 is the hub 20 which is mounted to the top of the pedestal 22. Extending outwardly from the hub are arms 50 constructed to flex in two planes normal to each other. Each arm comprising a horizontal plate- like portion 52 and a vertical plate-like portion
54. Each portion 52 and 54 of each leg of the cross has a pair of strain gauges secured to it. A pair of gauges 60 are secured at opposite sides of the horizontal portion 52 and a pair of gauges 62 are located on opposite sides of the vertical portion of the arms 50. Thus, there are two pair or four strain gauges per leg, for a total of 16 gauges. In a more simplified version of the invention, two gauges per arm would suffice.
The pair of strain gauges 60 mounted on the top and bottom surfaces of the horizontal portions 52 measures strains from forces applied to the sphere in the vertical direction and the pair of strain gauges 62 mounted on the vertical portions of the legs 54 measures strains resulting from horizontally applied forces.
The flexible force transmitting member is a frame 64 attached symmetrically to both the sphere and the cross 18. It is illustrated as a square frame having sides 66 of equal length. The corners 68 of the square frame member are slightly rounded and are firmly secured to and fit within a retainer 70 attached to the sphere. The arms 50 of the cross are attached to the midpoint of the sides 66 of the frame.
A force applied to the sphere and the resultant moments of that force are transmitted through the square frame member to the arms 50, which strains are measurable by the strain gages. The load cell can measure all six components of force and moment at the center of the sphere.
Wires from the strain gauges are threaded through the cross, the pedistal and the base to a pin connector, not shown, located on the side of the base. From here the sensor is attached by a cable to a set of amplifiers and through a A/D converter to a computer which computes the^location, magnitude and direction of the force. Referring next to the schematic diagrams in
Figure 6, the bending moment in each of the arms of the cruciform load cell will now be described. The bending moment produces strain on the surfaces of
-li¬
the arms of the cross. The sum of the strains on the horizontal portions 52 of the arms, are proportional to the vertical force a3 (Figure 6c) . The difference in the strains on the two opposing horizontal surfaces give the two moments a4 and ag (Figure 6d & 6e) . The sum of the strains on the sides of the opposing vertical portions 54 are proportional to the forces a, and a- (Figure 6a & 6b) . Lastly, the moment afi is determined by the difference in strains on the vertical surfaces 54 of opposing legs of the cruciform load cell (Figure 6f) .
The summary of these relations are given in the following equation where s,. to sR are strains and k.. to kg are constants. a kι {s6 + a2=k2 (S5 ;+ S7 ) • ' a3+ 3 (S 1. + S 2 + S3 + S4 )' a4=k4 { S2 - S4 } a5= 5 (S 1 - S3 )
Whereas the invention has been illustrated in apparatus having a sphere as the element to which the face is applied, this element may be any convex surface of known definable configuration. The configuration may even be two or more composite convex surfaces. Referring to Figure 7 there will be seen a hypothetical robot finger having a pedestal 90, a cruciform load cell 92, a convex dome 94, of known definable configuration and a depending cylindrical skirt 96 also known definable configuration. In programming the computer, a definition of the convex surface (or surfaces) need only be inputed.