EP1034066A1 - Vorrichtung und verfahren zur kalibrierung eines hexapod-positionierungsgerätes - Google Patents
Vorrichtung und verfahren zur kalibrierung eines hexapod-positionierungsgerätesInfo
- Publication number
- EP1034066A1 EP1034066A1 EP98960594A EP98960594A EP1034066A1 EP 1034066 A1 EP1034066 A1 EP 1034066A1 EP 98960594 A EP98960594 A EP 98960594A EP 98960594 A EP98960594 A EP 98960594A EP 1034066 A1 EP1034066 A1 EP 1034066A1
- Authority
- EP
- European Patent Office
- Prior art keywords
- platform
- actuator
- precision
- positioning device
- artifact
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Withdrawn
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1615—Programme controls characterised by special kind of manipulator, e.g. planar, scara, gantry, cantilever, space, closed chain, passive/active joints and tendon driven manipulators
- B25J9/1623—Parallel manipulator, Stewart platform, links are attached to a common base and to a common platform, plate which is moved parallel to the base
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1641—Programme controls characterised by the control loop compensation for backlash, friction, compliance, elasticity in the joints
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/35—Nc in input of data, input till input file format
- G05B2219/35017—Finite elements analysis, finite elements method FEM
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39182—Compensation for base, floor deformation
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39186—Flexible joint
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39326—Model compensates positions as function of position to compensate force deformations
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40269—Naturally compliant robot arm
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40357—Compliance, design and operational issues
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/41—Servomotor, servo controller till figures
- G05B2219/41189—Several axis, compensation for load for several axis at the same time
Definitions
- This invention generally relates to machines, such as machine tools, robots, linkages, coordinate measuring machines, and positioners.
- 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.
- the accuracy of any machine tool depends on how accurately the dimensions of the machine are determined during calibration and setup.
- 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.
- 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
- These plurality of pivots are determined by: (q 1 ) 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: (a 1 ) 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
- step (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); (a1 1 ) 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; (a 1 2) repeating steps (a6)-(a1 1 ) 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)-(a1 2); (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
- 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: (b 1 ) 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.
- 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;
- 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 6 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 1 1 is a flowchart of the steps taken to simulate the upper platform movement step of the simulation analysis of FIGURE 10;
- FIGURE 1 2 is a detailed block diagram of a portion of the control system of FIGURE 4;
- FIGURE 1 3 is a general flowchart of the steps taken to perform the reaction feedforward calculation of the reaction feedforward calculator of FIGURE 1 2;
- 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 1 5 is a signal flow diagram showing the operation of the kinematics calculator of FIGURE 1 2;
- FIGURE 1 6 represents a flowchart of the steps taken to collect compliance information for the machine sensitivity model of FIGURE 1 5; and
- FIGURE 1 7 is a signal flow diagram showing the operation of the servo feedback system of FIGURE 1 2.
- the calibration system 100 comprises a hexapod machining center 1 10 connected to a series of equipment enclosures 1 20 by way of a power and control cable loop 1 25.
- the series of enclosures 1 20 preferably comprises a microcomputer bay 1 30, a servo power control system 140, and a tool power control system 1 50.
- the microcomputer bay 1 30 and the servo power control system 140 will be described in further detail with reference to FIGURE 4.
- the tool power control system 1 50 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 1 60 affixed to the feet 1 70 of the hexapod machining center 1 10 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.
- FIGURE 2 a preferred embodiment of the hexapod machining center 1 10 is shown.
- the hexapod machining center 1 10 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 21 5 attached to the lower platform 200 at a plurality of lower pivot locations 21 5a and to the upper platform 205 at a plurality of upper pivot locations 21 5b.
- Each actuator 21 5 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 21 5 could include pneumatic cylinders, hydraulic cylinders, or rack-and-pinion devices.
- 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 1 10 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 1 10 could also include different types of vibration isolation components.
- the hexapod machining center 1 10 is isolated from the floor by two gas springs 1 60, one positioned on each side of each of the three feet 1 70 of the base of the machine.
- the hexapod machining center 1 10 is isolated from the floor by two gas springs 1 60, one positioned on each side of each of the three feet 1 70 of the base of the machine.
- 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.
- 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” .
- the lower platform is separate and isolated from the floor such that it is decoupled by a 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” .
- the lower platform 200 is not even located below the upper platform 205, but would be supporting it in the same horizontal plane.
- 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.
- each transducer is associated with each of the actuators 21 5.
- U.S. Patent No. 5,538,373 discloses the use of six instrument arms, separate from the actuators 21 5, 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 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.
- an instrument arm 300 is formed of concentric outer and inner tubes 310 and 31 5, 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.
- 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.
- FIGURE 3A illustrates a representative instrument arm 300 which is separate from the actuators 21 5
- FIGURE 3B illustrates a cross-section of a measurement transducer 360 comprised of an extendable actuator leg 21 5 incorporating a laser interferometer instrument system inside it.
- the actuator leg 21 5 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 21 5a and 21 5b of the actuator 21 5. 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.
- 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
- the retro-reflector 350 is mounted at the other end of the ball screw.
- 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 21 5. This distance can be mathematically translated to determine the locations of pivots 21 5a and 21 5b. 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 21 5 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 21 5. 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
- 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 1 10.
- 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 provides mathematical transformations from Cartesian coordinate system-based instructions to actuator lengths.
- 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 21 5 of FIGURE 2), and a measuring transducer
- 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.
- 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 21 5, thus providing some movement to upper platform 205.
- 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 21 81 DSPs available from Analog Devices, Inc. of Norwood, Massachusetts; the servo amplifiers 445 are Model BDS4
- the servo system includes DSPs 440 and the servo control stages 443 which provide a closed feedback loop used to position the machine.
- the servo system further includes processor 430 and the calibration device 470.
- processor 430 could be eliminated if its function was incorporated into a more powerful microcomputer 410.
- 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.
- FIGURE 5 provides an enlarged, side perspective view of a gauge nest 505 and a ball plate 510 attached to the hexapod machining center
- 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.
- the calibration system moves the gauge nest 505 in relation to the ball plate 510 in order to record precision actuator information used to calibrate the machine.
- 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
- FIGURE 7 a top perspective view of the ball plate 510 is shown.
- the ball plate 510 comprises six precision balls 705 arranged around a center precision ball and disposed on the corners of a hexagon-shaped base 710.
- 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.
- sensors 605 are conventional Linear Variable Differential Transformers (LVDTs). Each LVDT produces an electrical output signal proportional to the displacement of its moveable core. 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.
- LVDTs Linear Variable Differential Transformers
- 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 1 983 (Library of Congress Card
- Different types of sensors 605 would be used with different types of artifacts.
- LVDTs can be used to measure the aforementioned cylinder, surface plate, and tooling ball
- a laser interferometer can be used to monitor linear movements of the upper platform over distances equal to integral numbers of light wavelengths.
- 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.
- FIGURES 8-1 1 illustrate how the calibration system is used to find the precise dimensions of the hexapod machining center 1 10 by computer simulation.
- 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 1 10 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.
- the precise dimensions utilized are the location of the plurality of pivot locations 21 5a and 21 5b for 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.
- measurement data must first be collected from a series of precision machine movements, called a "ball run", in order to determine the precise geometry, or linkage dimensions, of the hexapod machining center 1 10.
- a parameter called the "change-in-actuator-length" is collected as the measurement data, as will be discussed below.
- Step 800 rough estimates of the pivot locations for the plurality of actuators 21 5 are determined in Step 805 according to previous knowledge of the manufactured dimensions of the machine.
- the machine is a hexapod machining center
- These manufactured dimensions are preferably accurate to within ⁇ Vz inch of the actual values which will finally be determined.
- 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 21 5 would be [-1 7.7, -38.2, -23.6] for the lower pivot location 215a and [-40.9, 10.23, 23,6] for the upper pivot location 21 5b.
- 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.
- Each displacement of the upper platform is defined with respect to a reference position having coordinates [0, 0, 0, 0, 0, 0] .
- 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.
- 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;
- 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" .
- 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.
- 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.
- 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.
- 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 balls 705, for a total of three hundred fifty precision movements per ball run.
- 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 last 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
- 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 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.
- 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.
- 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]).
- Step 91 5 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.
- Step 920 the processor 430 actuates the servo system.
- 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 21 5 to the new actuator length.
- Measuring transducer 465 feeds back data to the digital signal processors 440 in order to ensure the actuator 21 5 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.
- Step 920 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.
- 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.
- 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.
- processor 430 returns control to
- Step 910 where the above-described process is repeated using the adjusted platform command data.
- the platform command data is continuously adjusted until the voltages output from sensors 605 are reduced to within the above- mentioned displacement limits.
- 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).
- Step 955 these differences are output as "change-in-actuator- length data" and control of the servo system is completed at Step 960.
- 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 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.
- a line generated by a laser interferometer instead of a ball plate as the artifact.
- the calibration run would comprise a "laser run” instead of a "ball run”.
- 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 21 5a and
- 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 (e.g., LAN or WAN) .
- the computer system either the microcomputer 41 0 or the above-mentioned separate computer system
- the platform simulator is the personal computer included in the CNC 8000 mentioned above.
- the platform simulator receives the change-in-actuator-length data in Step 1005.
- 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, 0].
- Step 1 01 5 the platform simulator makes initial estimates of the pivot locations in the lower and upper platforms, 21 5a and 21 5b, 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.
- 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- iength datapoint. The steps taken to perform this simulation of platform movement are shown in detail in FIGURE 1 1 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
- Step 1 025 the platform simulator subtracts the seven estimated ball locations of Step 101 0 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".
- Step 1 030 the ball locations and pivot locations are adjusted in order to reduce the cost function.
- 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.
- D-F-P Davidon- Fletcher-Powell
- 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.
- 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.
- 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.
- 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 1 025, 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.
- 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.
- 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 1 055, and the simulation analysis ends with Step 1 060.
- 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 1 1 . 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.
- 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.
- 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 1 100, the platform simulator first receives a set of pivot locations and estimated ball locations in Step 1 105.
- the pivot locations are used in Step 1 1 10 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.
- the platform simulator assigns or receives an estimate of the new platform position.
- the reference position may be an acceptable initial estimate of the new platform position.
- the platform simulator transforms the platform reference position (and the upper platform reference pivot locations) to the estimated new platform position.
- the Pythagorean theorem is used to calculate the distance between each pair of lower platform actuator pivots and transformed upper platform actuator pivots.
- Step 1 130 the actuator length errors are calculated as the sum of the squares of the differences between the estimated actuator lengths from Step 1 125 and the actual actuator lengths from Step 1 1 10.
- Step 1 135 the platform simulator adjusts the estimated new platform position to reduce the actuator length error defined in Step 1 130. 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.
- Step 1 140 the platform simulator compares the amount of adjustment required in Step 1 135 to a predetermined limit. If the adjustment is more than the predetermined limit, the platform simulator returns control to Step 1 1 15, and Steps 1 1 15-1 140 are repeated.
- the adjustment required in Step 1 140 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 1 10.
- the predetermined adjustment limit used in Step 1 140 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-6.
- 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
- 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 1 105.
- 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.
- 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.
- the present invention provides for the calibration of a positioning device without the use of extremely precise pivot locations for the movable platform.
- 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.
- the calibration technique of the present invention ensures very high precision for a positioning device without the high cost of other conventional calibration systems.
- the microcomputer 410 controls hexapod machine center such that the upper platform 205 moves along a pre-programmed path.
- the microcomputer 41 0 moves the upper platform by sending platform command data in the form of a new desired position.
- 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 1 2-1 7. In FIGURES 12-1 7 below, a detailed explanation will be presented as to how the platform command data is transformed into precise actuator movement.
- the microcomputer 410 sends the platform command data [X, Y, Z, A, B, C] * to a trajectory generator 1 205 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.
- 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 1 205.
- 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).
- trajectory generator 1 205 outputs the commanded relative position, velocity, and acceleration to both a reaction feedforward calculator 1210 and a kinematics calculator 1 21 5.
- the reaction feedforward calculator 1 210 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 21 5 to produce the relative accelerations commanded by trajectory calculator
- the reaction feedforward calculator 1 210 outputs the actuator forces F* to the kinematics calculator 1 21 5 and to a servo feedback system 1225.
- Kinematics calculator 1 215 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 1 10 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 1 5.
- Commanded actuator lengths L* are output to the servo feedback system 1 225 and to a differentiator 1 220.
- Differentiator 1 220 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 1 225.
- Servo feedback system 1 225 provides commanded torque T* to the control stage 443 of each actuator 21 5 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 1 225.
- servo feedback system 1 225 uses the commanded actuator forces F*, the commanded actuator lengths L*, the derivative of the commanded actuator lengths dL*7dt, and the feedback from each control stage 443 to determine the commanded torque T* .
- reaction feedforward calculator 1 210 the reaction feedforward calculator 1 210, the kinematics calculator 1 21 5, and the differentiator 1 220 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.
- FIGURE 1 a general software flowchart of the steps taken to perform the reaction feedforward calculation performed by the reaction feedforward calculator 1 21 0 is shown.
- Step 1 300 the commanded relative position, velocity, and acceleration are received from the trajectory generator 1205 at Step 1305.
- Step 1 310 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.
- the system of equations is given in matrix form as:
- CPmat*F B (1 )
- CPmat is a coupling matrix having the six columns of the top three rows filled with the unit vectors for each actuator 21 5, 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.
- 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 the B vector are the rectilinear forces in each of three directions X, Y, and Z, which are calculated as follows:
- 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 B vector. This is shown by equation (3) :
- the actuator forces are output from reaction feedforward calculator 1 210.
- 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.
- Step 1 325 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.
- Step 1400 the steps required to calculate the actuator forces F* in Step 1 310 are described starting at Step 1400.
- the coupling matrix CPmat and the B vector must be built in order to solve the equation for the actuator forces vector F.
- 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.
- 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 21 5 and the associated moment arm.
- Step 141 5 PENTIUM processor 440 obtains the relative angular accelerations from the trajectory generator 1 205.
- Step 1 420 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.
- Tlg n represents the six unit torque vectors for the lower platform 200 associated with each of 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.
- Step 1 425 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 + R T «Rlc»lli •Rlc ⁇ »foot_ang_tot (5) where maccc_ang is the commanded relative angular acceleration from generator 1 205, 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.
- Step 1435 digital signal processor 440 builds the B vector according to the above-described values.
- 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
- a signal flow diagram of the kinematics calculator 1 21 5 of FIGURE 1 2 is illustrated.
- Input into kinematics calculator 1 21 5 is the commanded position vector p (which contains six position commands for X, Y, Z, A, B, and C) from trajectory generator 1 205 and the actuator forces F* .
- Kinematics calculator 1 21 5 uses the rotational commanded position data [A, B, C] in a rotation matrix generator 1 505 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 1 525 and then input to a multiplier 1 510 which rotates the pivot vectors by R.
- the kinematics calculator 1 21 5 then adds the linear command position data [X, Y, Z] from trajectory generator 1 205 to the rotated pivot position data in adder 1 515.
- the kinematics calculator 1 21 5 uses the actuator forces F* and the actuator unit vectors in a pivot deflection calculator 1 520 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 1 6.
- the upper platform pivot migrations are added to the upper platform pivot location constants in adder 1 525.
- the lower platform pivot location constants which represent the pivot location vectors from 1055 are added to the lower platform pivot migrations in adder 1 530.
- the upper and lower platform pivot location vectors are sent to the actuator length calculator 1 540, which calculates the magnitude of the actuator vectors by the Pythagorean theorem. This magnitude is the actuator length.
- Kinematics calculator 1 21 5 also uses a scalar universal joint compliance calculator 1 545 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 1 550. The result is the commanded actuator lengths L* output from kinematics calculator 1 21 5.
- FIGURE 1 6 a flowchart of the steps taken by the pivot deflection calculator 1520 to collect compliance information and build a machine compliance model are shown.
- the accuracy of the hexapod machining center 1 10 is determined by how accurate the microcomputer 410 determines the plurality of pivot locations 21 5a and 215b. Also as described above, the pivot locations 21 5a and 21 5b 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.
- a finite element model of the upper platform is constructed in Step 1 605 using an IBM workstation running the CAEDS finite element software, which is a product of the Structural Dynamics Research Corporation.
- 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 21 5b 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 21 5b 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.
- Step 1 610 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 21 5b in the upper platform 205 are then recorded in Step 1 61 5, where each cartesian component is recorded at each of the six pivots 21 5b.
- Step 1 620 causes the process to repeat Steps 1 610 and 1 61 5 for independently applied accelerations in each cartesian direction.
- Step 1 625 After recording the responses to the upper platform components of acceleration, a force node is chosen in Step 1 625, and a unit force is applied to the chosen force node in a single cartesian direction X, Y, or Z in Step 1 630.
- the deflection responses, or "pivot migrations", of the actuator pivots 21 5b in the upper platform are recorded in Step 1 635, where each cartesian component is recorded at each of the six actuator pivots in the upper platform 205.
- Step 1 640 causes the process to repeat Steps 1 630 and 1 635 for independently applied unit forces in each cartesian direction, still applied at the chosen node.
- Step 1 645 causes Steps 1 625 through 1 640 to be executed for all of the nodes at which unit forces are to be applied: six actuator pivots 21 5b and three counterbalance pivots 250.
- the analysis of the lower platform 200 begins at Step 1 650.
- Step 1 655 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.
- the finite element model of the lower platform includes a plurality of nodes at which forces may be applied or displacements may be recorded.
- 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 21 5a in the lower platform 200.
- Steps 1 625 through 1 645 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 21 5a in the lower platform 200 are recorded.
- Step 1 660 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 1 6 is used in pivot deflection calculator 1 520 of the hexapod machining center 1 10.
- 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).
- 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 1 520 of FIGURE 1 5.
- 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, 0].
- the migrations are added to the actuator pivot coordinates at the reference position in Step 1 525 of FIGURE 15.
- FIGURE 1 7 a signal flow diagram of the servo feedback system 1 225 of FIGURE 1 2 is illustrated.
- Input into the servo feedback system 1 225 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 1 71 0 in order to develop the output commanded torque T* .
- the digital signal processor 440 feeds the commanded actuator lengths L* into an adder 1 71 5 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.
- PID proportional integral derivative
- the three torques are then added in adder 1 720 and the result is the second torque of the three torques added in adder 1 71 0.
- the integral gain Ki is for low frequency enhancement, or stiffness enhancement
- the derivative gain Kd is for adding dampening stability.
- the IBM workstation also feeds the commanded actuator lengths L* into a transformer 1725, which transforms the commanded actuator lengths L* into commanded angular position ⁇ * of the actuator screw.
- the commanded angular position ⁇ * is then subtracted from the fed back signal of the encoder 445 angular position ⁇ in subtractor 1 730 in order to calculate an angular error.
- the angular error is then give a proportional gain Kp and a derivative gain S and Kd for similar reasons as stated above.
- the resulting torques are 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 1 740.
- 440 also inputs the derivative actuator lengths dL*/dt into a transformer 1 745 in order to convert it into angular velocity.
- the angular velocity is then multiplied by a gain for overcoming viscous friction of the motor 450 and the ball screw and the resulting torque is also added in 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 1 740.
- the resulting torque of adder 1740 is the third of three torques added to complete the commanded torque T* to the servo amps 445.
- the compliance compensation technique of the present invention utilizes "clean" force data generated by the reaction feedforward calculator 1 210.
- the same compliance compensation technique can be used with other data.
- the motor torque feedback data can be used for this purpose, although it is generally a very noisy signal and, accordingly, makes it more difficult to use.
- Appendix B sets forth the detailed motion equations for the reaction feedforward calculator 1 210
- Appendix C sets forth the derivation of the B vector described above. Both of these appendices are attached hereto and incorporated herein by reference.
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Health & Medical Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Orthopedic Medicine & Surgery (AREA)
- Automatic Control Of Machine Tools (AREA)
- Manipulator (AREA)
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US6749397P | 1997-12-01 | 1997-12-01 | |
US67493P | 1997-12-01 | ||
PCT/US1998/025450 WO1999028097A1 (en) | 1997-12-01 | 1998-12-01 | System and method for calibrating a hexapod positioning device |
Publications (1)
Publication Number | Publication Date |
---|---|
EP1034066A1 true EP1034066A1 (de) | 2000-09-13 |
Family
ID=22076349
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
EP98960594A Withdrawn EP1034066A1 (de) | 1997-12-01 | 1998-12-01 | Vorrichtung und verfahren zur kalibrierung eines hexapod-positionierungsgerätes |
Country Status (4)
Country | Link |
---|---|
EP (1) | EP1034066A1 (de) |
CA (1) | CA2312897A1 (de) |
TW (1) | TW396096B (de) |
WO (1) | WO1999028097A1 (de) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107065558A (zh) * | 2017-05-05 | 2017-08-18 | 上海交通大学 | 基于机身姿态角度校正的六足机器人关节角度标定方法 |
CN111531532A (zh) * | 2020-04-03 | 2020-08-14 | 华南理工大学 | 一种基于旋量理论的机器人攀爬运动速度建模方法 |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE10209141A1 (de) | 2002-03-01 | 2003-09-18 | Siemens Ag | Verfahren zur Kalibrierung von parallelkinematisch in einem Bewegungsraum bewegten Maschineneinheiten in Werkzeugmaschinen und Handhabungsgeräten |
DE20303367U1 (de) * | 2003-02-28 | 2003-07-24 | Faude, Dieter, 71116 Gärtringen | Roboter für Werkzeuge |
JP4960038B2 (ja) * | 2006-08-09 | 2012-06-27 | オークマ株式会社 | パラレルメカニズム機械の制御方法及び制御装置 |
DE102007010067B3 (de) * | 2007-02-28 | 2008-07-03 | Technische Universität Braunschweig Carolo-Wilhelmina | Singularitätsbasiertes Maschinenprüf- und Kalibrierverfahren |
EP2404712A1 (de) * | 2010-07-07 | 2012-01-11 | ABB Research Ltd. | Roboter mit zwei Armen und Verfahren zum Steuern eines Roboters mit zwei Armen |
ES2448215B1 (es) * | 2012-07-24 | 2015-04-01 | Fundación Tekniker | Método de calibración de una máquina de cinemática paralela portátil |
DE102013101095B4 (de) * | 2013-02-04 | 2016-12-15 | Johannes Gottlieb | Verfahren und Anordnung zur Korrektur von Posenfehlern einer Kinematik sowie ein entsprechendes Computerprogramm und ein entsprechendes computerlesbares Speichermedium |
FR3042590B1 (fr) * | 2015-10-15 | 2017-11-10 | Micro-Controle - Spectra-Physics | Procede et systeme de compensation d’erreurs de precision d’un hexapode. |
DE102018124898A1 (de) * | 2018-10-09 | 2020-04-09 | Physik Instrumente (Pi) Gmbh & Co. Kg | Verfahren und Anordnung zur hochgenauen Kalibrierung einer Parallelkinematik |
DE102018126022B3 (de) | 2018-10-19 | 2019-12-12 | Physik Instrumente (Pi) Gmbh & Co. Kg | Anordnung zur Positionierung und Positionserfassung einer verformbaren Lasttragplatte |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5538373A (en) * | 1992-02-20 | 1996-07-23 | Giddings & Lewis, Inc. | Machine tool vibration isolation system |
-
1998
- 1998-12-01 WO PCT/US1998/025450 patent/WO1999028097A1/en not_active Application Discontinuation
- 1998-12-01 CA CA002312897A patent/CA2312897A1/en not_active Abandoned
- 1998-12-01 EP EP98960594A patent/EP1034066A1/de not_active Withdrawn
-
1999
- 1999-01-20 TW TW87120027A patent/TW396096B/zh not_active IP Right Cessation
Non-Patent Citations (1)
Title |
---|
See references of WO9928097A1 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107065558A (zh) * | 2017-05-05 | 2017-08-18 | 上海交通大学 | 基于机身姿态角度校正的六足机器人关节角度标定方法 |
CN107065558B (zh) * | 2017-05-05 | 2019-09-27 | 上海交通大学 | 基于机身姿态角度校正的六足机器人关节角度标定方法 |
CN111531532A (zh) * | 2020-04-03 | 2020-08-14 | 华南理工大学 | 一种基于旋量理论的机器人攀爬运动速度建模方法 |
Also Published As
Publication number | Publication date |
---|---|
CA2312897A1 (en) | 1999-06-10 |
WO1999028097A1 (en) | 1999-06-10 |
TW396096B (en) | 2000-07-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO1999028095A1 (en) | System and method for compensating for compliance of a hexapod positioning device | |
Martins et al. | Approaches for dynamic modelling of flexible manipulator systems | |
US4362977A (en) | Method and apparatus for calibrating a robot to compensate for inaccuracy of the robot | |
EP1718924B1 (de) | Robotisches messsystems mit einem tragenden gelenkarm und einem messarm | |
Bonev et al. | A new method for solving the direct kinematics of general 6-6 Stewart platforms using three linear extra sensors | |
Conrad et al. | Robotic calibration issues: Accuracy, repeatability and calibration | |
Lightcap et al. | Improved positioning accuracy of the PA10-6CE robot with geometric and flexibility calibration | |
WO1999028097A1 (en) | System and method for calibrating a hexapod positioning device | |
US5946449A (en) | Precision apparatus with non-rigid, imprecise structure, and method for operating same | |
Whitcomb et al. | Adaptive model-based hybrid control of geometrically constrained robot arms | |
Youcef-Toumi et al. | High-speed trajectory control of a direct-drive manipulator | |
Mooring et al. | The effect of kinematic model complexity on manipulator accuracy | |
Rauf et al. | Experimental results on kinematic calibration of parallel manipulators using a partial pose measurement device | |
WO2005050134A1 (en) | Method of error compensation in a coordinate measuring machine with an articulating probe head | |
JP3326175B2 (ja) | 産業用ロボットの運動軸の較正方法及び装置 | |
CN113195176B (zh) | 制造系统及方法 | |
WO1998042482A1 (en) | A method for determining load parameters for a manipulator | |
JPH0445841B2 (de) | ||
JPH0445842B2 (de) | ||
EP1035952A1 (de) | Vorrichtung und verfahren zur verbesserung der dynamische genauigkeit eines hexapod-positionierungsgerätes | |
JPH03117580A (ja) | ロボットモデル同定装置 | |
Trevisani | Feedback control of flexible four-bar linkages: a numerical and experimental investigation | |
JP4311621B2 (ja) | 6自由度位置・姿勢測定装置による機械の運動誤差補正方法 | |
JPS6228808A (ja) | ロボツト座標系の較正方法 | |
JPH0433006A (ja) | ロボツトシステムの制御方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PUAI | Public reference made under article 153(3) epc to a published international application that has entered the european phase |
Free format text: ORIGINAL CODE: 0009012 |
|
AK | Designated contracting states |
Kind code of ref document: A1 Designated state(s): CH DE FR GB IT LI SE |
|
17P | Request for examination filed |
Effective date: 20000703 |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: THE APPLICATION IS DEEMED TO BE WITHDRAWN |
|
18D | Application deemed to be withdrawn |
Effective date: 20010702 |