|Publication number||US4356554 A|
|Application number||US 06/186,636|
|Publication date||Oct 26, 1982|
|Filing date||Sep 12, 1980|
|Priority date||Sep 12, 1980|
|Publication number||06186636, 186636, US 4356554 A, US 4356554A, US-A-4356554, US4356554 A, US4356554A|
|Inventors||Kenneth J. Susnjara, Michael N. Diamond|
|Original Assignee||Thermwood Corporation|
|Export Citation||BiBTeX, EndNote, RefMan|
|Patent Citations (5), Referenced by (44), Classifications (24)|
|External Links: USPTO, USPTO Assignment, Espacenet|
This invention relates to industrial robots, and more particularly, to control systems for such robots.
In the design and development of industrial robots it has been the primary objective of most robot manufacturers to produce a machine which will most nearly simulate the work function of an individual worker at a cost saving so as to provide improved productivity. Most commercially available robots, however, do not achieve such an objective because they require an initial investment which is too great. Much of this high initial investment is caused by the need to use very high quality electronic and other components in order to insure that as few positioning errors are created by the system itself as possible. That is, in robot systems of the type here in question it is quite possible that the various components used can introduce errors which will cause the actual point in space to which the robot is aimed to differ from the desired point. Should lower quality components be used in most systems the aimed point will differ much more significantly from the desired point than would be the case with the use of higher quality components.
Accordingly, it is an object of the invention to provide improved means and method for controlling industrial robot mechanisms wherein lower cost components can be used, but which provides correction for errors introduced by such components.
Another object of this invention is to provide means and method for continuously correcting positioning errors in industrial robot control systems which errors are introduced by the control system itself.
The foregoing and other objects and advantages of the invention will become more apparent to those having ordinary skill in the art to which the invention pertains through consideration of the following description taken with the accompanying drawings, wherein:
FIG. 1 is a perspective view of an embodiment of an industrial robot illustrating an exemplary environment for the invention principally illustrating the side and rear portion of the robot;
FIG. 2 is a perspective view of an opposite side and rear portion of the FIG. 2 embodiment;
FIG. 3 is an enlarged vertical cross-sectional view of the lower end of the embodiment shown in FIGS. 1 and 2, principally illustrating the support base assembly, the lower end of the tank unit and the mounting of the lower end of the tank unit on the support base assembly;
FIG. 4 is a cross-sectional view taken along line 4--4 in FIG. 3;
FIG. 5 is a vertical cross-sectional view of a portion of the upper arm member of the embodiment shown in FIGS. 1 and 2 illustrating the wrist assembly of the embodiment;
FIG. 6 is a cross-sectional view taken along lines 6--6 in FIG. 5;
FIG. 7 is a perspective view of the wrist assembly of the embodiment shown in FIGS. 1 and 2 illustrating the components thereof in exploded view;
FIG. 8 is a diagrammatic-schematic view of the hydraulic control system for the FIGS. 1 and 2 embodiment and
FIG. 9 is a block-schematic view of an electronic control system for the FIG. 1 robot constructed in accordance with the principles of the invention.
Referring to FIGS. 1 and 2, there is illustrated an industrial robot system for performing a mechanical work function. This illustration provides an example of an environment in which the invention described herein is used. The robot consists of a support base assembly 10, a tank unit 11 is mounted on the support base assembly for rotational movement about a vertical axis, an articulated arm assembly 12 mounted on the upper end of the tank unit, a wrist assembly 13 mounted on the free end of the arm assembly, a work tool 14 mounted on the wrist assembly and an electro-hydraulic system 15 for controlling the rotation of the tank unit about its vertical axis of rotation, the manipulation of the arm assembly and the operation of the wrist assembly for positioning the work tool to perform the desired work function.
As best illustrated in FIGS. 3 and 4, the support base assembly consists merely of a base plate 16, a split clamp block 17 and a thrust bearing 18. Base plate 16 may be formed of any heavy material, such as steel, which will provide a good stable base for the machine. To provide increased stability, such member may be provided with bolt holes for bolting the machine to the floor at the desired work station. Split clamp block 17 includes a rigidly mounted block section 19 adapted to be bolted to the base plate, and a detachable block section 20. Block section 19 is rigidly secured to the base plate by means of a bolt 21 extending through a vertical opening in block section 19 and threaded into a threaded hole 22 provided in the base plate. Block section 19 further is provided with a vertical mating surface 19a having a vertically disposed, semi-circular recess 19b and a pair of horizontally disposed, threaded openings 19c. Detachable block section 20 is adapted to be mounted on the base plate and is provided with a vertical mating surface 20a having a vertically disposed, semi-circular recess 20b registrable with recess 19b of block section 19 for receiving therebetween the shaft of a rotary motor as will later be described. Block section 20 further is provided with a set of horizontal bolt openings 20c which are adapted to register with threaded openings 19c of block section 19. Block sections 19 and 20 are adapted to be drawn together to clamp the output shaft of a rotary motor between registered grooves 19b and 20b by means of a set of bolts 23 inserted through bolt holes 20c and threaded into registered threaded openings 19c.
Thrust bearing 18 is adapted to be seated on split clamp block 17 and rigidly secured thereto by bolting or other suitable means. The bearing is provided with an axial opening which is adapted to register with the opening provided by recesses 19b and 20b of the block sections.
Tank unit 11 functions primarily as a post member and includes a pair of front and rear walls 24 and 25, sidewalls 26 and 27, a top wall 28 and a bottom wall 29. As best illustrated in FIG. 3, bottom wall 29 is disposed above the lower edges of front and rear walls 24 and 25 and sidewalls 26 and 27 to provide an upper, closed compartment 30 and a lower compartment 31 opened at the bottom. Compartment 30 is utilized as a hydraulic fluid reservoir for electrohydraulic control system 15.
Referring again to FIGS. 3 and 4, lower compartment 31 is provided with a pair of support strips 32 and 33 which are rigidly secured to front and rear walls 24 and 25 of the tank unit and which function to support a fluid actuated rotary motor 34. The motor includes a housing 35 provided with a set of flanges 36 and 37, and an output shaft 38. The housing is mounted on support strips 32 and 33 by means of a set of bolts 39 which project up through bolt holes in flanges 36 and 37 and are threaded into threaded openings in support strips so that output shaft 38 of motor 34 projects through the opening in thrust bearing 18 and is received within the vertical opening defined by registered recesses 19b and 20b of the clamping block. Output shaft 38 is firmly clamped between registered recesses 19b and 20b by tightening bolts 23. Access to compartment 31 can be had through an opening in sidewall 27 which is provided with an access panel 112. It will be appreciated that by applying fluid under pressure to motor 34 with the output shaft thereof clamped to the support base assembly and the housing thereof clamped to the tank unit, the tank unit will be caused to rotate about its vertical axis of rotation relative to the support base assembly.
Arm assembly 12 generally includes a lower arm member 40 and an upper arm member 41. Lower arm member 40 includes a fluid actuated rotary motor 42 rigidly mounted on upper wall 28 of the tank unit, and a set of side plates 43 and 44. The side plates are spaced apart by means of a set of crosspiece members 45 and are provided at one set of ends thereof with openings for mounting such set of ends on laterally projecting portions of the output shaft of rotary motor 42.
Upper arm member 41 similarly includes a fluid actuated rotary motor 46 and a pair of side plates 47 and 48. One set of ends of side plates 47 and 48 are mounted on sides of rotary motor 46 and are provided with aligned openings therein through which laterally projecting portions of the output shaft of rotary motor 36 project, into aligned openings at the free ends of side plates 43 and 44 of the lower arm member. Side plates 47 and 48 are further maintained in parallel, spaced relation by means of a crosspiece member 49 and a support shaft 50 which is received within a pair of aligned openings at the free ends of said plates 47 and 48, and which supports the wrist assembly, as will later be described. It will be appreciated that by operating rotary motor 42, lower arm member 40 will be caused to pivot about a horizontal axis relative to the tank unit, and by operating rotary motor 46, arm member 41 will be caused to pivot about a horizontal axis relative to lower arm member 40.
Wrist assembly 13 is best illustrated in FIGS. 5 through 5. The assembly includes support shaft 50, a tool mounting unit 63, a set of beveled drive gears 51 and 52 and a set of hydraulic cylinder assemblies 53 and 54. As previously mentioned, support shaft 50 is adapted to be received and mounted in a pair of transversely aligned openings in the free ends of side plates 47 and 48 of the upper arm member. Shaft 50 also is provided with a longitudinally disposed stub shaft 55 provided with a threaded end 55a. Tool mounting unit 63 is adapted to be rotatably mounted on stub shaft 55 and includes a cylindrical section 63a, a beveled driven gear 63b rigidly mounted on an inner end of section 63a and rotatably mounted on stub shaft 55, and a circular mounting plate 63c rigidly mounted on the outer end of cylindrical section 63a. The mounting unit is retained on stub shaft 55 by means of a nut 63c threaded on threaded end portion 55a of stub shaft 55, drawn up against a bushing 63d mounted on stub shaft 55 and engaging an annular collar 63f which is rigidly secured to the inner end of cylindrical section 63a of the mounting unit, as best illustrated in FIG. 5.
Beveled drive gears 51 and 52 are rotatably mounted on support shaft 50 and are provided with integrally formed pinions 51a and 52a, respectively. As best shown in FIG. 6, beveled drive gears 51 and 52 drivingly mesh with beveled driven gear 63b and are maintained in spaced relation from side plates 47 and 48 by means of a pair of bushings 56 and 57 and a set of spacers interposed between pinions 51a and 52a and the adjoining sidewalls of the upper arm member. The support shaft is retained in position by means of a set of bolts 58 and 59 threaded on the ends of support shaft 50 projecting through the transversely aligned openings in the side plates of the upper arm member.
Hydraulic cylinder assemblies 53 and 54 are substantially identical in construction and operation. Hydraulic cylinder assembly 53 includes a cylinder portion 53a mounted on crosspiece member 49 and a rod portion 53b having a rack member 60 mounted on the end thereof which drivingly meshes with pinion 51a. Hydraulic cylinder assembly 54 includes a cylinder portion 54a mounted on crosspiece member 49 and a rod portion 54b having a rack member 61 mounted on the end thereof which drivingly meshes with pinion 52a. Rack member 60 also is supported on a bracket 47a mounted on side plate 47, provided with a wear pad 47b which supports the rack member and which may be adjusted vertically by an adjusting screw 47c. Similarly rack member 61 is supported by a bracket 48a provided with a wear pad 48b which may be adjusted with an adjusting screw 48c. It will be appreciated that by simultaneously extending rod portions 53b and 54b, beveled drive gears 51 and 52 will be caused to rotate in a counterclockwise direction relative to FIG. 5 to pivot mounting unit 63 upwardly about the transverse axis of support shaft 50. Similarly, by simultaneously retracting rod portions 53b and 54b, beveled drive gears 51 and 52 will be caused to rotate in a clockwise direction relative to FIG. 5 to pivot mounting unit 63 downwardly about the transverse axis of support 50. Furthermore, it also will be appreciated that by simultaneously extending one of rod portions 53b and 54b while retracting the other thereof, beveled drive gears 51 and 52 will be caused to rotate in opposite directions to rotate mounting unit 63 about the longitudinal axis of stub shaft 55.
Where rotary motors have been specified for use in rotating the tank unit and pivoting the arm members, it is contemplated that hydraulic cylinder assemblies or comparable actuators also can be used. Similarly, rotary motors and other comparable actuators can be used in lieu of hydraulic cylinder assemblies as herein described.
The hydraulic portion of the control system is illustrated in FIG. 8 and includes a pump 62 of the variable, pressure-compensated type driven by a motor 64, and an appropriate filter assembly 65. Pump 62 supplies fluid under pressure through a pressure line 65 to a set of two-stage, electro-hydraulic servo-valves 66 through 70. Fluid under reduced pressure also is supplied through pilot lines to the spool ends of valves 66 through 70. Fluid is returned from the control valves to reservoir 30 through a return line 72.
Valve 66 functions to control the operation of rotary motor 34 and is connected thereto by means of a pair of fluid lines 73 and 74. Valve 67 functions to control the operation of lower arm rotary motor 42 and is connected thereto through a pair of fluid lines 75 and 76. Valve 68 functions to control the operation of upper arm rotary motor 46 and is connected thereto by fluid lines 77 and 78. Valves 69 and 70 function to control the operation of cylinder assemblies 53 and 54 of the wrist assembly, and are connected thereto by sets of fluid lines 79 and 80 and 81 and 82, respectively.
FIG. 9 is a block-schematic diagram illustrating the connected and functional relationships between the various portions of the motive power, hydraulic control and electronic control systems for the described industrial robot.
As illustrated, the robot is caused to move about various of its axes through the operation of hydraulic valves 34, 42, 46, 53 and 54 as described hereinabove. These hydraulic valves form an actuator 102 as schematically illustrated in this figure. The hydraulic valves forming actuator 102 are in fluid communication via the illustrated sets of hydraulic lines with a series of hydraulic servo-valves constituted by valves 66 through 70, and it is these latter valves which operate to control the functions of the various actuating hydraulic valves forming actuator 102.
As pointed out hereinabove, the various servo-valves 66 through 70 are selectively operated by control or command signals issuing from control system 100. These signals are shown schematically in this figure as being supplied over a line 104. As discussed hereinabove, the potentiometers 86 through 90 supply voltage signals which are indicative of the current positions of the various axes of motion of the robot components. These potentiometers or position sensors supply their signals to control system 100 by lines 106 which are branched to supply these signals to control computer 108 through its input/output circuits and to a comparator 110, which in this case is an analog comparator. The signals PA on line 106 can be utilized in the supplied anglog form by comparator 110, but in the control computer it will be necessary through conventional means to convert these analog signals to digital signals for further processing. An operating data storage 112 receives data corresponding with the desired positions, or the positions it is desired the robot to take during a given operating sequence. Signals corresponding with this data PD are communicated via lines 111 and 115, respectively, to comparator 110 and control computer 108. Of course, conversion to analog form will be required prior to application of these signals to comparator 110. The data placed in storage 112 can be from any desired source, and for example, can be generated through a lead-through teaching operation as described hereinabove.
Control system 100 operates on the basis of the input operating data it receives and stores in storage 112. It operates to produce control signals which would ultimately in a predetermined operating sequence position the robot at the positions in space indicated by each set of data from each storage location. In order to accomplish this on a "coarse" basis the various position data from storage 112 are communicated to comparator 110 and there compared with the signal corresponding with the actual position of the robot mechanism. An error signal E2 corresponding with the compared result is produced and communicated through the input/output circuits of control computer 108 to line 104 to cause operation of the servo-valves to position the robot. However, this comparison alone will likely produce an error between the point at which the robot will actually aim and the point at which it is desired the robot as indicated by the particular data signal PD now being operated. In order to compensate for this error a correction factor is introduced in the foregoing comparison.
The correction factor is in the form of an error signal E1 produced by control computer 108 and communicated to an input of comparator 110. This signal has the effect of changing the reference value about which a comparison occurs and thereby compensates for the error it has noted. The signal E1 is produced by control computer 108 on the basis of the values of the current signals PD and PA now being operated on. It in effect performs a comparison on a longer time constant basis than the analog comparator and produces an error signal corresponding with the positioning errors occurring in the system. This error-noting comparison is performed continuously throughout the sequence of operations of the robot mechanism, and this first error signal E1 is continuously supplied to comparator 110 to provide the reference or error correction value about which the analog comparison of the signals PA and PD occur for operating actuator 102.
In effect the inputs from lines 106 and 111, comparator 110 and the output line 116 form a hardward servo-loop operating on an analog basis. The inputs from lines 106 and 115, control computer 108 and the output therefrom on line 118 form a software servo-loop operating on a digital basis for providing an error signal E1 correcting the operation of the analog servo-loop.
The control computer 108 operates on the basis of a program stored in a program storage (not shown) of conventional structure and arrangement to carry out in the usual manner a series of calculations necessary to utilize the operating data and the signals appearing on line 106 to carry out the operations described hereinabove. The central processor forming the control computer 108 may be structured in the form of a microprocessor known as Zilog model Z80. Data storage 112 can be formed from any practical storage medium for use with the aforementioned microprocessor.
It is to be understood that the description of a preferred embodiment given hereinabove is considered to be only exemplary and that modifications or changes in the described embodiment will occur to those skilled in the art. It is contemplated that such modifications or changes are within the spirit and scope of the invention as defined in the appended claims.
|Cited Patent||Filing date||Publication date||Applicant||Title|
|US3909600 *||May 31, 1973||Sep 30, 1975||Cincinnati Milacron Inc||Method and apparatus for controlling an automation along a predetermined path|
|US4021651 *||Jan 23, 1975||May 3, 1977||Kawasaki Jukogyo Kabushiki Kaisha||Programmed manipulator|
|US4025838 *||Dec 26, 1974||May 24, 1977||Kawasaki Heavy Industries, Ltd.||Signal modification device for memory controlled manipulator apparatus|
|US4178632 *||Mar 6, 1978||Dec 11, 1979||Cincinnati Milacron Inc.||Method for controlling the operation of a computer operated robot arm|
|US4283764 *||Oct 12, 1979||Aug 11, 1981||Nordson Corporation||Manually programmable robot with power-assisted motion during programming|
|Citing Patent||Filing date||Publication date||Applicant||Title|
|US4403281 *||Apr 3, 1981||Sep 6, 1983||Cincinnati Milacron Industries, Inc.||Apparatus for dynamically controlling the tool centerpoint of a robot arm off a predetermined path|
|US4432063 *||Oct 6, 1981||Feb 14, 1984||Cincinnati Milacron Inc.||Apparatus for automatically moving a robot arm along a nonprogrammed path|
|US4433382 *||Jul 20, 1981||Feb 21, 1984||Cincinnati Milacron Inc.||Apparatus for automatically adjusting the programmed location of a robot arm|
|US4448342 *||Nov 6, 1981||May 15, 1984||Kabushiki Kaisha Komatsu Seisakusho||Method and device for tracer correction in a welding robot|
|US4475160 *||Dec 28, 1981||Oct 2, 1984||Fanuc Ltd.||Method of sensing abnormal condition in robot control apparatus|
|US4481568 *||Oct 21, 1981||Nov 6, 1984||Fujitsu Fanuc Limited||Numerical control method and apparatus|
|US4482968 *||Dec 28, 1981||Nov 13, 1984||Fanuc Ltd.||Method and apparatus for robot control|
|US4494206 *||Jul 10, 1981||Jan 15, 1985||Fujitsu Fanuc Limited||Control device for indexing a stepping rotatable member|
|US4518308 *||Mar 1, 1982||May 21, 1985||Acrobe Technology Inc.||Manipulator apparatus|
|US4542471 *||Dec 28, 1981||Sep 17, 1985||Fanuc Ltd.||Robot control system for presetting limit values corresponding to limits of deviation|
|US4558424 *||Sep 23, 1982||Dec 10, 1985||Kabushiki Kaisha Sankyo Seiki Seisakusho||Robot control apparatus|
|US4564898 *||Jun 23, 1983||Jan 14, 1986||Omron Tateisi Electronics Co.||Programmable controller having a drum type sequencer function subject to programming|
|US4594670 *||Feb 21, 1984||Jun 10, 1986||Mitsubishi Denki Kabushiki Kaisha||Robot control apparatus|
|US4603897 *||May 20, 1983||Aug 5, 1986||Poconics International, Inc.||Vacuum pickup apparatus|
|US4642781 *||Jul 9, 1984||Feb 10, 1987||International Business Machines Corporation||System for automatically calibrating a robot|
|US4693663 *||Oct 5, 1984||Sep 15, 1987||Donaldson Company, Inc.||Robot with articulated arm|
|US4703668 *||Sep 25, 1985||Nov 3, 1987||Champion Spark Plug Company||Wrist mechanism for a robot arm|
|US4705243 *||Oct 4, 1984||Nov 10, 1987||Kuka Schweissanlangen||System of externally holding and guiding supply lines to moving implements of manipulators|
|US4725965 *||Jul 23, 1986||Feb 16, 1988||American Telephone And Telegraph Company||Method for calibrating a SCARA robot|
|US4739692 *||May 27, 1986||Apr 26, 1988||Fluidic Motion Corporation||Liquid contractility actuator|
|US4751868 *||Feb 12, 1986||Jun 21, 1988||Paynter Henry M||Method and system employing double-acting, fluid-driven twistor-pairs as combined joints and motors in arthrobots|
|US4753569 *||Aug 8, 1986||Jun 28, 1988||Diffracto, Ltd.||Robot calibration|
|US4766322 *||Mar 14, 1986||Aug 23, 1988||Kabushiki Kaisha Toshiba||Robot hand including optical approach sensing apparatus|
|US4775926 *||Sep 23, 1987||Oct 4, 1988||Toshiba Kikai Kabushiki Kaisha||Apparatus for correcting displacement of movable members of machine tools|
|US4776230 *||Jul 23, 1987||Oct 11, 1988||Susnjara Kenneth J||Actuator assembly for industrial robots|
|US4813125 *||Jun 8, 1987||Mar 21, 1989||Utica Enterprises, Inc.||Method and apparatus for establishing the position of a datum reference from an object having dimensional variations within a tolerance range|
|US4841795 *||Jan 27, 1987||Jun 27, 1989||Novar S.P.A.||Double-rotatable universal head for machine tools|
|US4914566 *||Aug 24, 1989||Apr 3, 1990||Steutermann Edward M||Shaft position detector and control device|
|US5198973 *||Apr 19, 1990||Mar 30, 1993||Steutermann Edward M||Select-a-range control device|
|US5535306 *||Feb 14, 1995||Jul 9, 1996||Applied Materials Inc.||Self-calibration system for robot mechanisms|
|US8000837||Aug 16, 2011||J&L Group International, Llc||Programmable load forming system, components thereof, and methods of use|
|US8567185 *||Feb 16, 2010||Oct 29, 2013||Vecna Technologies, Inc.||High efficiency actuator method, system and apparatus|
|US9422947 *||Sep 25, 2013||Aug 23, 2016||Vecna Technologies, Inc.||High efficiency actuator method, system and apparatus|
|US20080236324 *||Feb 19, 2008||Oct 2, 2008||Fanuc Ltd||Robot having working tool|
|CN102848384A *||Oct 8, 2012||Jan 2, 2013||常州汉迪机器人科技有限公司||Flexible actuator of robot system and robot system|
|DE3434899A1 *||Sep 22, 1984||May 23, 1985||Kuka Schweissanlagen & Roboter||Vorrichtung zum aussenseitigen halten und fuehren von versorgungsleitungen zu bewegten werkzeugen von manipulatoren|
|DE8703229U1 *||Mar 3, 1987||Dec 23, 1987||Kempf Widerstandsschweisstechnik Gmbh, 6072 Dreieich, De||Title not available|
|EP0114505A1 *||Dec 21, 1983||Aug 1, 1984||Diffracto Ltd.||Apparatus and method for robot calibration|
|EP0144602A1||Oct 4, 1984||Jun 19, 1985||KUKA Schweissanlagen & Roboter GmbH||Exterior retaining and guiding device for the supply conduits of actuated tools of manipulators|
|EP0196685A1 *||Feb 11, 1986||Oct 8, 1986||DANIELI & C. OFFICINE MECCANICHE S.p.A.||Packager|
|EP0222915A1 *||Apr 25, 1986||May 27, 1987||Fanuc Ltd.||Industrial robot|
|EP0321890A2 *||Dec 17, 1988||Jun 28, 1989||Barmag Ag||Manipulating device|
|WO1985001686A1 *||Oct 4, 1984||Apr 25, 1985||Kuka Schweissanlagen + Roboter Gmbh||Fixing device for supply lines in manipulators|
|WO1988005712A1 *||Jan 19, 1988||Aug 11, 1988||Logabex S.A.R.L.||Redundant robot|
|U.S. Classification||700/254, 901/26, 700/193, 901/9, 700/78, 901/22, 414/730, 901/29, 901/15|
|International Classification||B25J9/04, G05B19/35, B25J9/16|
|Cooperative Classification||G05B2219/45083, G05B19/351, G05B2219/39191, B25J9/046, G05B2219/37462, G05B2219/41301, G05B2219/34215, G05B2219/41209, B25J9/1692|
|European Classification||B25J9/16T5, B25J9/04D, G05B19/35C|