Background of the Invention
1. Field of the Invention:
The invention relates to robots and more specifically to robots for assembling electronic circuits with the position of the leads of the component to be assembled determined by sequentially rotating the component about an axis of rotation and calculating the locations of each of the leads with respect to the axis of rotation.
2. Description of the Prior Art:
Automated equipment for assembling elecrical circuit boards is known in the art. The successful operation of automated assembly equipment depends upon the capability of determining the location of the leads of electrical components to be inserted into a printed circuit board with sufficient accuracy to permit the leads to be inserted without excessive interference between the component leads and the edges of the hole into which the lead is to be inserted. In applications where sufficient dimensional tolerances between the size of the lead and the circuit board holes into which the leads are to be inserted is available, the leads of components such as resistors may be trimmed and prebent with sufficient accuracy to permit the leads to be inserted without undue difficulty. Prior art automated assembly systems have attempted to locate the tips of the leads using vision systems having an optical axis substantially parallel to the leads. These techniques have encountered operational difficulties when accurate position of the leads was required.
Summary of the Invention
The preferred embodiment of the invention utilizes a gripper mounted on a robot or similar automated insertion apparatus to insert components into a printed circuit board. More specifically, the leads of the components to be assembled in the circuit board are trimmed and preformed such that the leads of the components are substantially parallel to each other with each lead of a multi-lead component differing from all other leads in length by a predetermined value. The component to the inserted into the printed circuit board is acquired by the robot and held by the gripper such that the leads extend downwardly from the component in a substantially vertical direction. A first visual (preferably TV) image of the downwardly extending leads is acquired by moving the robot to position the component at a predetermined position in front of a visual sensor (preferably a TV camera). A first rotary motion about the vertical axis of the gripper rotates the leads of the components through a predetermined angle and a second TV image is acquired and stored. A second rotary motion about the vertical axis of the gripper is utilized to rotate the component and its downward extending leads through an angle of 180.degree. with respect to the original position and a third TV image of the lead position is acquired and stored. The different lengths of the individual leads permits each lead to be uniquely identified in each of the images. From these TV images, the position of each of the leads of the component relative to the rotational axis of the gripper and the robot is calculated. Utilizing this information, the robot is then commanded to move such that the longest lead of the component is immediately above the hole in the circuit board into which it is to be inserted. A downward motion slightly inserts the longest lead and then the robot is commanded to move to a position such that the second longest lead is immediately over the opening into which it is to be inserted. This process is sequentially repeated until all of the leads of the component are inserted into the appropriate openings in the circuit board. Of course, the vertical position of the leads is arbitary. That is, this orientation is selected as a matter of convenience. Also, it is convenient to "back light" the leads because this conveniently produces sharp high contrast images.
Brief Description of the Drawings
FIG. 1 is a functional block diagram of the hardware comprising the system;
FIGS. 1 through 7 illustrates the rotation of a component to generate data for determining the position of the leads of the component;
FIG. 8 is a diagram illustrating the mathematics of the lead position calculation;
FIG. 9 illustrates the insertion of the longest lead of the component into the circuit board; and
FIG. 10 illustrates the illustration of the shorter leads in the circuit board.
Description of the Preferred Embodiments
FIG. 1 is a somewhat functional diagram of the apparatus comprising the preferred embodiment of the invention. A conventional robot 10 has a gripper 12 affixed to the movable arm of the robot 10. Control commands are supplied to the robot 10 by a conventional robot controller 14 permitting the movable arm to move in all directions. A conventional TV camera 16 is positioned at a location such that the robot 10 can position a component 18 held in the jaws of the gripper 12 within the field of view of the TV camera 16. Video signals from the TV camera 16 are coupled to a digital computer 20. The digital computer 20 communicates with the robot control 16 to complete the coordination of the system to insert the leads of the component 18 into holes on the circuit board 19. (This process is described and illustrated in more detail later.) Conventional "back lighting" techniques can be used to back light the component 18 in order to produce high contrast images of the component leads.
Operation of the system illustrated in FIG. 1 with respect to the process for determining the precise location of leads of a component 18 to be inserted into a printed circuit board 19 will be described with reference to FIGS. 2 through 7. More specifically, a component 18 is acquired by the robot 10 by causing the two fingers of the gripper mechanism 24 and 26 to contact the outer edges of the component 18 and apply sufficient force to support the component 18. The robot 10 positions the component 18 in the field of view of TV camera 16 such that the two leads 28 and 30 of the component 18 are in a plane which is substantially 90.degree. with respect to the optical axis of the TV camera 16. With the component 18 in this orientation, the TV camera 16 produces a binary image of the leads 28 and 30. These images are illustrated at reference numeral 28a and 30a, FIG. 3. From this image, the computer calculates the distance .DELTA.X1 and .DELTA.X1' which defines the distance of each of the leads from a reference edge 32 of this TV image.
In order the produce a second TV image of the component 18, the robot 10 is commanded to rotate the component 18 counterclockwise through a predetermined angle, 60.degree., for example, as illustrated in FIG. 4. A second TV image of the leads is produced with the resultant images of the leads is illustrated at 28b and 30b in FIG. 5. From this image, second distances .DELTA.X2 and .DELTA.X2' are measured which gives the distance of the leads 28 and 30 from the reference edge 32 with the component oriented in this orientation.
A third TV image is generated by commanding the robot 10 to orient the component 18 180.degree. from its original position. This orientation is illustrated in FIG. 6. In this orientation, a third TV image of the leads 28 and 30 is generated as illustrated in FIG. 7. This gives two new distances .DELTA.X3 and .DELTA.X3' respectfully identifying the distances from the reference edge 32 to the leads 28 and 30.
FIG. 8 is a diagram illustrating the position of the longest lead 28 with respect to the point about which the lead is rotated, specifically point XO and YO. From this diagram, the various distances of the longest lead 30 can be calculated using the following formulas.
Also, since a+b=A, then
(Substitute (1), (2) and (3) in (5))
(multiply (6r) by )
Similarily,
(Substitute (1), (2) and (4) in (7) and multiply by (r)
(Substitute (6) for .DELTA.Y2 -Y0 in (8))
(Multiply out and rearrange terms)
(substitute for 1-cos.sup.2 (A)=sin.sup.2 (A) and divide equation by sin (A))
Rearranging the terms in (10), the equation for the .DELTA.Y1-Y0 in terms of the knowns .DELTA.X1-X0, .DELTA.X2-X0, and the angle A is:
After the calculations have been made in accordance with the above discussion, the location of the longest lead 30 precisely known with respect to the axis (identified in the plane by points XO and Y0) of rotation of the gripper 12 known. Since the location of the gripper 12 is precisely known with respect to the robot 10 and the circuit board 19, the position information necessary to insert the leads 28 and 30 into the circuit board 19, is avaliable.
The insertion process will be described with reference to FIGS. 6 and 7 which illustrate the insertion of the leads 28 and 32 into circuit board 19. (Only a fragment of circuit board 19 is illustrated.) The first step in the insertion process is to position the robot 10 such that the longer lead 30 is precisely located above the opening in the circuit board 19 through which it is to be inserted. In this position, the component 18 is moved such that the longest lead 30 extends slightly into the opening in the circuit board 19. Then the robot 30 moves, as necessary to, position the shorter lead 28 above the opening in the circuit board 19 and to which it is to be inserted. Then the program robot is programmed to complete the insertion as illustrated in FIG. 7. This process permits components whose leads are not precisely preformed to a spacing matching the spacing of the holes into which the leads are to be inserted, to be assembled.
The above illustrated process is repeated for each component to be mounted on circuit board 19. Interconnections between the components on the circuit board 19 may be provided using conventional techniques, such as printed wiring. Although the typical component 22 is what is commonly referred to as a "can" type component "radial" type components such as conventional resistors can be mounted using this technique.
Although the invention has been described above with respect to assembling electronic circuit boards, it is obvious that similar techniques can be used to assemble other mechanical device.