The present invention relates generally to methods, systems, and apparatus adapted to calibrate a positional orientation of a robotic component.
In medical testing and processing, the use of robotics may minimize exposure to, or contact with, bodily fluid samples (otherwise referred to as “specimens”) and/or may increase productivity. For example, in some automated testing and processing systems (e.g., clinical analyzers and centrifuges), sample containers (such as test tubes, sample cups, vials, and the like) may be transported to and from sample racks (sometimes referred to as “cassettes”) and to and from a testing or processing location or system.
Such transportation may be accomplished by the use of an automated mechanism, which may include a suitable robotic component (e.g., a moveable robot arm or gantry arrangement) having a moveable end effector that may have gripper fingers coupled thereto. The end effector may be moved in two or more coordinate directions (e.g., X, R, and Z). In this way, a sample container (containing a specimen to be tested or processed) may be gripped by the end effector, and then moved from one location to another in relationship to the testing or processing location or system. For example, the sample container may be moved to and from a receptacle of a sample rack.
Inaccurate calibration may result in inaccurate positioning of the end effector and may cause collisions or jams between the end effector and the sample container, and/or between the sample container being moved and the testing or processing system or sample rack. Additionally, inaccurate calibration may contribute to jarring pick and place operations of the sample container, which may contribute to unwanted spillage of specimen from the sample container. Furthermore, knowing a precise rotational orientation of the end effector fingers may allow for the manufacture of smaller sample racks, in that the fingers may be placed in a defined orientation when grasping the sample container, thereby allowing the distance between respective sample containers in the sample rack in other directions to be minimized.
Accordingly, methods, systems, and apparatus that may improve accuracy of positioning of a robotic component relative to an article, such as a sample rack, in testing and processing systems are desired. Furthermore, methods that improve accuracy of positioning of robot fingers of end effectors are also desired.
In a method aspect, an improved method of calibrating a position of an article relative to an end effector of a robot is provided. The method includes providing a robotic component having the end effector with end effector fingers and a light beam sensor provided in a fixed orientation to the end effector fingers; providing a teach tool at an approximately known location on the article within a work envelope reachable by the end effector, the teach tool having a geometrical calibration feature; positioning the end effector with the light beam sensor at a first location proximate to the geometrical calibration feature; rotating the end effector and sensing with the light beam sensor a first engagement edge of the geometrical calibration feature of the teach tool; and rotating the end effector and sensing with the light beam sensor a second engagement edge of the geometrical calibration feature of the teach tool.
According to another aspect, an improved robot calibration system is provided. The system includes a robotic component having an end effector with end effector fingers; a light beam sensor provided in a fixed orientation to the end effector fingers; a teach tool coupled to an article at a first location, the teach tool including a geometrical calibration feature; and a controller adapted to rotate a light beam of the light beam sensor around the geometrical calibration feature of the teach tool and calculate a position thereof based upon edge interferences between the geometrical calibration feature and the light beam.
In an apparatus aspect, a calibration assisting tool is provided. The calibration assisting tool includes a base adapted to couple to an article; a first geometrical calibration feature extending from the base, the geometrical calibration feature including a cylindrical post extending from the base; a second geometrical calibration feature including a flat surface; and a third geometrical feature extending crosswise through the base or cylindrical post.
In another method aspect, a method of calibrating a rotational position of fingers of an end effector is provided. The method includes providing a robotic component having the end effector and a light beam sensor provided in a fixed orientation to the end effector fingers; providing a teach tool within a work envelope reachable by the end effector, the teach tool having a rotational geometrical calibration feature; grasping the teach tool with the fingers of the end effector and rotating the teach tool relative to a scanner; scanning the teach tool during the rotation to determine a rotational orientation of the teach tool; positioning the teach tool with the end effector in a known rotational orientation and releasing the end effector fingers from the teach tool; positioning the end effector with the light beam sensor proximate to the rotational geometrical calibration feature; and rotating the end effector and the light beam of the light beam sensor to determine the rotational orientation of the fingers relative to the rotational geometrical calibration feature.
Still other aspects, features, and advantages of the present invention may be readily apparent from the following detailed description by illustrating a number of exemplary embodiments and implementations, including the best mode contemplated for carrying out the present invention. The present invention may also be capable of other and different embodiments, and its several details may be modified in various respects, all without departing from the spirit and scope of the present invention. Accordingly, the drawings and descriptions are to be regarded as illustrative in nature, and not as restrictive. The drawings are not necessarily drawn to scale. The invention is to cover all modifications, equivalents, and alternatives falling within the scope of the invention.
In robotic apparatus, such as those used to accomplish robotic pick and place operations in clinical analyzers or other testing or processing systems, for the aforementioned reasons, achieving precision in the placement of robotic end effector fingers is desirable. “End effector” as used herein is any member coupled to a robot that is used in robotic operations to grasp and/or move a device (e.g., a sample container) from one location to another, such as in a pick and place operation. In such robotic systems, positional precision to several thousands of an inch or less may be desirable. However, in many instances, tolerance stack-ups due to manufacturing variances and assembly variances of the multitude of connected system components may amount to many thousandths, or many hundredths, or even many tenths of an inch. Accordingly, means for appropriately determining an actual position of a robotic end effector relative to an article (e.g., in X and R; X, R, and Z; X, R, and T, or X, R, Z, and T) in such a robotic system is desired.
In view of the foregoing problems, the present invention provides calibration methods, calibration systems, and calibration assisting tools for readily determining an actual position of an article relative to an end effector in a robotic system.
In a first aspect, a method of calibrating a position of an article relative to an end effector of a robot is provided. The method includes providing a robot with an attached end effector and end effector fingers and a light beam sensor provided in a fixed orientation thereto, and a teach tool on the article. The light beam sensor may be fixed (immoveable) vertically, and horizontally (in X-R coordinates) relative to the end effector, and fixed relative to the fingers such that a light beam always remains in a fixed orientation relative to the fingers, i.e., the light beam rotates with the fingers. The teach tool has a geometrical calibration feature (e.g., a cylindrical post) thereon. The light beam sensor is positioned proximate to the geometrical calibration feature and rotated to sense with the light beam several engagement edges of the geometrical calibration feature. A location of the geometrical calibration feature is calculated based upon the sensed location of several engagement edges. Once the location of the geometrical calibration feature is determined, another feature of the teach tool may be measured (e.g., a vertical geometrical calibration feature) such that orientation in another degree of freedom (e.g., the Z direction) may be determined. In other embodiments, an orientation of a rotational geometrical calibration feature (e.g., a hole through the teach tool) of the teach tool may be determined by orienting and rotating the fingers and light beam sensor relative to the rotational geometrical calibration feature. This may determine an orientation of the end effector fingers in a T direction (e.g., rotation).
In another aspect, a robot calibration system is provided. The robot calibration system includes a robotic component having a moveable end effector with end effector fingers, and a light beam sensor provided on the end effector. The system also includes a teach tool coupled to an article at a first location whose orientation is to be determined, wherein the teach tool has a geometrical calibration feature thereon. The system includes a controller adapted to rotate a light beam of the light beam sensor around the geometrical calibration feature of the teach tool and thereafter calculate a position (e.g., center in X-R coordinates) of the geometrical calibration feature that is based upon edge interferences between the geometrical calibration feature and the light beam.
In another aspect, a calibration assisting tool is provided. The calibration assisting tool includes a base adapted to couple to an article, a first geometrical calibration feature extending from the base, the geometrical calibration feature including a cylindrical post extending from the base; a second geometrical calibration feature including a flat surface; and a third geometrical feature extending crosswise through the base or cylindrical post.
In yet another aspect, a method of calibrating a rotational orientation of end effector fingers of an end effector is provided. The method involves scanning the teach tool to determine an orientation of a rotational geometrical calibration feature thereon, placing the tool in a known orientation (e.g., in a receptacle of a sample rack), and then rotating the end effector fingers about the teach tool to determine the rotational orientation of the fingers to the rotational geometrical calibration feature of known orientation.
These and other aspects and features of the invention will be described with reference to
In accordance with a first embodiment of the invention, as best shown in
The robotic apparatus 101 includes a robotic component 103 having an end effector 104 being coupled thereto. The end effector 104 may have two or more moveable jaws or fingers 104A, 104B that are adapted to grasp components, such as sample containers (e.g., sample tubes) and/or sample racks 105 that are adapted to receive sample containers in one or more receptacles 106 thereof. A partial cross sectional view of the sample rack 105 is shown in
Prior to calibration, the location of the sample rack 105 on a component of the testing or processing system may be only “generally known” in three-dimensional space. For example, the location of the sample rack 105 on a system component, such as on a tray or portion of a frame 107 of the system may only be “generally known.” The sample rack 105 may include one or more geometrical features that aid in generally locating the sample rack 105 on the tray or frame 107, such as locator pins or features, tabs, locking mechanisms, or other orienting features (not shown). It is said herein that the location of the sample rack 105 may only be “generally known” because of the tolerance stack-ups in manufacturing of the system, and that a precise location of one or more of the receptacles 106 is desired to be “precisely known” for the reasons listed above. Accordingly, the present invention (method and system) has great utility in enabling a location of one or more receptacles 106 of the sample rack 105 to be “precisely known,” that is known with a relative high degree of certainty or precision.
In more detail, the robotic apparatus 101 includes a light beam sensor 108 that enables the robotic apparatus 101 to gauge whether the gripper fingers 104A, 104B have an item in their vicinity to grasp. The light beam sensor 108 may include fiber optic components, such as a light source 108A, an optical fiber 108B adapted to carry and direct a light beam 108C, and a light detector 108D adapted to receive and detect a presence of a light beam 108C thereat. The light beam sensor 108 functions to send a light beam 108C from the optical fiber 108B to the detector 108D. The light beam sensor 108 may be coupled directly to a portion of the end effector 104 or to a portion of the robotic component (e.g., to a robot arm, boom, or beam), but the location between the centerline axis 104C of the end effector 104 and the light beam sensor 108 is fixed and known. Preferably, the light beam 108C is oriented so that the light beam 108C passes through the centerline axis 104C of the end effector 104 (i.e., through the T axis of rotation). For example, the light beam 108C may be oriented generally horizontally. The light beam 108C may be made as small as practical. Likewise, the Z dimension between the lower terminal ends of the gripper fingers 104A, 104B or gripping members of the end effector 104 and the light beam 108C is also fixed and known. Rotation of the fingers 104A, 104B of the end effector 104 relative to the robotic component 103 causes the light beam 108C to also rotate with the fingers 104A, 104B in a fixed relationship thereto.
The robotic apparatus 101 may include a suitable controller 110 that may command the robotic component 103 and attached end effector 104 and move the end effector 104 and light beam sensor 108 in one or more coordinate directions, two or more coordinate directions (e.g., X and R), three or more coordinate directions (e.g., X, R, and Z or X, R, and T), or even four directions (e.g., X, R, Z, and T), where X is into and out of the paper in
Any suitable robotic component 103 may be used, such as a moveable multi-arm robot (e.g., having included one or more shoulder, elbow, or wrist elements), a telescopic boom robot, or a beam or beams having one or more motors coupled thereto. Any suitable mechanism for imparting motion to the end effector 104 may be used. In one implementation, the robotic component 103 may be used to accomplish three-dimensional coordinate motion (X, R, and Z) of the end effector 104 so that sample containers may be placed in a receptacle 106 of a sample rack 105. Additionally, the robotic component 103 may accomplish a rotation (T) of the end effector 104, which is rotation about the axis 104C, so that the fingers 104A, 104B may be precisely oriented relative to a sample container (not shown) in a sample rack 105, or relative to the sample rack 105 when a sample container is being inserted in the sample rack 105.
The robotic component 103 may include a moveable assembly including an R axis motor adapted to impart R axis motion to the end effector 104 relative to a frame of the testing or processing system, an X axis motor adapted to cause X axis motion of the end effector 104 relative to the frame, a Z axis motor adapted to cause Z axis motion of the end effector 104 relative to the frame, and a T axis motor adapted to cause rotation of the end effector fingers 104A, 104B relative to the frame in the T direction (about the axis 104C). Suitable feedback mechanisms may be provided for each degree of motion, such as position and/or rotation sensors. The robotic component 103 may include suitable tracks or guides and suitable motors, such as one or more stepper motors, servo motors, pneumatic or hydraulic motors, electric motors, or combinations thereof. Furthermore, drive systems including chains, guides, pulleys and belt arrangements, gear or worm drives or other conventional drive components may be utilized to cause the various motion of the end effector 104. Other types of robotic components 103 may be employed.
Again referring to
As previously mentioned, the robot calibration system 100 includes one or more teach tools 102. The one or more teach tools 102 may be mounted to the article (e.g., sample rack 105) for which the precise positional calibration is to be determined. For example, in the present instance, one or more teach tools 102 may be mounted in one or more receptacles 106 of the sample rack 105. The sample rack 105 and teach tool 102 may be placed in a testing or processing system at any location within the reach of the robotic component 103. For example, the sample rack 105 may be placed and locked in a generally-known position in the testing or processing system within the reach of the robotic component 103.
As shown in
In the depicted embodiment, teach tool 102 includes a geometrical calibration feature 112. The geometrical calibration feature 112 may be a generally cylindrical post extending upwardly from a base 114 of the teach tool 102. The teach tool 102 may be received securely in the receptacle 106 of the sample rack 105 by any suitable means, such as first and second leaf springs 116F, 116S (
In another aspect, the teach tool 102 may include a rotational geometrical calibration feature 124 that is used to determine and calibrate a rotational orientation of the end effector fingers 104A, 104B. Knowing the rotational orientation of the fingers 104A, 104B allows the rack 105 to be made smaller in at least one direction, because the clearance needed for the fingers 104A, 104B may be eliminated in that direction. In some embodiments, the rotational geometrical calibration feature 124 may comprise a through hole formed through the teach tool 102. The through hole may be formed crosswise through the body or optionally through the post as is shown in
Additionally, the teach tool 102 may include a hoop groove 126 that may encircle the perimeter of the base 114. Furthermore, the teach tool 102 may include a start groove 128 that extends along a direction parallel to the tool axis 120, i.e., in a vertical orientation. Furthermore, a bar code label 130 may be positioned and affixed on the surface of the teach tool 102, such as on the base 114 thereof. The bar code label 130 may be affixed to the base 114 in a known orientation, such as shown. In particular, the location of the start groove 128 may be generally aligned with the axis 120 and also with the axis of the rotational geometrical calibration feature 124. The bar code 130 may include a detectable feature such as a detectable edge 130A placed so as to abut an edge of the start groove 128. The detectable edge 130A may be detectable by a bar code reader 132 (
A first method aspect of a method 200 of the invention will now be explained in detail with reference to the flowchart in
In step 210, the end effector 104 is again rotated, and a second engagement edge 136 of the geometrical calibration feature 112 of the teach tool 102 is sensed with the light beam sensor 108. In some embodiments, the light beam 108C may be rotated continuously from the contact with the first engagement edge 134 to the second engagement edge 136 in a clockwise direction, for example. As the light beam 108C is again sensed by the detector 108D as is shown in
As shown in the graphic illustration of
L1=r/sin α Equation 1
where α=½ (θ2−θ1).
Since R is known because the diameter D (i.e., D=2r) of the geometrical calibration feature 112 is precisely known, and α is known through measurement of first and second angles θ1 and θ2, L1 can be determined, wherein L1 is the distance between the center axis 104C of the end effector 104 and the center of the geometrical calibration feature 112. The exact location of the center of the geometrical calibration feature 112 in X-R coordinates may be more precisely determined by repeating the above method. Thus, the end effector 104 may be moved in the X and R directions by known amounts, and then the edge finding method described above for determining the center of the geometrical calibration feature 112 is repeated.
In more detail, a precise determination of the center may be obtained by moving the end effector 104 with the light beam sensor 108 to a second location proximate to the geometrical calibration feature 112 of the teach tool 102. The second location is different than the first location. The end effector 104 is again rotated and a third engagement edge of the geometrical calibration feature 112 is sensed with the light beam sensor 108 via breaking the light beam 108C. The rotation of the end effector 104 then may continue in the same direction and a fourth engagement edge of the geometrical calibration feature 112 is sensed when the light beam 108C is again detected by detector 108D of the light beam sensor 108. The length (L2) from the second rotation point to the center of the geometrical calibration feature 112 of the teach tool 102 may then be calculated based upon a location of the third and fourth engagement edge and using Equation 2:
L2=r/sin α Equation 2
where α=½(θ4−θ3).
Once L1 and L2 are known, an exact location of the center of the geometrical calibration feature 112 of the teach tool 102 relative to the centerline axis 104C of the end effector 104 in the X-R plane may be determined geometrically using the cosine rule of Equations 3, 4, and 5 below and referring to
L3=(X2+R2)1/2 Equation 3
C=Cos−1((L12−L32+L22)/(−2×L3×L2)) Equation 4
L2/Sin A=L1/Sin C Equation 5
Once angles A and C are known, the location of the center of the geometrical calibration feature 112 of the teach tool 102 relative to the centerline axis 104C is also known. The calibration may be repeated a third time to even more precisely locate the exact center of the geometrical calibration feature 112.
Once the center location of the geometrical calibration feature 112 is known, an additional calibration routine may be executed to determine a vertical location of a vertical geometrical calibration feature 112A of the teach tool 102, as best shown in
In another broad aspect of the invention, a calibration method adapted to determine a rotational orientation of the end effector fingers 104A, 104B relative to the teach tool 102 and the article (e.g., sample rack 105) is provided. This calibration may be accomplished in addition to the center-finding calibration method and/or the vertical calibration method where it is desired to know the rotational orientation of the end effector fingers 104A, 104B relative to an article. According to the method, the teach tool 102 may be engaged (e.g., gripped) by the end effector 104 (e.g., by gripper fingers 104A, 104B) as shown in
Now the teach tool 102 is again placed (bottomed) in the sample rack 105 as shown in
The end effector 104 may be further rotated until the light beam 108C is no longer detected by the light detector 108D, as shown in
In some instances, the light beam 108C, when first oriented at the rotational geometrical calibration feature 124, will by mere chance be oriented along the rotational geometrical calibration feature 124. In this instance, the end effector 104 will be rotated through a predetermined angle (e.g., 90 degrees) such that the rotational orientation measurement sequence will start with the light beam 108C not passing through the rotational geometrical calibration feature 124, and then carried out as discussed above.
The above calibration methods may be carried out in any order, but will be best implemented by first calibrating the center of the geometrical calibration feature 112, then calibrating the Z axis height of the vertical calibration feature 112A, followed by calibration of the rotational orientation of the fingers 104A, 104B to a center of the rotational geometrical calibration feature 124.
Thus, in one implementation, the calibration method is carried out to determine the orientation of the end effector 104 in the X-R plane, and Z, and T directions. The calibration method is carried out relative to the teach tool 102 including the geometrical calibration feature 112, the vertical calibration feature 112A, and the rotational geometrical calibration feature 124.
One method of calibrating a position of an article relative to an end effector of a robot may be carried out as follows. According to the method, as best shown in
Using the above center-finding calibration method, the exact positional center location of the geometrical calibration feature 112 in X-R space may be found. The vertical orientation of the end effector 104 to the article (e.g., a receptacle 106 of the sample rack 105) may be determined by calibrating the vertical geometrical feature 112A as described above. Alternatively, or in addition, the rotational calibration method may be used. Accordingly, the X, R, Z location of the article (e.g., a receptacle 106 of the sample rack 105) may be determined. Moreover, the rotational orientation of the fingers 104A, 104B of the end effector 104 may be determined relative to the article and/or frame of the processing or testing system.
It should be understood that one or more additional teach tools 102 may be used (or moved to other locations) on other system component(s) within the reach of the end effector 104. Thus, positions of other features of an article may be calibrated. For example, the teach tool 102 may be arranged at more than one location of the article (e.g. in more than one receptacle 106 of a sample rack 105) as shown in
An exemplary method of determining a rotational orientation of the end effector fingers 104A, 104B of the end effector 104 will now be described with reference to
While the invention is susceptible to various modifications and alternative forms, specific system and apparatus embodiments and methods thereof have been shown by way of example in the drawings and are described in detail herein. It should be understood, however, that it is not intended to limit the invention to the particular systems, apparatus, or methods disclosed but, to the contrary, the intention is to cover all modifications, equivalents, and alternatives falling within the scope of the invention.
This application claims priority to U.S. Provisional Application Ser. No. 61/454,069 entitled “METHODS, SYSTEMS, AND APPARATUS FOR CALIBRATION OF AN ORIENTATION BETWEEN AN END EFFECTOR AND AN ARTICLE” filed on Mar. 18, 2011, the disclosure of which is hereby incorporated by reference in its entirety herein.
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/US2012/029501 | 3/16/2012 | WO | 00 | 9/12/2013 |
Number | Date | Country | |
---|---|---|---|
61454069 | Mar 2011 | US |