CA2312897A1

CA2312897A1 - System and method for calibrating a hexapod positioning device

Info

Publication number: CA2312897A1
Application number: CA002312897A
Authority: CA
Inventors: Richard J. Loerch
Original assignee: Individual
Current assignee: Giddings and Lewis LLC
Priority date: 1997-12-01
Filing date: 1998-12-01
Publication date: 1999-06-10
Also published as: TW396096B; EP1034066A1; WO1999028097A1

Abstract

A system and method for calibrating a positioning device, such as a hexapod machining center, are disclosed. The system comprises a gage nest, having a plurality of sensors and being connected to the positioning device; an artifact, disposed in a work area defined by the positioning device; a first computer, connected to said positioning device, for controlling and recording precision movements of the positioning device with respect to the artifact; and a second computer for using the recorded precision movement as input data in order to simulate the operation of the positioning device, thereby iteratively determining the actual geometry of the positioning device.

Description

SYSTEM AND METHOD
FOR CALIBRATING
A HEXAPOD POSITIONING DEVICE
Background of the Invention 1. Field of the Invention This invention generally relates to machines, such as machine tools, robots, linkages, coordinate measuring machines, and positioners.
In particular, this invention relates to the calibration of a positioning device by manipulating machine inputs to produce precision machine outputs. Such machines include a hexapod machining center in which a tool can be moved in three linear directions and three rotational directions.

2. Description of the Prior Art U.S. Patent Numbers 5,538,373, issued on July 23, 1996, to Kirkham, and 5,556,242, issued on September 17, 1996, to Sheldon et al., both assigned to Giddings & Lewis, Inc., are incorporated herein by reference. These patents disclose a hexapod machine tool comprising a base platform connected to a tool platform by a plurality of legs or actuators. The base platform is configured to hold a workpiece, while the tool platform is configured to hold and drive a tool. By manipulating the lengths of the actuators, the tool can be positioned along various linear and rotational axes with respect to the workpiece. This six-axis positioning provides the operator with precision tooling capabilities which are superior to those of conventional machine tools.
The accuracy of any machine tool depends on how accurately the dimensions of the machine are determined during calibration and setup. In the case of a hexapod machine tool, the exact location of each of twelve pivot points, which connect the actuators to the base and tool platforms, must be accurately determined in order to precisely define the length of each actuator. It is the exact length of each actuator and the exact location of the pivots that defines the exact location of the tool with respect to the workpiece, and hence, the overall accuracy of the machine.
One standard method for determining precise dimensions of a machine is to measure each of its constituent parts. For example, in a conventional milling machine, the guide rails associated with the machine movements must be precisely measured, tooled or scraped, monitored, and maintained within given tolerance limits. In order to reduce tolerance buildups (i.e., each error associated with each constituent part contributing to a larger overall error), the tolerance values for each part must be minimized. In the above example, errors in the guide rail linearity directly affect the overall accuracy of the machine. To increase the machine's accuracy, the guide rails would have to be more accurately constructed and maintained. This leads to a much higher manufacturing cost and/or structural complexity, as each constituent part must be manufactured and maintained to much more exacting standards than would otherwise be required had tolerance buildups not occurred.
Moreover, the process for determining how each constituent part error contributes to the overall machine error is extraordinarily difficult for a hexapod machining center. In J.A. Soons, "ERROR ANALYSIS OF A
HEXAPOD MACHINE TOOL," Lambda Man '97. Third International Conference and Exhibition on Laser Metrology and Machine Performance, July 15-17, 1997, the author presents an analysis of the possible measurement errors associated with a hexapod milling machine at the National Institute of Standards and Technology, and the difficulties in the determination of such errors.
A need, therefore, exists to provide an improved technique to readily calibrate a positioning device or other machine having multiple degrees of freedom, and in particular, a hexapod machining center.
Objects and Summary of the Invention Accordingly, it is a primary object of the present invention to provide an improved system and method for calibrating a positioning device having multiple degrees of freedom.
It is another object of the present invention to provide a method and apparatus for determining precise linkage dimensions of a machine without requiring finely tooled constituent parts.
It is a further object of the present invention to provide a method and apparatus for accurately determining machine dimensions by manipulating machine inputs such that the machine performs output movements in relation to a calibration artifact.
It is still another object of the present invention to provide a method and apparatus for calibrating a hexapod machining center without requiring initial precise measurement of the hexapod machine dimensions.
It is yet another object of the invention to provide a method and apparatus for precisely determining machine geometry with a minimal amount of equipment, and to readily provide for continued re determination as needed in a particular machine.
In accomplishing these and other objects, the present invention provides a method of calibrating a positioning device using precision movements defined by the precision nature of an artifact, the positioning device having a moving platform mounted to a base by a plurality of actuators, the plurality of actuators having a plurality of pivot locations.
The method comprises the steps of: (a) obtaining change-in-actuator length data for the plurality of actuators taken in response to precision movements of the positioning device; and (b) performing a simulation analysis using the change-in-actuator length data to iteratively determine the plurality of pivot locations within a predetermined tolerance limit.
The present invention also provides a method of calibrating a hexapod machining center having a base and a platform, each having a plurality of pivots, said hexapod machining center also having a plurality of extendable legs, each leg connected between one of the plurality of pivots of the platform and one of the plurality of pivots of the base. The method comprises the steps of: (a) defining an estimate of the plurality of pivot locations in the base; (b) defining an estimate of the plurality of pivot locations in the moving platform when the platform is at a reference position; (c) calculating, from the estimates described in steps (a) and (b), actuator lengths when the platform is at the reference position; (d) placing a precision ball in proximity to the platform; (e) mounting sensors to the platform, designed to indicate a distance between a unique point on the platform and a center of the precision ball; (f) obtaining platform command data required to move the platform to a position such that the sensors begin to measure the distance described in step (e); (g) moving the platform according to the platform command data; (h) obtaining the distance described in step (e) from the sensors; (i) obtaining platform command data determined to move the platform to another position that reduces the distance described in stp (e); (j) moving the platform according to the platform command data; (k) repeating steps (h)-(j) until the distance described in step (e) falls within a predetermined range; (1) outputting, as change-in-actuator length data, a change in the actuator lengths from when the platform is at the reference position described in step (c), to when the platform satisfies the condition of step (k); (m) when the platform is not in a last position on the precision ball, obtaining platform command data required to move the platform to a different position, such that the sensors begin to measure the distance described in step (e); (n) repeating steps (g)-(m) until the platform is in the last position on the precision ball; (o) when the platform is not on a last precision ball, placing a precision ball in a new location in proximity to the platform; (p) repeating steps (f)-(o) until the platform is on the last precision ball; (q) determining a sufficiently accurate estimate of actual locations of the plurality of pivots. These plurality of pivots are determined by: (q1) estimating the positions of the precision balls; (q2) simulating movement of the platform using platform command data from step (I), yielding simulated platform positions for which the sensors were centered on the precision balls; (q3) computing the errors between the simulated platform positions and the estimated positions of the precision balls; (q4) adjusting the estimated positions of the precision balls and the actuator pivot locations to reduce the errors described at step (q3); (q5) repeating steps (q2)-(q4) until the errors described at step (q3) fall within a predetermined range; (q6) outputting final pivot locations resulting from step (q5), wherein the final pivot locations represent a sufficiently accurate estimate of actual pivot locations.
The present invention also provides a system for calibrating a positioning device, the system comprising: a gage nest, having a plurality of sensors and being connected to said positioning device; an artifact, captured in a work area defined by said positioning device; a first computer, connected to said positioning device, for controlling and recording precision movements of the positioning device with respect to the artifact; and a second computer for using the recorded .precision movement as input data in order to simulate the positioning device, thereby iteratively determining the actual geometry of the positioning device.
The present invention also provides a method of calibrating a positioning device further comprising the steps of: (a1) estimating the geometry of the positioning device at a reference position; (a2) placing an artifact in proximity to the platform; (a3) mounting sensors to the platform designed to indicate deviations between motion of the platform and the precision nature of the artifact; (a4) obtaining platform command data required to move the platform to a position such that the sensors begin to measure the precision nature of the artifact; (a5) moving the platform in accordance with the platform command data; (a6) obtaining the deviations described in step (a3) from the sensors; (a7) obtaining platform command data determined to move the platform to another position that reduces the deviations; (a8) moving the platform in accordance with the platform command data; (a9) repeating steps (a6)-(a8) until sensor deviations fall within a predetermined range; (a 10) outputting, as change-in-actuator length data, a change from the geometry of the positioning device of step (a 1 ), to the geometry of the positioning device satisfying step (a9); (a 11 ) when the platform is not in a last position in relation to the artifact, obtaining platform command data required to move the platform to a different position such that the sensors begin to measure the precision nature of the artifact; (a12) repeating steps (a6)-(a11 ) until the platform is in a last position; (a13) when the artifact is not in a last proximity to the platform, placing the artifact in proximity to the platform such that the precision nature of the artifact defines a motion of the platform different from that previously measured in steps (a2)-(a12); (a14) repeating steps (a3)-(a13) until the artifact is in a last proximity to the platform.
The present invention also provides a method of calibrating a positioning device, wherein the positioning device further comprises a work pallet mounted to the base and a spindle cartridge mounted to the platform, and further comprising the steps of: (a1) mounting a ball plate, supporting a plurality of precision balls, to the work pallet; (a2) mounting a gage nest, supporting a plurality of sensors, to the spindle cartridge, wherein the plurality of sensors are designed to detect the coincidence of a unique point on the gage nest and the center of a precision ball, the condition of coincidence being referred to as centered; (a3) moving the platform so that the gage nest is centered on one of the plurality of precision balls; (a4) recording first actuator length change commands required to accomplish step (a3) as change-in-actuator length data, wherein the change-in-actuator length data are recorded with respect to a platform reference position; (a5) rotating the platform to another position on the ball, keeping the gage nest centered on the ball; (a6) recording second actuator length change commands required to accomplish step (a5) as change-in-actuator length data, wherein the change-in-actuator length data are recorded with respect to the platform reference position;
(a7) repeating steps (a51-(a6) a statistically significant number of times;
and (a8) repeating steps (a3)-(a6) for another one of the plurality of precision balls.

The present invention also provides a method of calibrating a positioning device according to claim 1, wherein the simulation analysis further comprises the steps of: (b1) defining a second estimate of the plurality of pivot locations at a reference position of the platform; (b2) defining a first estimate of the artifact location; (b3) simulating tracing of the artifact by moving the platform using the change-in-actuator-length data; (b4) determining errors between the simulated movement of the platform in step (b3) and the precision nature of the artifact; (b5) updating the second estimate of the artifact location and the first estimate of the plurality of pivot locations based on the errors; and (b6) repeating steps (b31-(b5) a statistically sufficient number of times in order to minimize the errors within a predetermined range, thereby causing the second estimate of the plurality of pivot locations to converge toward actual pivot locations within an acceptable error, thereby calibrating the positioning device.
Brief Description of the Drawings The accompanying drawings, which are incorporated in and constitute a part of the specification, illustrate presently preferred embodiments of the invention, and, together with the general description given above and the detailed description of the preferred embodiments given below, serve to explain the principles of the invention. In each of the FIGURES, like-referenced numerals indicate like parts, in which:
FIGURE 1 is a perspective view of the hexapod machining center calibration system in accordance with a preferred embodiment of the present invention;
FIGURE 2 is a side view of the hexapod machining center of FIGURE 1;
FIGURES 3A & 3B represent a schematic diagram of an instrument arm and a cross-section of an extensible actuator leg incorporating an instrument arm, respectively, used for measuring the length of the actuators of the hexapod machining center of FIGURE 2;
_7_ FIGURE 4 is a general block diagram of a control system for the calibration system of FIGURE 1 in accordance with the present invention;
FIGURE 5 is an enlarged, side perspective view of a gauge nest and a ball plate attached to the hexapod machining center of FIGURE 2 for calibration;
FIGURE 8 is a bottom perspective view of the gauge nest attached to the spindle cartridge of the hexapod machining center of FIGURE 2;
FIGURE 7 is a top perspective view of the ball plate attached to the work pallet of the hexapod machining center of FIGURE 2;
FIGURE 8 is a flowchart of the steps taken to perform a ball run calibration procedure for the calibration system of FIGURE 1;
FIGURE 9 is a flowchart of the steps required to control the servo system during the ball run calibration procedure of FIGURE 8;
FIGURE 10 is a flowchart of the steps taken to perform a simulation analysis for the calibration system of FIGURE 1;
FIGURE 11 is a flowchart of the steps taken to simulate the upper platform movement step of the simulation analysis of FIGURE 10;
FIGURE 12 is a detailed block diagram of a portion of the control system of FIGURE 4;
FIGURE 13 is a general flowchart of the steps taken to perform the reaction feedforward calculation of the reaction feedforward calculator of FIGURE 12;
FIGURE 14 is a detailed flowchart of the steps taken to perform the calculation of actuator forces of the reaction feedforward calculation of FIGURE 13;
FIGURE 15 is a signal flow diagram showing the operation of the kinematics calculator of FIGURE 12;
FIGURE 16 represents a flowchart of the steps taken to collect compliance information for the machine sensitivity model of FIGURE 15;
and _g_ FIGURE 17 is a signal flow diagram showing the operation of the servo feedback system of FIGURE 12.
Detailed Description of the Preferred Embodiments Referring to FIGURE 1, a hexapod machining center calibration system 100 is shown in accordance with the present invention. The calibration system 100 comprises a hexapod machining center 110 connected to a series of equipment enclosures 120 by way of a power and control cable loop 125. The series of enclosures 120 preferably comprises a microcomputer bay 130, a servo power control system 140, and a tool power control system 150. The microcomputer bay 130 and the servo power control system 140 will be described in further detail with reference to FIGURE 4. The tool power control system 150 operates the motor used to rotate the spindle of the machining center, and this system is available from Giddings & Lewis, Inc. of Fond du Lac, Wisconsin. The gas springs 160 affixed to the feet 170 of the hexapod machining center 110 comprise one embodiment of a vibration isolation system, which will be explained in more detail below. Note, however, that the techniques of the present invention may be used on various other types of positioning devices other than hexapod machining centers.
In FIGURE 2, a preferred embodiment of the hexapod machining center 110 is shown. The hexapod machining center 110 includes a base or lower platform 200 connected to an upper or tool platform 205 by an actuator mechanism 210. Actuator mechanism 210 preferably includes a plurality of extendable linkages or actuators 215 attached to the lower platform 200 at a plurality of lower pivot locations 215a and to the upper platform 205 at a plurality of upper pivot locations 215b. Each actuator 215 may be constructed, for example, using a ball screw mechanism.
Although the preferred embodiment includes a ball screw mechanism, the invention is not limited to this type of actuator. Actuators 215 could include pneumatic cylinders, hydraulic cylinders, or rack-and-pinion devices.
_g_ Upper platform 205 includes a spindle cartridge 220 configured to hold a tool 225. The lower platform 200 includes a work pallet 240 configured to hold a workpiece 230. Tool 225 interacts with workpiece 230 when the actuator mechanism 210 causes the upper platform 205 to move along a pre-programmed path relative to the lower platform 200.
The hexapod machining center 110 may optionally include a plurality of counterbalances 235 to counteract gravitational effects. Counterbalances 235 are preferably nitrogen gas-filled springs connected between the base or lower platform 200 and the upper or movable platform 205 at pivot locations 250.
The hexapod machining center 110 could also include different types of vibration isolation components. For example, as illustrated in FIGURE 1, the hexapod machining center 110 is isolated from the floor by two gas springs 160, one positioned on each side of each of the three feet 170 of the base of the machine. Alternatively, as illustrated in FIGURE 2, three resilient pads 245, extending from each of the three legs of the lower platform 200 to the floor, serve the same function, i.e., to isolate the upper platform 205 and lower platform 200 from the rigid attachment of an external support structure. Vibration isolation components could comprise springs without dampers, combinations of separate springs and dampers, resilient pads, etc.
A further detailed description and alternate embodiments of hexapod machining center 110 can be obtained from the above-mentioned U.S. Patent Nos. 5,538,373 and 5,556,242, which have been incorporated by reference. Note that in the machining center 110 of FIGURE 2, which is similar in orientation to a vertical machining center, the lower platform 200 is oriented below the upper platform 205. If there were no vibration isolation system, the lower platform would rest on the floor, and thus, serve as a stationary base for the machine. In this case, it makes essentially no difference whether it is called a "base" or a "lower platform" with respect to an "upper platform" or simply the "movable .
platform". However, in the different embodiments shown above as well WO 99/28097 PCTlUS98/25450 as in U.S. Patent No. 5,538,373, and in various other models of commercially available hexapod machining centers, the lower platform is separate and isolated from the floor such that it is decoupled by a vibration isolation system. With the vibration isolation system, the lower platform may not serve as a stationary base for the machine, and it may make a difference whether the lower platform is referred to as a "base".
Moreover, in a horizontal machining center orientation, the lower platform 200 is not even located below the upper platform 205, but would be supporting it in the same horizontal plane. Hence, it should be kept in mind that the "base platform" or "lower platform" terminology used herein not only refers to the specific type of machining center shown in FIGURE 2, but also to many other types of positioning devices and machining center configurations.
In hexapod machining center 110, the position and orientation of the machine at any instant is monitored by a plurality of measuring transducers, e.g., one transducer is associated with each of the actuators 215. U.S. Patent No. 5,538,373 discloses the use of six instrument arms, separate from the actuators 215, wherein each instrument arm contains a length-measuring transducer. One possible type of length-measuring transducer is a laser interferometer such as shown in FIGURES 3A and 3B. As will be explained in detail below, the measuring transducer can be configured as separate instrument arms attached to its own pivots located on the upper and lower platforms, or can be constructed inside each of the actuators as will be described below.
In FIGURE 3A, an instrument arm 300 is formed of concentric outer and inner tubes 310 and 315, respectively, that telescope on bearings 325. A laser beam from a laser light source 330 enters the sealed hollow interior of the instrument arm through a window 335, and is then reflected off a mirror 340 into an interferometer device 345 where it is divided into two beam components. One beam component travels inside the entire length of the concentric tubes to a retro-reflector 350 which is mounted at the closed end of the outer tube 310. Light is _1 1 _ reflected back down the tubes towards the interferometer device 345.
The two beam components are then recombined within the interferometer device 345, and the combined beam components interfere with each other, constructively or destructively, depending on their phase. A
photodetector within the laser light source 330 detects the fringes that result from the interference between the two components of the light beam as the retro-reflector 350 moves relative to the interferometer device 345. The phase is dependent upon the distance between the interferometer device 345 and the retro-reflector 350, and the fringes are therefore indicative of changes in the length of the instrument arm 300.
Again, a further description of the instrument arm can be obtained from the above-mentioned U.S. Patent No. 5,538,373.
Although FIGURE 3A illustrates a representative instrument arm 300 which is separate from the actuators 215, FIGURE 3B illustrates a cross-section of a measurement transducer 360 comprised of an extendable actuator leg 215 incorporating a laser interferometer instrument system inside it. In this view, it can be seen that the actuator leg 215 includes a rotatable ball screw rod 365 having a hollow interior and connected to a motor 370 by a drive mechanism 375, such as a belt and pulley arrangement. The ball screw rod 365 is rotatably mounted to the yoke of a first of two universal joint assemblies 380, 382. A nut tube 385 surrounds and is operatively connected to the ball screw rod 365 by a plurality of recirculating balls 388. The nut tube 385 is mounted to the yoke of the second universal joint assembly 382. Therefore, the centers of the universal joints 380, 382 define the pivot locations 215a and 27 5b of the actuator 215. Thus, as ball screw rod 365 is rotated within nut tube 385, the universal joint assemblies 380, 382 are driven farther apart or closer together depending on the direction of rotation of the ball screw rod. A tubular housing 390 is attached to the yoke of the second universal joint assembly 382 and surrounds the ball screw rod 365 as shown.

WO 99128097 PCf/US98/25450 In the preferred embodiment of FIGURE 3B, laser light source 330 is mounted to the tubular housing 390, the interferometer device 345 is mounted within the distal end of tubular housing 390 separate from ball screw rod 365, and the retro-reflector 350 is mounted at the other end of the ball screw. This combined interferometer-actuator configuration is fully described in German Patent Publication DE 19617880 by Giddings &
Lewis, Inc. based on U.S. Patent Application No. 08/430,390, which is also incorporated herein by reference.
Thus, the laser interferometer measurement transducer 360 is able to precisely measure the distance between the points at which interferometer device 345 and the retro-reflector 350 are disposed on the ball screw-driven actuator 215. This distance can be mathematically translated to determine the locations of pivots 215a and 215b. Since this combined interferometer-actuator is the preferred embodiment, the remaining description of the invention will use the pivot locations with reference to the pivots of the actuator 215 as opposed to the pivots of a separate instrument arm. However, the invention will work with either measurement configuration, since, as will be explained in detail below, it is the calibration ball run of the actual positioning device that determines the estimated pivot locations of the instrument arms, irrespective of whether the instrument arms are coincident with the actuators 215.
Referring now to FIGURE 4, a general block diagram of the microcomputer bay 130 and servo power and control system 140 for the calibration system of FIGURE 1 is shown. The control system 400 comprises a microcomputer 410, which includes input and output circuits 412, at least one central processing unit 414, a random-access memory 416, and a read-only memory.418. Microcomputer 410 further includes an external memory 420 for storing, for example, the control software for the calibration system 400 and data relating to the calibration and control of the hexapod machining center 110. An operator interface 425 is connected to the microcomputer 410. The operator interface 425 can include, for example, a display, a keyboard, a printer or other output devices, and/or an input pointing device.
The microcomputer 410 is coupled to a processor 430. The processor 430 provides mathematical transformations from Cartesian coordinate system-based instructions to actuator lengths. The processor 430 is connected to a pair of digital signal processors (DSPs) 440, each of which is connected to a plurality of servo control stages 443 for each actuator 215. Each control stage 443 comprises a servo amplifier 445, a motor 450, an encoder 455, an actuator drive 460 (e.g., the ball screw mechanisms of actuators 215 of FIGURE 2), and a measuring transducer 465 (e.g., such as laser interferometer measuring transducer 360 of FIGURE 3B).
The servo amplifier 445 provides the correct power to the motor 450, which includes an encoder 455. The encoder 455 feeds back a signal indicative of the motor speed in order to provide a closed velocity loop in the actuator control system. The feedback signal from the encoder 455 is coupled to the appropriate digital signal processor 440.
When the servo amplifier 445 receives a signal to activate the motor 450, the motor moves the actuator drive 460 and either extends or retracts the actuator 215, thus providing some movement to upper platform 205.
The measuring transducer 465, operating as described above, feeds back the precise change in the length of the actuator 215 to the digital signal processor 440, which then relays that information through processor 430 to microcomputer 410.
In a preferred embodiment, microcomputer 410 is a CNC 8000 controller available from Giddings & Lewis, Inc. of Fond du Lac, Wisconsin; processor 430 is the commonly available Intel PENTIUM
(trademark of Intel corporation) microprocessor; digital signal processors 440 are Type 2181 DSPs available from Analog Devices, Inc. of Norwood, Massachusetts; the servo amplifiers 445 are Model BDS4 Amplifiers available from Kollmorgen Industrial Drives of Radford, Virginia;
motors 450 are Kollmorgen Model 8604 brushless DC motors; and WO 99/28097 PC'T/US98/25450 actuator drives 460 and the laser measuring transducers 465 are of the type previously described in connection with FIGURES 3B. Further explanation of the software executed on the above-described hardware is given below with respect to FIGURES 12-17.
In the normal operation of the hexapod machining center 110, the servo system includes DSPs 440 and the servo control stages 443 which provide a closed feedback loop used to position the machine.
However, during a calibration run (such as a "ball run" described below), information from a calibration device 470 (such as a gauge nest described below) is included in a larger feedback loop including digital signal processors 440. Hence, in the calibration mode, the servo system further includes processor 430 and the calibration device 470.
Although the above devices and computers comprise the preferred embodiment of the invention, many alternatives known to those 7 5 skilled in the art can be used. For example, processor 430 could be eliminated if its function was incorporated into a more powerful microcomputer 410. In fact, the Giddings & Lewis CNC 8000 controller actually includes an IBM-compatible personal computer in order to perform many of its functions, particularly with respect to the user interface. Although the tasks performed by each computer or processor shown in FIGURE 4 will be described below with respect to a particular hardware deice, the techniques of the present invention should not be interpreted to be restricted to any such device.
FIGURE 5 provides an enlarged, side perspective view of a gauge nest 505 and a ball plate 510 attached to the hexapod machining center 110 during calibration. Gauge nest 505 is attached to spindle cartridge 220 on the upper platform 205, and ball plate 510 is attached to work pallet 240 on the lower platform 200. By controlling the movement of the upper platform 205, the calibration system moves the gauge nest 505 in relation to the ball plate 5"10 in order to record precision actuator information used to calibrate the machine. This calibration procedure will now be explained in detail.

Referring to FIGURE 6, a bottom perspective view of the gauge nest 505 associated with the preferred embodiment of the calibration system is shown. The gauge nest 505 includes a plurality of sensors 605 disposed around a single point as shown. The sensors 605 are arranged in such a manner so as to detect a displacement of the upper platform 205 with respect to a bail on the ball plate 510.
In FIGURE 7, a top perspective view of the ball plate 510 is shown. In the preferred embodiment, the ball plate 510 comprises six precision ba(Is 705 arranged around a center precision ball and disposed on the corners of a hexagon-shaped base 710. Although the combination of FIGURES 6 and 7 show the sensors 605 configured to measure seven precision balls 705 arranged in a hexagon pattern, the invention is not limited to such ball plate and sensor configuration. Rather, the ball plate 510 serves as an example of any type of artifact to be measured, e.g., a ball plate in any configuration, a cylinder, a surface plate, a step gauge, a moveable tooling ball, a laser interferometer light beam, etc.
In the preferred embodiment, sensors 605 are conventional Linear Variable Differential Transformers (LVDTs). Each LVDT produces an electrical output signal proportional to the displacement of its moveable care. Each sensor 605 has an end portion 610 which comes in mechanical contact with precision balls 705 during the calibration process. End portion 610 is mechanically connected to the LVDT
movable core, which is made of a magnetic material. The moveable core is positioned inside of a primary and two secondary coils such that the primary coil is located between the two secondary coils. Thus, the LVDTs translate physical inputs, e.g., movements of the end portion 610, into an output voltage corresponding to a displacement from a zero position. A further description of the LVDTs can be found in the Handbook of Measurement and Control HB-84, published by Schaevitz Engineering of Pennsauken, N.J., October 1983 (Library of Congress Card Catalog Number 76-24971 ).

WO 99!28097 PGT/US98/Z5450 The sensors 605, mounted to the spindle cartridge 220, serve to monitor or measure each artifact by determining deviations between (a) the precision nature of the artifact, e.g., surface characteristics, and (b) the movement or position of the upper platform 205. Different types of sensors 605 would be used with different types of artifacts. For example, LVDTs can be used to measure the aforementioned cylinder, surface plate, and tooling ball, whereas a laser interferometer can be used to monitor linear movements of the upper platform over distances equal to integral numbers of light wavelengths. Also, the type of artifact may determine the type of precision movement. Examples of precision movements include: moving a precise distance along a line, moving parallel to a line, moving parallel to a plane, rotating about a line, and rotating about a point.
Turning now to the flowcharts, FIGURES 8-11 illustrate how the calibration system is used to find the precise dimensions of the hexapod machining center 110 by computer simulation. Briefly described, this calibration technique is accomplished in the present invention using a two-stage process: (1) performing a "ball run" on the machine, i.e., requiring the hexapod machining center 110 to make precision movements such that the gauge nest 505 is moved around the precision ball 705 by control of the actuator mechanism 210 in order to acquire exact measurement data on a particular positioning device; and (2) performing a "simulation analysis" on a computer, i.e., using the measurement data from the ball run in order to iteratively determine the precise dimensions of the positioning device to within specified tolerance limits. In the preferred embodiment of a hexapod machining center, the precise dimensions utilized are the location of the plurality of pivot locations 215a and 215b far the actuators.
FIGURE 8 provides a detailed explanation of the first part of the calibration process in the form of a flowchart illustrating the steps taken to perform a ball run calibration procedure. As mentioned above, measurement data must first be collected from a series of precision _17_ machine movements, called a "ball run", in order to determine the precise geometry, or linkage dimensions, of the hexapod machining center 110.
In the preferred embodiment, a parameter called the "change-in-actuator-length" is collected as the measurement data, as will be discussed below.
Beginning with Step 800, rough estimates of the pivot locations for the plurality of actuators 215 are determined in Step 805 according to previous knowledge of the manufactured dimensions of the machine. In the preferred embodiment, where the machine is a hexapod machining center, there are two pivot locations 215a and 215b for each of six actuators 215, for a total of twelve pivot locations. These manufactured dimensions are preferably accurate to within ~ % inch of the actual values which will finally be determined.
These estimated pivot locations are defined by Cartesian coordinates measured from an absolute or "fixed" coordinate system associated with the lower platform 200. An example of estimated pivot locations for one actuator 215 would be [-17.7, -38.2, -23.6) for the lower pivot location 215a and [-40.9, 10.23, 23.6) for the upper pivot location 215b. The units for this example are inches, but any other unit could be used. Note that since the absolute coordinate system is fixed to the lower platform, it would not matter whether the lower pivots actually move with respect to the floor.
There are six points defining the pivots fastened to the base or lower platform 200, and six points defining pivots fastened to the upper or movable platform 205. Since the upper platform moves, a numerical specification must be assigned to each platform position. Since the upper platform has six degrees of mechanical freedom, six unique coordinates are assigned to define a position: three translational coordinates and three rotational coordinates. For every position of the upper platform, there is a set of six coordinates [X, Y, Z, A, B, C) (where X, Y, and Z are the linear coordinates and where A, B, and C are the rotational coordinates) that define that platform position. Since the six upper actuator pivot locations are coincident with the six upper platform pivot locations, they are sometimes referred to below as "platform pivots".
Each displacement of the upper platform is defined with respect to a reference position having coordinates [0, 0, 0, 0, 0, 0]. At the reference position, the upper platform pivots are coincident with the aforementioned six points defining the upper platform pivots, measured from the absolute coordinate system fixed to the lower platform 200. For example, a displacement from the reference position [0, 0, 0, 0, 0, 0] to an arbitrary position [ 1, 3, 5, 2, 4, 6) would be accomplished as follows:
A. define a "moving coordinate system" associated with and attached to the upper platform, such that the moving coordinate system is coincident with the fixed absolute coordinate system of the lower platform only when the upper platform is situated at the reference position;
B. from the reference position, rotate the upper platform by six units about the Z axis of the moving coordinate system;
C, from the reference position, rotate the upper platform by four units about the Y axis of the moving coordinate system;
D, from the reference position, rotate the upper platform by two units about the X axis of the moving coordinate system;
E. translate the upper platform five units in the Z direction;
F. translate the upper platform three units in the Y
direction; and G. translate the upper platform one unit in the X direction.
Note that the order of the above rotations and translations should not be changed in the preferred embodiment.
Hence, the application of such a displacement to the upper platform results in displaced positions of the upper platform pivots. Recall WO 99/28097 ' PCTNS98125450 that the coordinates [X, Y, Z, A, B, C] define the upper platform position, that the pivot locations are defined at the reference position [0, 0, 0, 0, 0, 01, and that the position coordinates [X, Y, Z, A, B, C] are equal to [0, 0, 0, 0, 0, 0] only at the reference position. Note that it is important to be able to re-create this reference position whenever the machine has been turned off.
Since the actuators 215 are connected between the pivot locations 215a and 215b, estimates of the length of each actuator can be determined through use of the Pythagorean theorem. In Step 810, these estimates of the actuator lengths are calculated for the reference position of the upper platform, and are called "actuator lengths at the reference position".
From the nominal dimensions of the machine, a rough estimate of the center of sensors 605 in the moving coordinate system is available.
An example of such a sensor position estimate would be [0, 0, 0] in the moving coordinate system of the upper platform 205. Furthermore, a rough estimate of ball locations is also available in absolute coordinates.
An example of such a ball location is [5, 0, 0] in the absolute coordinate system of the lower platform 200.
In Step 820, microcomputer 410 calculates and outputs platform command data required to move the upper platform 205 to a "new"
position such that the gauge nest sensors 605 are in mechanical contact with one of the precision balls 705. In Step 825, the processor 430 uses the actuator feedback data to control the servo system such that the actuators move the upper platform 205 to the new position corresponding to the platform command data. As mentioned above, the servo system comprises that portion of the control system which is used to position the machine. The steps required to control the servo system will be further explained in connection with FIGURE 9. In Step 830, the output from the control of the servo system is recorded in a data file. This output represents the output of the ball run calibration procedure and is called "change-in-actuator-length data."

In the preferred embodiment, the upper platform 205 is instructed to make fifty precision rotation movements around the center of each of the seven precision bails 705, for a total of three hundred fifty precision movements per ball run. It should be noted, however, that the number of movements is dependent upon the type of machine, its particular application, the desired precision, the type of artifact, and the type of movement. Although three hundred fifty precision movements were chosen in the preferred embodiment, a statistically sufficient number of movements is all that is required.
After the servo system controller outputs and records the change-in-actuator-length data in Step 830, the microcomputer 410 determines in Step 835 whether the current position of the upper platform 205 represents the last of the preferred fifty positions associated with the current precision ball 705. If not, in Step 840, microcomputer 410 sends next position platform command data, required to move the upper platform 205 to a new position on the same ball 705. The new platform position has an angular orientation that is different from those of other platform positions centered on the same ball. Then, in Step 825, the above-described data-gathering process is repeated.
If the microcomputer 410 determines that the current position of the upper platform 205 represents the fast position associated with the current precision ball 705, the microcomputer 410 then determines in Step 845 whether the current precision ball 705 is the last of the seven balls on ball plate 510. If not, in Step 850, microcomputer 410 sends next ball platform command data required to move the upper platform 205 to the next precision baH, and in Step 825, the above-described process is repeated for the next ball. If the microcomputer 410 determines that the current precision ball is the last of the seven balls on ball plate 510, the ball run calibration procedure is completed at Step 855. Upon completion, the change-in-actuator-length data, representing the difference between the actuator lengths at the reference WO 99!18097 PCTNS98/25450 position and the actuator lengths at each of the preferred three hundred fifty positions, is stored in memory 420.
FIGURE 9 provides a detailed explanation of Step 825 of FIGURE 8 which primarily runs on processor 430 and operates the servo system during the ball run calibration procedure. Starting with Step 900, the platform command data instructing the platform to move is input at Step 905. This data was provided by Steps 820, 840, and 850 of FIGURE 8. Then, in Step 910, the processor 430 transforms the estimated platform pivot locations (e.g., those of Step 805 of FIGURE 8) at the reference position [0, 0, 0, 0, 0, 0] to new pivot locations according to the position required by the platform command data (e.g., the above-mentioned platform position command [1, 3, 5, 2, 4, 6]).
In Step 915, the processor 430 uses the new estimated pivot locations from Step 910 and the Pythagorean theorem to produce a set of new actuator lengths required to move the upper platform 205 to the position required by the platform command data. In Step 920, the processor 430 actuates the servo system. For example, the processor 430 sends the new actuator lengths to the digital signal processors 440 of FIGURE 4. Each of the servo amplifiers 445 drives their respective motors 450 such that the respective actuator drives 460 adjust each . actuator 215 to the new actuator length. Measuring transducer 465 feeds back data to the digital signal processors 440 in order to ensure the actuator 215 is precisely extended or retracted to the new actuator length. Accordingly, the upper platform 205 is moved to the position required by the platform command data.
Returning to FIGURE 9, it is important to note that the hexapod machining center 1 10 is still being controlled using estimated pivot locations. Thus, the movement of Step 920 will not correspond exactly with the precision nature of the artifact, even though it exactly corresponds to the actual changes in actuator lengths from those at the reference position as calculated by processor 430. Since the end portions 610 of sensors 605 are in mechanical contact with the precision ball 705, when the upper platform 205 movement deviates from the exact location of the precision balls 705, the end portions 610 of one or more sensors 605 are displaced. In Step 925, this displacement is fed back as a voltage difference for each sensor to the processor 430. In Step 930, processor 430 determines if the voltage differences are within a predetermined limit. In the preferred embodiment, this predetermined limit is 9 mV. If the voltage differences are not within the predetermined limit, processor 430 converts the voltage differences in Step 935 into new platform command data designed to minimize the displacements. of the sensors 605. For example; a platform position [ 1, 3, 5, 2, 4, 6] might result in a new platform command of [1.01, 2.99, 5.01, 2, 4, 6]. This conversion is accomplished by applying a series of well known coordinate system similarity transformations to the displacements along the axes of the sensors. This similarity transformation is required in the preferred embodiment because the axes of the sensors 605 of the gauge nest 505 are not orthogonal.
In Step 940, the new platform command data is adjusted by means of integral and proportional feedback from the LVDTs, e.g., using an integrator to drive the LVDTs completely to null and using a proportional gain for stability. Next, processor 430 returns control to Step 910, where the above-described process is repeated using the adjusted platform command data. With each pass through Steps 910-940, the platform command data is continuously adjusted until the voltages output from sensors 605 are reduced to within the above-mentioned displacement limits. When this occurs at Step 930, the current actuator lengths are subtracted in Step 950 from the actuator lengths at the reference position (e.g., from Step 810 in FIGURE 8).
Finally, in Step 955, these differences are output as "change-in-actuator-length data" and control of the servo system is completed at Step 960.
When a statistically sufficient amount of change-in-actuator-length data is collected, preferably through the ball run calibration procedure~described above, the dimensions of the machine and any WO 99/28097 PC'TlUS98/25450 unknown characteristics of the artifacts can be found. Examples of the latter include: the orientation of a line and the coordinates of a point on the line measured by a laser interferometer, the location and orientation of a line defined by the center of a cylinder; the location and orientation of a plane defined by a surface plate; and the center of rotation defined by a tooling ball. Note that for many machining center applications, it may be desired to perform the calibration run using a line generated by a laser interferometer instead of a ball plate as the artifact. In that case, it would not be the location of the center of a precision ball that would be determined, but would be above-mentioned laser beam orientation and the coordinates of a point on the beam measured to within a few wavelengths by the laser interferometer. In that case, the calibration run would comprise a "laser run" instead of a "ball run". tn fact, there are numerous other alternative types of artifacts that can be measured during the calibration run.
As mentioned above, once the change-in-actuator-length data is collected, preferably from the ball run calibration procedure, the calibration procedure continues by performing a "simulation analysis" on a computer. The simulation analysis uses the change-in-actuator-length data to iteratively determine the plurality of pivot locations 215a and 215b of the hexapod machining center 110. This process is shown in detail with reference to FIGURES 10-11.
Referring now to FIGURE 10, a flowchart of the steps taken to perform the platform simulation analysis is provided. These steps can be executed either on microcomputer 410 or on a completely separate and distinct computer system than microcomputer 410. The simulation analysis computer would have the change-in-actuator-length data file transferred to it, either by way of any mass storage device ~e.g., floppy disk, CD-ROM), over the Internet, or through any known network connection te.g., LAN or WAN). Thus, the computer system (either the microcomputer 410 or the above-mentioned separate computer system) will hereinafter be referenced as the "platform simulator". In the WO 99/28097 PC'T/US98/25450 preferred embodiment, the platform simulator is the personal computer included in the CNC 8000 mentioned above.
Beginning with Step 1000 of FIGURE 10, the platform simulator receives the change-in-actuator-length data in Step 1005. In Step 1010, the platform simulator makes initial estimates of the locations of the artifacts, e.g, the seven precision balls. These estimates are based on prior knowledge of the placement of the precision balls on the lower platform 200. The ball locations are defined with respect to the above-mentioned absolute coordinate system fixed to the lower platform.
Examples of seven ball location estimates in the absolute X-Y-Z
coordinate system are: [0, 0, 0]; [-8.5, 0, 0]; [-4.3, -7.5, 0];
[4.3, -7.5, 0]; [8.5, 0, 0]; [4.3, 7.5, 0]; [-4.3, 7.5, O].
In Step 1015, the platform simulator makes initial estimates of the pivot locations in the lower and upper platforms, 215a and 215b, respectively. Both of these estimates are made from knowledge of the dimensions of the machine within manufacturing tolerance limits.
Examples of estimates of the pivot location were given above.
In Step 1020, the platform simulator uses the initial estimated ball locations and pivot locations along with the change-in-actuator-length data to simulate platform movement for each precision movement of the ball run calibration procedure. Accordingly, three hundred fifty simulations are performed, corresponding to each change-in-actuator-length datapoint. The steps taken to perform this simulation of platform movement are shown in detail in FIGURE 11 and will be discussed below.
The simulation of platform movement provides microcomputer 410 with three hundred fifty positions of the upper platform 205. It is important to note that, in the preferred embodiment, these three hundred fifty resulting positions directly correspond to the seven precision ball locations, since, during the ball run calibration procedure, each of the three hundred fifty change-in-actuator-length datapoints were recorded when the sensors 605 were exactly centered on one of the seven precision ball locations.

In Step 1025, the platform simulator subtracts the seven estimated ball locations of Step 1010 from the resulting three hundred fifty ball locations of Step 1020 in order to obtain differences, and then squares and sums these differences to create a "cost function". In Step 1030, the ball locations and pivot locations are adjusted in order to reduce the cost function. In the preferred embodiment, the Davidon-Fletcher-Powell (D-F-P) nonlinear programming algorithm is used to reduce the error by adjusting the estimated ball locations and pivot locations.
Although the well-known D-F-P method is used in the preferred embodiment because of its speed, other minimization techniques could be used, e.g., steepest descent or conjugate gradient. Refer to Introduction to Linear and Nonlinear Proaramminp by D.G. Luenberger of Stanford University, 1973, specifically Chapter 9.3, for more information on the D-F-P method.
In Step 1035, the platform simulator uses the adjusted pivot locations and ball locations along with the original change-in-actuator-length data to again simulate platform movement. As explained above, the platform simulator calculates movement of the upper platform for each of the three hundred fifty change-in-actuator-length datapoints gathered during the ball run calibration procedure, one at a time. In Step 1040, the cost function described in Step 1025 is recalculated using the newly adjusted seven ball locations from Step 1030 and the three hundred fifty ball locations from Step 1035. In Step 1045, a "cost change" is computed using the current cost function value by subtracting the previous cost function value (i.e., on the first pass through the flowchart, the previous cost function is the value calculated in Step 1025, otherwise it is the previous cost function value from Step 1035); this difference is then divided by the current cost function value to determine the cost change. In Step 1050, the platform simulator determines if the cost change computed in Step 1045 is below a predetermined limit. In the preferred embodiment, the predetermined limit is 1.OE-9. If the differences are greater than the predetermined limit, the platform simulator returns to Step 1030 and Steps 1030-1050 are repeated.
If, in Step 1050, the platform simulator determines that the cost change is less than the predetermined limit, the simulation analysis is completed and the final estimates of the pivot locations and ball locations are output in Step 1055, and the simulation analysis ends with Step 1060. These final estimates represent the actual dimensions of the machine used to perform the ball run calibration procedure within an acceptable error.
The simulation of platform movement of Steps 1020 and 1035 is illustrated in more detail with reference to FIGURE 11. Note that the platform simulator does not know or care that the input pivot locations and ball locations are simply estimates. Rather, the platform simulator assumes that an exact machine geometry is represented. The platform simulator then uses the change-in-actuator-length data to find a new position of the machine. For example, the position of the upper platform 205 before the simulation could be at the reference position [0, 0, 0, 0, 0, 0], and after the simulation has taken place, the upper platform 205 would be at a displaced position, say [1, 3, 5, 2, 4, 6], if the change-in-actuator-length data corresponds to that position. Thus, the simulation of the upper platform movement can be used in systems completely different and independent of the subject calibration system.
Accordingly, the steps of the simulation of platform movement can be executed on any computer system.
Beginning with Step 1100, the platform simulator first receives a set of pivot locations and estimated ball locations in Step 1105. The pivot locations are used in Step 1110 to calculate the actual actuator lengths between pivots at the [0, 0, 0, 0, 0, 0] platform position (i.e., the reference position?, to which are added the change-in-actuator-length data for the particular platform position of interest. The results are the actual actuator lengths for the displaced platform position. In Step 11 15, the platform simulator assigns or receives an estimate of the new platform _27_ WO 99/28097 PCT/US98~25450 position. For example, the reference position may be an acceptable initial estimate of the new platform position. In Step 1120, the platform simulator transforms the platform reference position (and the upper platform reference pivot locations) to the estimated new platform position. In Step 1125, the Pythagorean theorem is used to calculate the distance between each pair of lower platform actuator pivots and transformed upper platform actuator pivots. The results are estimated actuator lengths corresponding to the estimated new platform position.
In Step 1130, the actuator length errors are calculated as the sum of the squares of the differences between the estimated actuator lengths from Step 1125 and the actual actuator lengths from Step 1110.
In Step 1135, the platform simulator adjusts the estimated new platform position to reduce the actuator length error defined in Step 1130. This adjustment is done in the preferred embodiment using the well-known Newton Raphson method, although any algorithm designed to minimize the value of a multi-variable function can be applied. Refer to Elements of Numerical Analysis by P. Henrici, published by John Wiley, 1964 (Library of Congress Card Catalog Number 64-23840), particularly Chapter 5, for further information regarding the Newton Raphson method.
In Step 1140, the platform simulator compares the amount of adjustment required in Step 1135 to a predetermined limit. If the adjustment is more than the predetermined limit, the platform simulator returns control to Step 1115, and Steps 1115-1140 are repeated.
Through iterative adjustments of the position of the upper platform or the estimated new position, the adjustment required in Step 1140 will eventually become smaller and smaller. Theoretically, it could be as small as the number of significant digits in the given computer on which the simulation is running, since the change in the commanded position will eventually approach zero as the estimated actuator lengths approach the actual actuator lengths found in Step 1 110. In the preferred embodiment, the predetermined adjustment limit used in Step 1140 is defined such that the absolute value of the change in any of the platform coordinates X, Y, Z, A, B, or C must be less that 1.OE-fi.
If the adjustment meets the limit in Step 1140, the platform simulator outputs the commanded position as the position of the upper platform in Step 1 145. For example, if the commanded position was (0.01, -0.2, 0, 2, 0, 0] on consecutive passes through the flowchart, then the platform simulator would output that position as the position of the upper platform 205, or as discussed above, the position of one of the precision balls 705. The simulation of platform movement is completed at Step 1105.
It is important to note that the invention is not limited to this preferred embodiment of the simulation analysis. Rather, any simulation that uses similarly measured change-in-actuator-length data and estimated pivot locations to find a new position of the machine could be used.
By the above procedures of FIGURES 8 through 11, the hexapod machining center is calibrated by first collecting change-in-actuator-length data when the actual machine performs a series of precision movements defined by a particular artifact. This data is then collected and used in an iterative processes on a simulation computer to find the actual locations of the pivots. Thus, the present invention provides for the calibration of a positioning device without the use of extremely precise pivot locations for the movable platform. Furthermore, the calibration system requires only that a set of calibration movements be made, and then the calibration data can be manipulated on any remote computer. Therefore, the hexapod machining center can be re-calibrated periodically in the field to ensure its long-term accuracy. Thus, the calibration technique of the present invention ensures very high precision for a positioning device without the high cost of other conventional calibration systems.
As mentioned above with reference to FIGURE 4, the microcomputer 410 controls hexapod machine center such that the upper platform 205 moves along a pre-programmed path. The microcomputer 410 moves the upper platform by sending platform command data in the form of a new desired position. For example, if the upper platform currently resides at position [0, 0, 0, 0, 0, 0], the pre-programmed path may require microcomputer 410 to move to new position [ 1, 2, 3, 5, 5, 5]. The platform command data would be [1, 2, 3, 5, 5, 5]'~, where the asterisk "~"" indicates that the position is treated as a command or instruction to the positioning device to move it to that position, as opposed to the current position itself. This platform command data must be transformed into actuator movement through the hardware described with reference to FIGURES 4 and 12-17. In FIGURES
12-17 below, a detailed explanation will be presented as to how the platform command data is transformed into precise actuator movement.
Referring to FIGURE 12, the microcomputer 410 sends the platform command data fX, Y, Z, A, B, C]~" to a trajectory generator 1205 which is preferably internal to microcomputer 410. It should be noted that the commands [X, Y, Z, A, B, C] are relative to the lower platform.
Trajectory generator 1205 converts this Cartesian machine platform command data into a continuous stream of commanded position, velocity, and acceleration (p,v,a) motion command data and outputs all three. In the preferred embodiment, this is done using "S" curves where:
p(t) = A~t3 + B~tZ + C~t+ D
v = dp/dt = 3~A~tz + 2~B~t + C
a = dv/dt = 6~A~t + 2~B
and where p(t) is the instantaneous position as a function of time, v(t) is the instantaneous velocity as a function of time, aft) is the instantaneous acceleration as a function of time, and t is time. Each p, v, and a parameter calculated above consists of two vectors, one rectilinear, (X, Y, Z) and one angular (A,B,C). The coefficients A, B, C, and D are calculated by the trajectory generator in such a way that certain limits of jerk, acceleration, and velocity are not exceeded. The trajectory generator creates one or more S curves, which are used in succession, for each position command [X, Y, Z, A, B, C]'" into generator 1205.

An alternate method of calculating the instantaneous velocity and acceleration is to take the first and second numerical differences of the position command stream p(t).
Returning to FIGURE 12, trajectory generator 1205 outputs the commanded relative position, velocity, and acceleration to both a reaction feedforward calculator 1210 and a kinematics calculator 1215. The reaction feedforward calculator 1210 uses the commanded relative position, velocity, and acceleration as well as the forces acting on the lower platform to determine actuator forces F" on each actuator 215 to produce the relative accelerations commanded by trajectory calculator 1205. The steps required to perform this transformation are further described with reference to FIGURE 13.
The reaction feedforward calculator 1210 outputs the actuator forces F'" to the kinematics calculator 1215 and to a servo feedback system 1225. Kinematics calculator 1215 uses the commanded position and the actuator forces F'" to determine commanded actuator lengths L*' which include a correction for the errors due to the elastic distortions of the hexapod machining center 110 caused by the actuator forces F'~ and other inertia forces. The signal flow diagram of the routines required to perform the determination of commanded actuator lengths L'~ are further described with reference to FIGURE 15.
Commanded actuator lengths L'" are output to the servo feedback system 1225 and to a differentiator 1220. Differentiator 1220 provides the rate of change of actuator lengths L'", i.e., dL/dt, the derivative of the length L with respect to time, to the servo feedback system 1225. Servo feedback system 1225 provides commanded torque T"' to the control stage 443 of each actuator 215 as referenced in FIGURE 4. The control stage 443 comprises the servo amplifier 445, motor 450, encoder 455, actuator drive 460, and measuring transducer 465. Each control stage 443 provides feedback from the encoder 455 and measuring transducer 465 to the servo feedback system 1225.
Thus, servo feedback system 1225 uses the commanded actuator forces F'", the commanded actuator lengths L'", the derivative of the commanded actuator lengths dL'"/dt, and the feedback from each control stage 443 to determine the commanded torque T'".
Preferably, the reaction feedforward calculator 1210, the kinematics calculator 1215, and the differentiator 1220 are implemented on the Intel PENTIUM CPU 430. The servo feedback system 1225 is implemented on the digital signal processors 440 shown in FIGURE 4.
Referring now to FIGURE 13, a general software flowchart of the steps taken to perform the reaction feedforward calculation performed by the reaction feedforward calculator 1210 is shown. Following Step 1300, the commanded relative position, velocity, and acceleration are received from the trajectory generator 1205 at Step 1305. In Step 1310, the commanded relative position velocity, acceleration, and lower platform forces are used to calculate the actuator forces required to produce the desired relative accelerations. This calculation is done by solving a system of six equations simultaneously for the six actuator forces F. For example, in the preferred embodiment, the system of equations is given in matrix form as:
CPmat~F = B ( 1 ) where CPmat is a coupling matrix having the six columns of the top three rows filled with the unit vectors for each actuator 215, and the six columns of the bottom three rows filled with relative unit torque to inertia ratios, where the unit torques are the moments of the actuator unit vectors about the center of gravity of the associated platform. They are calculated as the cross-products of the leg unit vectors and the vectors from the center of gravity to the actuator pivots.
In equation (1?, F is a vector of the six actuator forces. The quantity being equated in the rectilinear system (top three rows) is force.
The quantity being equated in the angular system (bottom three rows) is relative angular acceleration. Therefore, the first three elements of the vector B on the right hand side of the equation are in force units. The last three elements are in acceleration units. The first three elements of WO 99/28097 PGTIUS98lZ5450 the B vector are the rectilinear forces in each of three directions X, Y, and Z, which are calculated as follows:
Mu/(Mu+MI)~(Ml~a+sum footl (2) Where Mu is the mass of the upper platform, MI is the mass of the lower platform, a is the commanded acceleration of the upper platform relative to the lower platform from Step 1305. Sum foot is the summation of all of rectilinear forces applied to the lower platform by the vibration isolation components from Step 1325. The next three elements of the B vector are the commanded relative angular accelerations from Step 1305.
Equation (1 / is solved for the actuator force vector F, which are the commanded actuator forces F", by first determining the values of the coupling matrix CPmat, and then inverting and multiplying it by the 8 vector. This is shown by equation (3):
F = CPmat-' ~ B (3?
The steps required to calculate the coupling matrix CPmat and the B vector are further described with reference to FIGURE 14.
After equation (3) is solved for the commanded actuator forces F~" in Step 1310, the actuator forces are output from reaction feedforward calculator 1210. Then, in Step 1320, the commanded actuator forces F~ are used to determine the new position, velocity, and acceleration of the lower platform 200. For example, since force equals mass times acceleration, all of the forces acting on the lower platform can be divided by the mass of the lower platform 200 to get the rectilinear acceleration. Similarly, the summation of all moments acting on the lower platform multiplied by the inverse of the lower platform inertia matrix is the lower platform acceleration. The acceleration is integrated to get the velocity of the lower platform 200. This velocity can be further integrated to get the position of the lower platform 200.
In Step 1325, the new position, velocity, and acceleration of the lower platform 200 are used to calculate the positions and velocities of the vibration isolation components 245, which, when combined with the stiffness and damping characteristics of the isolation components, are used to calculate the forces exerted by the isolation components on the lower platform. The forces on the lower platform 200 caused by the vibration isolation components, and the new position, velocity, and acceleration of the lower platform 200, are again used in Step 1310 to determine the B vector, and the above-described process is repeated.
Referring now to FIGURE 14, the steps required to calculate the actuator forces F~ in Step 1310 are described starting at Step 1400. As mentioned above, the coupling matrix CPmat and the B vector must be built in order to solve the equation for the actuator forces vector F. In Step 1405, PENTIUM processor 430 calculates the moment arms for the upper and lower platforms, 205 and 200. The moment arm is a vector calculated by subtracting the center of gravity location from the pivot location on the actuator connected to that pivot location. In Step 1410, the PENTIUM processor 430 calculates the unit torque vectors for the upper and lower platforms, 205 and 200. The unit torque vectors are equal to the cross product of a unit vector of the actuator 215 and the associated moment arm.
In Step 1415, PENTIUM processor 440 obtains the relative angular accelerations from the trajectory generator 1205. In Step 1420, the coupling matrix is filled such that the top three rows contain the unit vectors of the actuators. The bottom three rows are filled with the relative unit torque-to-inertia ratios. These are calculated by the following vector formula:
(IUI~(RT~Tug")) - RT~(RIC~(Ili~(RICT~Tlg"))) (4) where this vector is used six times (once for each actuator) to fill the columns of the bottom three rows of the coupling matrix CPmat with six vectors. The term lui is the inverse of the upper platform 205 inertia matrix, in lieu of putting a matrix in the denominator of equation (4).
Similarly, Ill is the inverse of the lower platform 200 inertia matrix. The term Tug" represents the six unit torque vectors for the upper platform 205 associated with each of six actuators. Similarly, Tlg~ represents the six unit torque vectors for the lower platform 200 associated with each of WO 99128097 PCT/US98l25450 six actuators. The rotation matrices R and Rlc for the upper and lower platform, respectively, describe the platform rotations relative to the global coordinate system.
An example of the rotation matrix R is:
f cb~cc -cb~sc sb f ca~sc+sa~sb~cc ca~cc-sa~sb~sc -sa~cb ]
f sa~sc-ca~sb~cc sa~cc + ca~sb~sc ca~cb ]
where:
sa = sin(A) ca = cos(A) sb = sin(B) cb = cos(B) sc = sin(C) cc = cos(C) The transpose of R and Rlc appear in equation (4) to place the quantities being equated into the same coordinate system.
In Step 1425, the PENTIUM processor 430 calculates the top three values of the B vector according to equation (2). The bottom three values of the B vector are filled using the following formula:
maccc ang + RT~Rlc~Ili ~RIcT~foot ang tot i5) where maccc ang is the commanded relative angular acceleration from generator 1205, R and Rlc were previously defined, and foot~ang tot is a vector representing the summation of all of the moments exerted on the lower platform by the vibration isolation components.
In Step 1435, digital signal processor 440 builds the B vector according to the above-described values. In Step 1440, PENTIUM
processor 430 inverts the coupling matrix CPmat and multiplies it by the B vector in order to find the actuator forces vector F. The commanded actuator forces F~" (or forces vector F) are then output for each actuator 215 to kinematics calculator 1215 of FIGURE 12, and the process stops at Step 1445.
Referring to FIGURE 15, a signal flow diagram of the kinematics calculator 1215 of FIGURE 12 is illustrated. Input into kinematics calculator 1215 is the commanded position vector p (which contains six position commands for X, Y, Z, A, B, and C) from trajectory generator 1205 and the actuator forces F~". Kinematics calculator 1215 uses the rotational commanded position data [A, B, C] in a rotation matrix generator 1505 to generate a rotation matrix R. The upper platform pivot location constants, which are the pivot location vectors determined in Step 1055 of FIGURE 10, are added in adder 1525 and then input to a multiplier 1510 which rotates the pivot vectors by R. The kinematics calculator 1215 then adds the linear command position data [X, Y, Z]
from trajectory generator 1205 to the rotated pivot position data in adder 1515.
The kinematics calculator 1215 uses the actuator forces F~ and the actuator unit vectors in a pivot deflection calculator 1520 in order to calculate the pivot migrations of the upper and lower platforms 205 and 200. These pivot migrations would be caused by elastic deflections of the machine platforms due to the actuator forces F~" and inertia forces.
These distortions are referred to as the "compliance" of the machine.
The steps taken to collect this compliance information and build a machine compliance model are discussed with reference to FIGURE 16.
The upper platform pivot migrations are added to the upper platform pivot location constants in adder 1525. Similar to the above processing for the upper platform, the lower platform pivot location constants, which represent the pivot location vectors from 1055 are added to the lower platform pivot migrations in adder 1530. Now the upper and lower platform pivot location vectors are sent to the actuator length calculator 1540, which calculates the magnitude of the actuator vectors by the Pythagorean theorem. This magnitude is the actuator length. Kinematics calculator 1215 also uses a scalar universal joint compliance calculator 1545 to calculate a scalar component of gimbal compliance representative of the stiffness of the actuator joints such as universal joints 380 and 382 of FIGURE 3B. This scalar component of U-joint compliance is added to the actuator lengths in adder 1550. The result is the commanded actuator lengths L~" output from kinematics calculator 1215.

Referring now to FIGURE 16, a flowchart of the steps taken by the pivot deflection calculator 1520 to collect compliance information and build a machine compliance model are shown. As described above, the accuracy of the hexapod machining center 110 is determined by how accurate the microcomputer 410 determines the plurality of pivot locations 215a and 215b. Also as described above, the pivot locations 215a and 215b move slightly when forces are applied to the upper and lower platforms 205 and 200. The significant forces preferably include:
six actuator forces (tension and compressions) of the six extendable actuators 215; three counterbalance forces (compression) from the counterbalances 235; and the acceleration of distributed masses.
Beginning from Step 1600 of FIGURE 16, a finite element model of the upper platform is constructed in Step 1605 using an IBM
workstation running the CAEDS finite element software, which is a product of the Structural Dynamics Research Corporation. In the model, the spindle cartridge 220 of the upper platform 205 is fixed to ground, since the goal is to minimize the deflections of this component. Such finite element models include a plurality of nodes at which forces may be applied or displacements may be recorded. In the preferred embodiment, a number of force nodes are defined at which forces may be applied: at the six actuator pivot locations 215b in the upper platform; and at the three counterbalance pivot locations 250 in the upper platform 205. Six displacement nodes at which the three Cartesian components of deflections will be recorded include the actuator pivot locations 215b in the upper platform 205. The finite element model also provides the deflections at the displacement nodes in response to accelerations of the upper platform in the X, Y, and Z directions.
In Step 1610, a unit acceleration is applied to the upper platform 205 in one of the three Cartesian directions X, Y, or Z. The deflection responses of the actuator pivots 215b in the upper platform 205 are then recorded in Step 1615, where each Cartesian component is recorded at each of the six pivots 215b. Step 1620 causes the process to repeat Steps 1610 and 1615 for independently applied accelerations in each Cartesian direction.
After recording the responses to the upper platform components of acceleration, a force node is chosen in Step 1625, and a unit force is applied to the chosen force node in a single Cartesian direction X, Y, or Z
in Step 1630. The deflection responses, or "pivot migrations", of the actuator pivots 215b in the upper platform are recorded in Step 1635, where each Cartesian component is recorded at each of the six actuator pivots in the upper platform 205. Step 1640 causes the process to repeat Steps 1630 and 1635 for independently applied unit forces in each Cartesian direction, still applied at the chosen node. Step 1645 causes Steps 1625 through 1640 to be executed for all of the nodes at which unit forces are to be applied: six actuator pivots 215b and three counterbalance pivots 250.
The analysis of the lower platform 200 begins at Step 1650. At Step 1655, a finite element model of the lower platform 200 is constructed using the aforementioned IBM workstation running the CAEDS finite element software. The model of the work pallet 240 of the lower platform 200 is fixed to ground, since the goal is to minimize the deflections of this component. Like the upper platform, the finite element model of the lower platform includes a plurality of nodes at which forces may be applied or displacements may be recorded. In the preferred embodiment, force nodes are defined at which forces may be applied: at the six actuator pivot locations 215a in the lower platform. The displacement nodes at which the three Cartesian components of deflections are recorded include the six actuator pivot locations 215a in the lower platform 200.
After the finite element model of the lower platform 200 is set up, the process executes Steps 1625 through 1645, i.e. for each application of a unit force in a single Cartesian direction at a force node, the Cartesian components of resulting deflections at all of the actuator pivots 215a in the lower platform 200 are recorded. Finally, the process ends with Step 1660 when all the pivot migrations have been recorded.
Note that the deflection responses to applied forces that were computed using the finite element models could be acquired experimentally. The actual platform structures could be fixed as was done in the finite element models, force components could be physically applied to the force nodes, and displacement node deflection responses could be physically measured.
The information preferably collected in FIGURE 16 is used in pivot deflection calculator 1520 of the hexapod machining center 110.
The actual Cartesian components of forces applied to the force nodes are multiplied by the corresponding finite element model deflections of the displacement nodes (i.e. the actuator pivots) computed in response to unit forces applied at the force nodes. The actual Cartesian components of acceleration applied to the upper platform are multiplied by corresponding finite element model deflections of the displacement nodes (i.e. the actuator pivots) computed in response to unit accelerations applied to the upper platform 205. The principle of superposition allows the displacements resulting from each individual force or acceleration to be summed, thereby yielding estimates of the actual deflections of the displacement nodes (i.e., the actuator pivots).
This superposition process is illustrated mathematically for the upper platform in Appendix A, attached hereto and incorporated herein by reference. The Cl matrix contains the finite element deflections computed in response to unit forces, preferably determined according to FIGURE 16.
The force components applied to the force nodes are contained in the Fu vector, which is rotated into the fixed lower platform coordinate system by the rotation matrix R. The resulting P vector contains the desired pivot migrations, which are output by the pivot deflection calculator 1520 of FIGURE 15. The migrations are supplied in the same coordinate system used to define the actuator pivot coordinates at the reference position (0, 0, 0, 0, 0, 01. The migrations are added to the actuator pivot coordinates at the reference position in Step 1525 of FIGURE 15.
It should be noted that the above number of nodes and number of recordings is only for the preferred embodiment, and the invention is not limited to the this number. Rather, one of ordinary skill in the art of finite element modeling would understand that variations of FIGURE 16 could be used to obtain any statistically sufficient number of elastic distortions to accurately model the compliance of the hexapod machining center 110. For example, different combinations of an applied force, velocity, or acceleration could be recorded for any given nodes of the machine.
Turning now to FIGURE 17, a signal flow diagram of the servo feedback system 1225 of FIGURE 12 is illustrated. Input into the servo feedback system 1225 are the commanded actuator forces.F'", the commanded actuator lengths L'" and the derivative of the commanded actuator lengths dL"/dt. The digital signal processor 440 feeds commanded actuator forces F~ into a unit transformer 1705 in order to transform the forces into torques. This is done by multiplying commanded actuator forces F" by the pitch of the upper platform 205 divided by 2~pi. This is the first of three torques added in adder 1710 in order to develop the output commanded torque T'~. The digital signal processor 440 feeds the commanded actuator lengths L'" into an adder 1715 where the actuator lengths L fed back from the measuring transducer 465 are subtracted. The actuator length error is sent though a proportional integral derivative (PID) filter where a proportional gain Kp of the error is transformed into torque, an integral gain of the integral of the error is transformed into torque, and a derivative gain Kd derivative of the error is transformed into torque. The three torques are then added in adder 1720 and the result is the second torque of the three torques added in adder 1710. The integral gain Ki is for low frequency enhancement, or stiffness enhancement, and the derivative gain Kd is for adding dampening stability.

--75895!380-- CA 02312897 2000-o6-of The IBM workstation also fieeds the oommanded actuator lengths L' into a transformer 1725, which transforms the commanded actuator lengths L~ into commanded angular position e"" of the actuator screw, The commanded angular position B~ is then subtracted from the fed beak signal of the encoder 445 angular position B in subtraator 1730 in order to oalculate an angular error. The angular error is then give a proportional gain Kp and a derivative gain S and Kd far similar reasons as stated above. The resulting torques ale then added in adder 1735 and the result is a sum of the angular error torques. The sum of the angular error torques are sent to an additional adder 1740. The digital signal processor 440 also inputs the derivative actuator lengths dL'"Idt into a transformer 1745 in order to convert it into angular velocity. The angular velocity is then multiplied by a gain for overcoming viscous friotion of the motor 450 and the bail screw and the resulting torque is also added in 18 adder 1740. The angular velocity is also differentiated S in order to obtain angular acceleration, which is multiplied by the inertia J of the motor and actuator screw, and the resulting torque is added in adder 1740, The resulting torque of adder 1740 is the third of three torques added to complete the commanded torque T" to the servo amps 445.
in the preferred embodiment, the compliance compensation technique of the present invention utilizes "clean" force data generated by the reaction feedforward caloulatar 1210. However, it is also contemplated that the same compliance compensation technique can be used with other data. Far example, the meter torque feedback data can be used for this purpose, although it is generally a vary noisy signal and, accordingly, makes it more diffioult to uas.
For further reference, Appendix 8 sets forth the detailed motion equations for the reaction feedforward calculator 1210, and Appendix C
sets forth the derivation of the B veotor described above. Both of these appendices are at~ched hereto and incorporated herein by reference.
While specific embodiments of the present invention have been shown and described herein, further modifications and improvements may ~J!~~~=r,fi~ ~~EET

--7b69b/380-- CA 02312897 2000-06-O1 be made by those akilied in the art. )rt particular, it should be noted that the software processing steps and processors described in the figures ere oniy preferred embodiments of software routines and hardware devices which can be used. Numerous software and hardware modifications may be made to customize the present invention for various other applications, All such modifications which retain the basis underlying principles disclosed and ciaimed herein ors within the scope and spirit of the invention.

~~~t~;EfiD ~fiFET

uw « . : rrHi rrui u~ts 1t 1 ~~w m k ~ 1- 7 -~5 : U : 14 : 4142975345~P 12/
++31 70 3403016 : # 12 .~ysss~~3ao-.
APPENDIX A
l~exayod peer Platform PiYot Micretion CQnnensetion The B pivot migration vectors can be calculated as follows:
Pd ~ Cu.(R r,Fu) wher~:
6 Cu = matrix of the Z7 compliance matrixes for the upper ' platform R = rotation matrix for the upper platform Fu = vector of the fi leg force vectors and 3 counterbalance force vectors a, b, c Pd = vector of the 8 pivot migration vectors Cu takes the following fiorm:
Cti C~z Gas C't~ Cte Cps ~~ ~~d C~c CeW~ ~ ~ Css ~e ~ ~e ~ ~ ~~ Csz ~s ~u ~a ~S ~, Csa Cac Cat C,~ C~a C,~ C~a Cue C,~,, C~u, C
"61 C6Z ~ ~ "56 ~'S8 ~ ~b ~a ~~2 ~ re4 CBE ~'Q8 ~ ~Bb C8o Each element in Cu consists of a stiffness matrix. Element Cz~
for example is the compliance of pivot 2 in response to foroe an leg 3.
IrMENDED ~i-itE i UN1'y. : EPA/EYU/UEt3 R1JSW I JK ~ 1 - 7-~J-9 : 0 ~ 15 : 4141~J7534~-.F'1'?/
++:31 7U .'34.U3U1(i: # LB

. ~r .~
' t The form of these compliance matrixes is as follows:
4x ~x e~

atx afy at ~~~ a ~ a r oz az o atx af,,at where element Bxl~fx is the deflection in the x direction in response to a change in force in the x direction, The leg force vector Fu takes the fotiowing form. Each element is s 3 dimensional leg thrust vector. For example: F~ is thQ farce vector for log 1. F, is the force vector for caunterbalanoe a.
Fur=(F, FsFaF,~FaFaF,FbF~
The Pivot migration vector Pd takes the following form;
PB Pa p~ pa pe) where P, for example is the 3 dimensional deflection vector for pivot 1, ,q,ei,. AMENDEt~ ~! ;tE s ... v . . . . L.L 1~ GC' V / VCD fC 1 JJ~I 1 Jll . 1- t -ay : U : 15 :
4142975:346-rP 12/ ++31 70 3403f116 : # 14 --7fiB951380-- , APPENDIX B
Motion Eouations jQr ,reaction Feedforwr~rd r~.mm+~~
forHgxapod with Floetin~y Lower Platform Rectilinear system.
J, S ..,~ ~ .i ~ r f~~~*~ F°~~ M M ~ M' ~ Fa i1 Rotary system:
g ~ ....
fpl I r~ ~P1 x ~P~ ' ~e t -0a rPu r ~r .r r + ~t F~ x r~ - ~~ -F~, x t~
I
r + ~r o _ I~ t F~ x rp = a i-i whore;
- Power I~g i force scalar = Power leg I unit veatar Gas spring i force vector at~i=r~~tu :~ t~, -4fi-r_rni ~ruiu~ts K 1 JSw I JK . t - 7-99 ~ CI : 15 ~ 4142975345-.P12/ ++31 70 34.03016 : # 15 Mu = Upper platform mass Ml = Lower platform mass = Mounting foot i force veotor (from numerically integrated lower platform model!

~r~ ~ Upper platform inertia matrix = R ~~ ~r ~,~ = Upper platform inertia matrix about x y and a whenabc=0 fiotatiort matrix for rotating the upper platform a = Lower platform inertia matrix (assumed constant for small anglesl rpul a Moment arm from cg. for power leg i on upper ptatform ,..
rpri -- Moment arm from cg. for pow~lr leg i on lower platform rqui Moment arm from ag. for gas spring i ory upper platform reri -- Mom~nt arm from cg. for gas spring i on lower platform r~ = Moment arm from cB. for rnountin~ foot i 0 - Commanded rectilinear acceleration of the cg.

with respect to lower platform a - commanded angular acoeleration of the machine w,r.t. lower platform which is nearly parallel with the global system -46- ' ~~~~I'_~~E/I_W .1_i~i~ t ww ~. ~ a..m w wi vLL l~lvlJnllaIA ~ 1- i-~u ~ v~ iu ~ -t1~*~~~;~c~~*J-~f-1::/
rrJ1 (V J~!~VJVltr~~tlG
~ . ~-75896/380-- CA 02312897 2000-06-O1 al~Ent~~x c Derijvatlon of B Vyctor ~H.S.I
1: m,a~aff-w~-f where:
m~ = mass of lower platform 6 a~ = acoeleration of lower platform ft = force from mounting foot wr = weight of lower platform f = total force between upper and lower platform lJfu ~u ~ f ~ Wu where:
1 Q m~ = mass of upper platform au ~ acceleration of upper platform w" = weight of upper platform 8is_ f fl+w~
I~Ti -4'-AMENDED ~E~

.nw . . . m ni ca ~m vcu m.~.:a.m.m . ~ - t-~~ : y: ~ p ; 4.1ø'~:116a45-iY l~/
++31 7U :34.03016: #I 7 . r~
o ~
m"
~._$u'~
l: 8r= f wu_.. f-f m~, rn, f (m~ + m~ _ fi my _ m~ w~ + mu w~
8: ar =
m, m~, _ 9: f ~rm~~°*f~m"+m~W"
m~ '" JI?a 10: f=f +f~
where:
f, = le$ (actuator) fvrca fo = gas spring (counterbalanae~ force 11; f *f = a'm'mo*f~m~'+m'Wu muw~
mi + mu AMENDED SHEET

um v . = Grhi ~rui U~ts K 1 U5w ! .!K . 1- 7 - 85 : U : 1 g : 4142575~i45~P

12/ ++31 7U 3403016 : # 18 --7fi696/380--12: f = ~r m' m~ + f~ m~ f~ tm~ + m~ + m~ w~ m~ ~'t m,*m"

13: f ~ mu (ar m° ~ f~ ~ f~ ~ ~i~ ~ m~ (fn ~a~
A1, + n1u f = "'' (ar mu " f~ ~+ "',~ + ~"" (ff ' ~~, " w~
W
15: f8 = m~ ('fir ~u ' fn+ ma ~ t mu (~~ ' f~ - me 0~
m, t m"
since:
g = gravity (m x g ~ ~v) 1B: f= armsm°+ffmu~fn(m~*m~
ma + mu 17: f R m' m~,.m~(~.m~+fr)_fa AMEtJDED SKEET

Claims

1. A method of calibrating a positioning device having a movable platform coupled to a base by at least three actuators at a plurality of pivot locations, the method comprising the steps of:
(a) obtaining calibration data indicative of a series of simultaneous three-dimensional measurements corresponding to movements of the movable platform with respect to an artifact, without the location of the artifact being predetermined to within a desired calibration tolerance of the positioning device; and (b) performing a computer simulation analysis using the calibration data to precisely determine the plurality of pivot locations by simulating the movement of the movable platform with respect to the artifact, thereby calibrating the positioning device to within the desired calibration tolerance.

2. The method of calibrating a positioning device according to claim 1, wherein step (a) further comprises the steps of:
(a1) estimating the geometry of the positioning device at a reference position;
(a2) placing an artifact in proximity to the platform;
(a3) mounting sensors to the platform designed to indicate deviations between motion of the platform and the precision nature of the artifact;
(a4) obtaining platform command data required to move the platform to a position such that the sensors begin to measure the precision nature of the artifact;
(a5) moving the platform in accordance with the platform command data;
(a6) obtaining the deviations described in (a3) from the sensors;
(a7) obtaining platform command data determined to move the platform to another position that reduces the deviations;

(a8) moving the platform in accordance with the platform command data;
(a9) repeating steps (a6)-(a8) until sensor deviations fall within a predetermined range;
(a10) outputting, as change-in-actuator-length data, a change from the geometry of the positioning device of step (a1), to the geometry of the positioning device satisfying step (a9);
(a11) when the platform is not in a last position in relation to the artifact, obtaining platform command data required to move the platform to a different position such that the sensors begin to measure the precision nature of the artifact;
(a12) repeating steps (a6)-(a11) until the platform is in the last position;
(a13) when the artifact is not in a last proximity to the platform, determining the next proximity to the platform such that the precision nature of the artifact at the next proximity defines a motion of the platform different from that previously measured in steps (a2)-(a12);
(a14) repeating steps (a3)-(a13) until the artifact is in the last proximity to the platform.

3. The method of calibrating a positioning device according to claim 2, wherein the deviations are deviations from a position where the sensors define a zero error.

4. The method of calibrating a positioning device according to claim 1, wherein the positioning device further comprises a work pallet mounted to the base and a spindle cartridge mounted to the platform, and wherein step (a) further comprises the steps of:
(a1) mounting a ball plate, supporting a plurality of precision balls, to the work pallet;

(a2) mounting a gage nest, supporting a plurality of sensors, to the spindle cartridge, wherein the plurality of sensors are designed to detect the coincidence of a unique point on the gage nest and the center of a precision ball, the condition of coincidence being referred to as centered;
(a3) moving the platform so that the gage nest is centered on one of the plurality of precision balls;
(a4) recording first actuator length change commands required to accomplish step (a3) as change-in-actuator-length data, wherein the change-in-actuator-length data are recorded with respect to a platform reference position;
(a5) rotating the platform to another position on the ball, keeping the gage nest centered on the ball;
(a6) recording second actuator length change commands required to accomplish step (a5) as change-in-actuator-length data, wherein the change-in-actuator-length data are recorded with respect to the platform reference position;
(a7) repeating steps (a5)-(a6) a statistically significant number of times; and (a8) repeating steps (a3)-(a6) for another one of the plurality of precision balls.

5. The method of calibrating a positioning device according to claim 1, wherein the precision movements are defined by causing the platform to trace the precision natures of the artifacts.

6. The method of calibrating a positioning device according to claim 1, wherein step (b) further comprises the steps of:
(b1) defining a second estimate of the plurality of pivot locations at a reference position of the platform;

(b2) defining a first estimate of the artifact location;
(b3) simulating tracing of the artifact by moving the platform using the change-in-actuator-length data;
(b4) determining errors between the simulated movement of the platform in step (b3) and the precision nature of the artifact;
(b5) updating the second estimate of the artifact location and the first estimate of the plurality of pivot locations based on the errors; and (b6) repeating steps (b3)-(b5) a statistically sufficient number of times in order to minimize the errors within a predetermined range, thereby causing the second estimate of the plurality of pivot locations to converge toward actual pivot locations within an acceptable error, thereby calibrating the positioning device.

7. The method of claim 1, wherein the calibration data is indicative of the change in length of each actuator during the series of movements.

8. The method of claim 7, wherein the positioning device is a hexapod machining center.

9. A method of calibrating a hexapod machining center to a desired accuracy, the hexapod machining center having a base and a platform, each having a plurality of pivots, the hexapod machining center also having a plurality of legs, each leg connected between one of the plurality of pivots of the platform and one of the plurality of pivots of the base, the method comprising the steps of:
(a) defining an estimate of the plurality of actual pivot locations in the base;
(b) defining an estimate of the plurality of actual pivot locations in the moving platform when the platform is at a reference position;

(c) calculating, from the estimates described in steps (a) and (b), actuator lengths when the platform is at the reference position;
(d) placing at least one precision ball in proximity to the platform, wherein the exact location of each precision ball is only approximately known to an accuracy that is not within the desired accuracy;
(e) mounting sensors to the platform, designed to indicate a distance between a unique point on the platform and a center of a precision ball simultaneously in three dimensions;
(f) obtaining platform command data required to move the platform to a position such that the sensors begin to measure the distance described in step (e);
(g) moving the platform according to the platform command data;
(h) obtaining the distance described in step (e) from the sensors;
(i) obtaining platform command data determined to move the platform to another position that reduces the distance described in step (e);
(j) moving the platform according to the platform command data described in step (i);
(k) repeating steps (h)-(j) until the distance described in step (e) falls within a predetermined range;
(l) outputting, as change-in-actuator-length data, a change in the actuator lengths from when the platform is at the reference position described in step (c), to when the platform satisfies the condition of step (k);
(m) when the platform is not in a last position on the precision ball, obtaining platform command data required to move the platform to a new position at a different angular orientation on the same precision ball, such that the sensors begin to measure the distance described in step (e);

(n) repeating steps (g)-(m) until the platform is in the last position on the precision ball;
(o) when the platform is not on a last precision ball, determining the approximate location of the next precision ball;
(p) repeating steps (f)-(o) until the platform is on the last precision ball;
(q) determining a sufficiently accurate estimate of actual locations of the plurality of pivots by:
(q1) estimating the positions of the precision balls;
(q2) simulating movement of the platform using platform command data from step (I), yielding simulated platform positions for which the sensors were centered on the precision balls;
(q3) computing the errors between the simulated platform positions and the estimated positions of the precision balls;
(q4) adjusting the estimated positions of the precision balls and the actuator pivot locations to reduce the errors described in step (q3);
(q5) repeating steps (q2)-(q4) until the errors described in step (q3) fall within a predetermined range;
(q6) outputting final pivot locations resulting from step (q5), wherein the final pivot locations represent the actual pivot locations to within the desired accuracy.

10. A system for calibrating a positioning device, the system comprising:
a positioning device to be calibrated to within a predetermined accuracy;
a measuring device having a plurality of sensors and being connected to the positioning device and adapted to precisely determine the exact location of an artifact simultaneously in three dimensions;

a plurality of artifacts disposed in a work area defined by the positioning device, wherein only rough estimates of the locations of the artifacts are known, and wherein the rough estimates are not within the predetermined accuracy;
a first computer, connected to the positioning device, having software programmed for controlling and recording precision movements of the positioning device with respect to the artifacts; and a second computer having software programmed for using the recorded precision movement as input data in order to simulate the positioning device and iteratively determine the actual geometry of the positioning device, thereby calibrating the positioning device to within the predetermined accuracy.

11. The system according to claim 10, wherein the second computer is part of a completely separate and distinct computer system from that of the first computer.

12. The system according to claim 10, wherein the artifact has a partially spherical surface having a centerpoint.

13. The system according to claim 12, wherein the measuring device is a gage nest having at least three sensors configured to determine the exact centerpoint of the artifact.

14. The system according to claim 10, wherein the positioning device is a hexapod machining center.

15. A method for calibrating a positioning device using the system according to claim 10, wherein the method includes the steps of:

(a) performing a calibration run on the positioning device to obtain calibration data indicative of a series of simultaneous three-dimensional measurements corresponding to movements of the positioning device with respect to an artifact, without the location of the artifact being predetermined to within a desired calibration tolerance of the positioning device; and (b) performing a computer simulation analysis using the calibration data to precisely determine the geometry of the positioning device by simulating the movement of the positioning device with respect to the artifact, thereby calibrating the positioning device to within the desired calibration tolerance.

16. The method according to claim 15, wherein the positioning device is a hexapod machining center.