1. Field of the Invention
The invention relates generally to capacitive proximity sensing devices. More particularly, the present invention relates to a precision alignment and positioning capacitive proximity sensor.
2. Background Description
Capacitive proximity sensors are generally known. Capaciflector technology uses a capacitive proximity sensing element backed by a reflector driven at the same voltage and in phase with the sensing element. The reflector is used to reflect electrical field lines from the sensor away from a ground plane and towards an object being sensed. Capaciflector technology has many applications including precision robotic manipulation. Typically a robot, using some combination of camera, machine vision with feature recognition, pre-programmed prior knowledge and/or operator supervision, brings a tool near a fastener. The vision system positions and aligns the tool over the fastener and moves the tool down to contact the fastener. At some point, the tool obscures fastener view and tool motion continues to contact based on a computer trajectory. At contact there are inevitable positional uncertainties and misalignments between tool and fastener. Thus, mechanical guides are present to correct such errors. But, these corrections often introduce forces back into the robot system. For this reason, mechanical compliance is added to the robot system to permit the adjustment motion to occur and to reduce the forces generated in the process. The robot simultaneously may rotate the tool to the proper position. The tool is then pushed down onto the fastener. The rotation will enable tool and fastener to align. Light pressure may drive the aligned tool down to complete seating between tool and fastener. In robotic aerospace applications, a force torque sensor on the robot wrist provides a sense of feel and guides the robot movement in relieving stress during seating. Once seating is complete, the robot removes the fastener.
In current alignment or positioning devices, misalignments at contact can be greater than the mechanical capture range of guides, which may cause the assembly process to fail. Further, mechanical guides may be too large so as to be certain mechanical capture occurs. In addition, mechanical compliance in the robot arm/end-effector wrist may become too large and its behavior too uncertain. This can degrade successful task completion and cause precision alignment or positioning to fail. The energy stored in the robot arm/end-effector, while correcting misalignments, can release suddenly as a spring to disrupt control of an assembly process. And, in many cases, friction, generated by the mechanical guides during assembly/disassembly, detract from smooth and precise assembly/disassembly. Existing Capaciflector technology, “Capaciflector Guided Mechanisms” uses several sensors in an array attached to a tool. The use of several sensors may complicate construction and adds multiple electric lines to service the sensor electrodes. This can be difficult to manage, particularly when changing from one tool to another. Such an arrangement also complicates the ability of the tool to withstand high torque and stress without damage to the sensors.
The present invention is directed to an improved capacitive proximity sensor that is particularly suited for precision alignment and positioning of a robotic arm or end-effector.
Accordingly, it is desired that the present invention provide a capacitive proximity sensor that is capable of facilitating the precise manipulation of a robot arm or end effector.
It is further desired that the present invention provide a capacitive proximity sensor that uses a minimum number of sensors and a minimum number of input/output leads.
In addition, it is desired that the present invention provide a capacitive proximity sensor that can manipulate a tool to seat over a mating fastener without contact.
In one embodiment of the present invention “Virtual Feel” Capaciflectors typically comprise two (2) mechanical components, one being manipulated by a robot type device to mate with another. A socket wrench being assembled over a hex bolt and an Allen wrench being inserted into a socket head screw are representative examples of Virtual Feel applications. Virtual Feel may be used in precision positioning and alignment during an assembly process to ensure proper mating and to prevent jamming. When the mechanical component being manipulated by the robot is also an electrically excited Capaciflector electrode and the mechanical component to which it is being mated is electrically conductive and grounded, intimate proximity between the two can be sensed prior to contact, thus non-contact virtual feel can be used in place of actual touch to perform sensory interactive precision assembly. In another embodiment, a Capaciflector socket wrench comprises an inner combination mechanical socket head wrench/Capaciflector-driven electrode (sensor #1), an outer combination mechanical jacket/Capaciflector-driven electrode (sensor #2), and an electrical insulator film layer separating the two (2) sensors. The inner and outer mechanical components/sensors may be arranged at the top of the wrench so as to interface with a robot chuck such that the wrench may be mechanically secured and independent electrical signals can pass from a robot controller to each of the sensors.
“Virtual Feel” Capaciflector tools may be configured so that each tool's contact surface also serves as a Capaciflector electrode. In this configuration a single contact surface of arbitrary shape can also function as a single Capaciflector electrode, which can sense proximal or near contact with another surface at any point on the Capaciflector electrode surface. In one embodiment, sensing closer or further proximity between the contact surfaces corresponds to sensing physical contact between surfaces wherein closer proximity is analogous to more applied force at the point of physical contact and further proximity is analogous to less applied force at the point of physical contact. While the sensor responses are similar in each case, physical contact is associated with actual feel and proximal variations may be associated with virtual feel. In another embodiment, precision positioning and alignment techniques are typically performed by moving along a preferred direction while adjusting the tool to minimize side loads and friction. Virtual Feel may be performed by moving along a preferred direction while adjusting the tool to minimize proximity to side contacts
a and 4b demonstrate the basic geometry of conductive plates moving in pure translation in accordance with an embodiment of the present invention.
a demonstrates the charge distribution of the conductive plate of
b demonstrates the charge distribution of the conductive plate of
a is a top view of
b is a top view of
a demonstrates the basic geometry of a conductive plate rotating about the plate bottom center in accordance with an embodiment of the present invention.
b demonstrates the basic geometry of a conductive plate rotating about the plate center in accordance with an embodiment of the present invention r.
a demonstrates the charge distribution of the conductive plate of
b demonstrates the charge distribution of the conductive plate of
a demonstrates the charge distribution of a centered circular plate in accordance with an embodiment of the present invention.
b demonstrates the charge distribution of an off-center circular plate in accordance with an embodiment of the present invention.
a demonstrates the charge distribution of a centered hexagonal plate in accordance with an embodiment of the present invention.
b demonstrates the charge distribution of an off-center hexagonal plate in accordance with an embodiment of the present invention.
c is the conductive plate of
a demonstrates the charge distribution of a centered asymmetric object in accordance with an embodiment of the present invention.
b demonstrates the charge distribution of an off-centered asymmetric object in accordance with an embodiment of the present invention.
c is the asymmetric object of
Energy (electric, magnetic, thermal) may transfer from one object to another. When an energy transfer takes place, it inherently seeks the path of least resistance/impedance. Thus, energy typically moves along each object surface to gather at the point(s) nearest contact and, thereby, anticipates contact. Also, the energy transfer typically increases as the objects come closer to contact. By configuring a system such that a tool's mechanical contact surfaces also serve to transfer sensing energy (capacitance), pre-contact sensing, without blind spots, the concept of virtual feel may be introduced. Therefore, a single sensor reading from the surface of an object can sense, guide, precisely position and align two mating members in six (6) degrees-of-freedom (6 DOF) in a manner analogous to human feel, without actual contact, ergo, virtual feel.
In the one embodiment, two electrically conductive capacitor electrodes may be constructed such that one can coaxially fit inside the other with equal separation between them in all directions. One electrode can be energized with an electrical ac potential and the other electrically grounded to form a capacitor with displacement current passing between the two electrodes and electric charge pairs being distributed over their mutually proximal electrode surfaces. Displacement current and electrode charge pairs change (both in amount and in location) when one or more of the electrodes is moved. The closer the electrodes at any point, the greater the displacement current and increasingly so right up to contact. Surprise (dead zone) contacts are prevented. The change in displacement current and its rate of change can be measured as can the amount and direction of electrode movement. Cause and effect relationships between electrode movement (amount and direction) and displacement current change and rate of change can be related to precisely guide the removal from or insertion of one electrode inside the other in a non-contact manner, even with small separation. This non-contact “Virtual Feel” process of using electrical signals from displacement current rising and falling with electrode small gap separation changes may be analogous to “real feel” using electrical signals from actual contact pressure, force or torque.
Electric charge on the electrode/contact surface typically changes, in reaction to changes in the distance between the electrode contact surface and the surface of some object. Adjustments in the movement of the electrode contact surface may allow a single Capaciflector electrode to provide 6 DOF sensing information because the electrode contact surface and the single Capaciflector electrode are one in the same. As the contact surface is adjusted in one direction, electric charge may move along the contact surface to collect and increase around the point of nearest contact and net displacement current between the proximal contact surfaces may increase. The point of nearest contact may correspond to the actual point of contact, if one were using actual feel. The sensor electronics can report this as an increase in electrical signal (or virtual force). When the electrode contact surface is adjusted in the opposite direction to relieve this “virtual force”, the charge (and displacement current) can first decrease and then increase and redistribute to the new point of nearest contact. This, again, corresponds to the new, actual contact point, if one were using actual feel. The sensor electronics can report this sequence as first a decrease in virtual force, followed by an increase. In this manner, a single Capaciflector electrode can provide 6 DOF virtual force responses to wiggling motions. When a preferential direction of movement is included, non-contact “virtual feel” precision positioning and alignment can result.
a and 4b are simple geometric illustrations of the basic concept of virtual feel.
The basic capacitance equation for a parallel plate capacitor is defined as:
where
Thus, when a plate is center located between two (2) parallel plates as shown in
Where dc is the distance between plate 50 and the ground plates 52a and 52b when the plate 50 is centered. When the plate is moved a short distance (Δd) in the +x direction
we have:
Thus, the minimum capacitance occurs when plate 50 is centered between parallel plates 52a and 52b. Whenever the plate is moved off center (either + or −), the capacitance increases. Therefore, as Δd approaches dc, the capacitance becomes increasingly large. The closer plate 50 comes into contact with either of plates 52a or 52b, the stronger the capacitance and the stronger the sensor signal. The strength of the sensor signal is determined as follows:
Assuming a signal voltage of 1 volt when the plate is centered (this level is set reasonably high to yield maximum sensitivity) the circuitry (not shown) is set up so that the signal voltage increases as the capacitive coupling between the plate 50 and the parallel plates 52a or 52b increases. This concept is illustrated via equations (5) and (6),
Assuming the electronics can discriminate a 30 millivolt change caused by increased displacement current.
Thus:
Thus, if dc=0.005 in., Δd=8.5 E-4 in.
Then the precision is better than 0.001 in. for clearances of 0.010 in. total or 0.005 in. on each side of plate 50.
a and 5b show one embodiment of parallel plates 50, 52a and 52b with their associated lines of capacitance 51.
Q=CV
Q=V(C1+C2) (7)
When the electrode plate 50 is centered between the parallel ground plates 52a and 52b:
C1=C2
Q=V2C1 (8)
When the electrode plate 50 is translated across ½ the gap, the capacitance changes to:
across the gap that increases (for a net loss of ⅓ in 1) and:
C12 across the gap that decreases (for a net gain of 1 in 1). (9)
For a total of
This presents a net relative charge and displacement current gain of:
The net relative charge can be measured by sensor circuitry (not shown). From the perspective of point pairs, the net relative gain represents the sum (or integral) of the net gains and losses of each point. When a point on a surface moves to close a gap, some point on the opposite surface moves an equal distance to open a gap. For this point pair, we get a net charge and displacement current increase; the larger the distance traveled and the greater the number of points (and area), the larger the increase. This relationship holds regardless of means of movement in perturbing the gaps (translation, rotation or some combination of the two). It also holds true regardless of the direction of movement. Whenever the perturbation moves from the center, which represents minimum capacitance, charge and displacement current show a net increase.
a shows an embodiment of an electrode plate 60 centered within a ground channel plate 62 and charge distribution lines 61. This illustration represents a rod inside an equal length channel. In this instance there is a net charge and displacement current increase when we depart from minimum capacitance center position in two dimensions.
b shows the increase is a superposition for the charge and capacitance for two (2) sets of orthogonal plates. The charge distribution lines 63 which are closer together on the sides approaching contact and further apart on the sides that moves away from contact illustrate the fact that capacitance increases as plate 60 approaches channel walls 62a and 62b.
a and 7b are simple geometric illustrations of the virtual feel concept wherein plate 50 is rotated.
In
a shows an embodiment of a rotated electrode plate 50 with charge distribution lines 55 between parallel plates 52a and 52b. When the electrode plate 50 is rotated about the tool point (bottom center of plate 50) there is movement of a point pair (A1, A2) away from minimum, centered, capacitance and a net gain in charge and displacement current. The charge distribution lines 55 illustrate the fact that capacitance is increased at point A1 which corresponds to dMIN illustrated in
b shows rotated electrode plate 50 with charge distribution lines 57 between parallel plates 52a and 52b.
a and 10b show a top view of charge distribution in 3-D translation for an embodiment with a round rod 80 inside a round cylinder 82.
a and 11c show an embodiment with a hexagonal plate 90 and the associated charge distributions. The results are similar to what has been experienced in the other configurations.
a and 12c show an embodiment with an asymmetric plate 100 and the associated charge distributions. The results are similar to what has been experienced in the other configurations.
To those skilled in the art, many modifications and variations of the present invention are possible in light of the teachings contained herein. It is therefore to be understood that the present invention can be practiced otherwise than as specifically describe by these teachings and still be within the spirit and scope of the claims.
The present invention is related to inventions shown and described in: U.S. Pat. No. Re. 36,772, entitled, “Driven Shielding Capacitive Proximity Sensor”, filed on Nov. 6, 1996; and, U.S. Pat. No. 5,539,292, entitled “Capaciflector Guided Mechanisms”, filed on Nov. 28, 1994. The above-noted related patents are assigned to the assignee of the present invention. These related patents are herein incorporated by reference.
The invention described herein was made by employees of the United States Government, and may be manufactured and used by or for the Government for governmental purposes without the payment of any royalties thereon or therefor.