WO2024023301A1 - Machine de positionnement par coordonnées - Google Patents

Machine de positionnement par coordonnées Download PDF

Info

Publication number
WO2024023301A1
WO2024023301A1 PCT/EP2023/071007 EP2023071007W WO2024023301A1 WO 2024023301 A1 WO2024023301 A1 WO 2024023301A1 EP 2023071007 W EP2023071007 W EP 2023071007W WO 2024023301 A1 WO2024023301 A1 WO 2024023301A1
Authority
WO
WIPO (PCT)
Prior art keywords
machine
sensed
relative
tool
orientation
Prior art date
Application number
PCT/EP2023/071007
Other languages
English (en)
Inventor
Julius Benjamin DUPREZ
Jean-Louis Grzesiak
Original Assignee
Renishaw Plc
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Renishaw Plc filed Critical Renishaw Plc
Publication of WO2024023301A1 publication Critical patent/WO2024023301A1/fr

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/1679—Programme controls characterised by the tasks executed
    • B25J9/1692—Calibration of manipulator
    • 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/39007—Calibrate by switching links to mirror position, tip remains on reference point
    • 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/39015—With different manipulator configurations, contact known sphere, ballbar
    • 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/39026—Calibration of manipulator while tool is mounted
    • 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/40545—Relative position of wrist with respect to end effector spatial configuration

Definitions

  • the present invention relates to a coordinate positioning machine.
  • the present invention relates in particular, but not exclusively, to a system for calibrating or otherwise characterising at least some aspect of a coordinate positioning machine.
  • the present invention is particularly applicable, for example, to a non-Cartesian type of coordinate positioning machine, such as a hexapod, measurement arm or articulated robot.
  • Articulated robots are commonly used in a wide variety of manufacturing applications such as assembly, welding, gluing, painting, picking and placing (e.g. for printed circuit boards), packaging and labelling, palletizing, and product inspection. They benefit from being versatile and rugged, with a large reach and a high degree of flexibility of movement, making them ideal for use in a production environment.
  • FIG. 1 An articulated robot (or just “robot” for short) is illustrated schematically in Figure 1 of the accompanying drawings, comprising an articulated robot arm 1 extending from a fixed base 2 to a moveable flange 3, with the flange 3 supporting a tool (or end effector) 4.
  • the tool 4 in Figure l is a drilling tool.
  • the flange 3 is provided with a coupling which allows for the tool 4 to be conveniently interchangeable, so that a variety of tools or end effectors can be employed depending on the application concerned; examples include grippers, vacuum cups, cutting tools (including both mechanical and laser cutting tools), drilling tools, milling tools, deburring tools, welding tools and other specialized tools.
  • the flange 3 is also referred to more generally as the “head” of the robot arm 1, with the fixed base 2 being the “base”, and with the robot arm 1 being controlled to move the head relative to the base by commands from a machine controller 8.
  • the arm 1 comprises a plurality of segments 5 connected by a mixture of transverse rotary axes 6 and inline (or longitudinal) rotary axes 7, forming a mechanical linkage from one end to the other.
  • An additional inline rotary axis 7 (not shown in Figure 1) could also be provided between the final transverse rotary axes 6 and the flange 3, to provide convenient rotation of the tool 4 around its longitudinal axis, making a total of seven rotary axes.
  • FIG. 1 Another common arrangement is shown in the arm 1 of Figure 2, which includes the additional inline rotary axis 7 mentioned above, between the final transverse rotary axis 6 and the flange 3, and which also omits the second inline rotary axis 7 from Figure 1 (in series order from the base end to the head end), thereby making a total of six rotary axes.
  • the tool 4 in Figure 2 is a gripper.
  • the arm 1 of Figure 1 is a schematic representation of the well-known IRB 140 six-axis industrial robot by ABB Robotics.
  • the final three axes 6, 7 form a “wrist” of the robot arm 1, with the centre of the wrist being at the centre of the final transverse rotary axis 6.
  • the centre of the wrist is invariant to rotation of the three rotary axes 6, 7 of the wrist, such that operation of the three rotary axes 6, 7 changes the orientation of whatever is attached to the wrist (in this case the gripper 4) without changing the position of the wrist centre, with the first three rotary axes 6, 7 of the robot arm 1 determining the position of the wrist centre.
  • the wrist may be readily detachable from the remainder of the arm 1.
  • the articulated robot arms 1 of Figures 1 and 2 are examples of a non-Cartesian coordinate positioning machine because, in contrast to a Cartesian machine such as a traditional three- axis (X, Y, Z) coordinate measuring machine (see for example Figure 1 of PCT/GB2020/052593), its axes are not arranged orthogonally according to a Cartesian coordinate system.
  • the arms 1 of Figures 1 and 2 are also examples of a “serial kinematic” coordinate positioning machine, because their axes of movement are arranged in series.
  • such a machine is similar to a traditional three-axis Cartesian coordinate measuring machine, which is also an example of a “serial kinematic” coordinate measuring machine, and is to be contrasted with a “parallel kinematic” coordinate positioning machine such as a hexapod whose axes of movement are arranged instead in parallel.
  • Calibration of any type of non-Cartesian machine is a significant challenge, and particularly so for an articulated arm such as that illustrated in Figures 1 and 2 having a plurality of rotary axes that are: (a) arranged in series; (b) are not fixed relative to one another; and (c) that can combine in complicated ways to position the tool in the working volume.
  • Calibration of a Cartesian machine is typically more straightforward, because such a machine has three well-defined axes that are fixed relative to one another in an orthogonal arrangement, with each axis being largely independent of another. With an articulated robot, the position and orientation of each axis depends on the position and orientation of each other axis, so that the calibration will be different for each different machine pose.
  • these machine parameters might include various geometrical parameters such as the length of each of the segments 5 and the rotation angle offset of each of the rotary axes or joints 6, 7 (with the angle from the encoder plus the calibrated offset giving the actual angle), as well as various mechanical parameters such as joint compliance and friction.
  • the machine parameters might also include the offset coordinates of the working point of the tool, such as the tip of the drilling tool 4 of Figure 1, relative to the head or flange 3. In this respect, the offset of the working point (or tool centre point) is an important piece of information, and this will be discussed in more detail below.
  • Robot arms such as depicted in Figures 1 and 2 are most typically used for positioning tasks, and are not typically considered to be sufficiently accurate for measurement tasks. However, the present applicant has also appreciated the desirability of a calibration routine that can be performed relatively quickly to find (or re-find) the offset of a measurement probe supported on a robot arm.
  • a method of determining an offset of a feature of or associated with a tool is defined relative to a first part of a coordinate positioning machine to which the tool is coupled or attached, for example relative to a point or frame of reference on or associated with the first part.
  • the method is characterised by determining the offset from: (a) values for the position and orientation of the first part relative to a second part of the machine for each of a plurality of sensed states for the first part, in each of which sensed states the feature is in a sensed position; and (b) information concerning or relating to where the sensed positions are at least relative to one another.
  • the offset of the tool can beneficially be determined using only values for the position and orientation of the part of the coordinate positioning machine to which the tool is coupled, for example the head or flange of a robot arm, without having to know anything about how the remainder of the machine is arranged, or anything about the geometry of the machine or the parametric model that is used to characterise the geometry of the machine (and which would be used by the machine controller to derive values for the position and orientation of the part of the machine to which the tool is coupled). All that is required in an embodiment of the present invention are values for the position and orientation of the part to which the tool is coupled, along with knowledge of where the sensed positions are relative to one another.
  • the information may be or may have been obtained by measuring the sensed positions relative to one another.
  • the information may comprise measurements of the sensed positions, at least relative to one another, or measurements from which it can be determined where the sensed positions are relative to one another.
  • the measurements may be taken using a non-contact measurement system such as a camera-based system or from a contact measurement system such as with a tool setter probe.
  • the method may comprise measuring the sensed positions relative to one another.
  • the information may be or may have been obtained by constraining the sensed positions relative to one another.
  • the sensed positions may be or may have been constrained relative to one another by moving the feature into a sensing relationship with an artefact having a known geometry, supported on the second part.
  • the artefact may have a spherical geometry or an at least part-spherical geometry.
  • the method may comprise constraining the sensed positions relative to one another.
  • the tool may be a measurement probe.
  • the method may comprise using the measurement probe to detect when the feature is in each of the sensed positions.
  • the method may comprise using the measurement probe to detect when the first part is in each of the sensed states.
  • the measurement probe may be a contact probe.
  • the feature may be (or may be at or within) a tip of the measurement probe or of a stylus of the measurement probe.
  • the method may comprise detecting that the feature is in a sensed position or that the first part is in a sensed state when the measurement probe has moved into a sensing relationship with the artefact.
  • the feature of or associated with the tool may be a point of interest of or associated with the tool, and in particular may be a tool centre point of the tool.
  • the coordinate positioning machine may be a robot arm.
  • a particularly beneficial embodiment of the present invention is where the method is used to determine a tool centre point of a measurement probe that is supported on a robot arm, using an artefact placed in the working volume of the robot arm.
  • a method embodying the present invention is straightforward to perform, making it quicker and easier to set up a robot arm for measurement tasks using a robot arm (thereby in effect creating a measurement arm), and to perform the method frequently to maintain the measurement accuracy of the robot arm (or measurement arm).
  • a robot arm is not typically considered for measurement tasks at least in part because of its serial kinematic architecture in which positioning errors tend to accumulate along the serial kinematic chain of links and joints, but an embodiment of the present invention makes it far more convenient to do so.
  • the present invention is not limited to the machine being a robot arm, nor is it limited to the tool being a measurement probe.
  • the machine may be any type of non-Cartesian and/or serial kinematic and/or parallel kinematic coordinate positioning machine, such as a hexapod or a robot arm, and the tool may be any type of tool, such as a drilling tool or welding tool or other type of mechanical tool or gripper.
  • a robot arm may also be referred to as (and is equivalent to) an articulated robot or an articulated robot arm.
  • the method may comprise controlling the machine to move the first part relative to the second part into the plurality of different sensed states.
  • the machine may be controlled (or may at least be caused to be controlled, for example by setting up a controller appropriately) to move the first part relative to a second part of the machine into the plurality of different sensed states for the first part.
  • the feature is in a sensed position relative to the second part.
  • a sensed state may be characterised by a position and orientation of (or by position and orientation values for) the first part relative to a second part.
  • the sensed positions may be constrained or measured relative to one another and/or relative to the second part, and these may be denoted relative constraints or measurements.
  • the sensed positions may be constrained relative to one another and/or relative to the second part by moving the feature into a sensing relationship with an artefact supported on the second part, with the artefact having a known geometry.
  • the relative constraints mentioned above would be provided by or based on the known geometry of the artefact.
  • the offset may then be determined based on (or taking account of) the known geometry of the artefact.
  • the method may comprise the step of constraining or measuring the sensed positions relative to one another and/or relative to the second part.
  • the position and orientation values may specify the position and orientation of the first part relative to the second part independently of and/or without reference to the state and/or geometry and/or position and/or orientation of any other part of the machine that might affect and/or influence the position and orientation of the first part relative to the second part (for example the intermediate joints and links arranged between the base end and the head end of the serial kinematic chain of a robot arm).
  • the position and orientation values may comprise numerical values for the position and orientation of the first part relative to the second part for each of the sensed states.
  • the offset is determined using only the position and orientation values and the information relating to where the sensed positions are relative to one another. It may be that the offset is determined from the position and orientation values without knowledge of and/or without reference to the machine geometry or a model, such as a parametric model, which characterises the geometry of the machine.
  • the position and orientation values for each of the sensed states may be received from an external source, for example from a machine controller that is used to control the machine to move the first part into the plurality of different sensed states. These position and orientation values may then be used to determine the offset mentioned above, based on (or taking account of) the relative constraints or measurements.
  • the method may comprise requesting the position and orientation values from the external source (e.g. machine controller).
  • the position and orientation values may be or may have been derived from a model, such as a parametric model, which characterises the geometry of the machine.
  • the external source mentioned above such as the machine controller
  • the method does not itself derive the position and orientation values and/or does not itself rely on any knowledge of the machine geometry (or a parametric model of the machine) to derive the position and orientation values, but instead receives the position and orientation values from elsewhere.
  • the method does not include a step of deriving the position and orientation values from a model, such as a parametric model, which characterises the geometry of the machine
  • the sensed states may comprise a plurality of different positions for the first part relative to the second part.
  • the sensed states may comprise a plurality of different orientations for the first part relative to the second part.
  • the sensed states may comprise a plurality of different orientations for the first part relative to the second part for at least one of (or at least some of, or each of) the sensed positions for the feature.
  • the sensed states may comprise at least three or at least four different orientations for the first part relative to the second part for each of the sensed positions for the feature.
  • the sensed states may comprise at least three or at least four different sensed positions for the feature.
  • the method may comprise moving the first part into the sensed states based on a current estimate for the offset.
  • the method may comprise using the position and orientation values to update or optimise the current estimate for the offset to provide a closer correspondence to the relative constraints or measurements.
  • the machine may comprise a plurality of joints or axes arranged in series between the first and second parts.
  • the joints or axes may be rotary and/or linear joints or axes.
  • the machine may be adapted to provide relative movement between the first and second parts in a plurality of degrees of freedom.
  • the machine may be provided with a plurality of degrees of freedom for relative movement between the first and second parts.
  • the first part may be a moving part or head of the machine and the second part may be a fixed part or base of the machine. Alternatively, the first part may be a fixed part or base of the machine and the second part may be a moving part or head of the machine.
  • a program which, when run by a computer or a calibration unit or some other type of processing unit, causes the computer or calibration unit or processing unit to perform a method according to the first aspect of the present invention (or at least any steps of the method that can be performed or caused to be performed by the computer or calibration unit or processing unit).
  • a medium having stored therein program instructions for controlling a computer or a calibration unit or some other type of processing unit to perform a method according to the first aspect of the present invention (or at least any steps of the method that can be performed or caused to be performed by the computer or calibration unit or processing unit).
  • a calibration unit or some other type of processing unit configured to perform a method according to the first aspect of the present invention (or at least any steps of the method that can be performed or caused to be performed by the calibration unit or processing unit).
  • a machine configured to perform a method according to the first aspect of the present invention.
  • Figure 1 is a schematic illustration of a coordinate positioning arm in the form of an articulated robot, and carrying a drilling tool;
  • Figure 2 is a schematic illustration of an articulated robot having a different arrangement of rotary axes to that of Figure 1, and carrying a gripping tool;
  • Figure 3 is a schematic diagram for use in illustrating and describing in more detail the concept of a tool centre point
  • Figure 4 schematically illustrates a robot moving an attached tool in such a way that the tool centre point should remain in the same position
  • Figure 5 shows a method embodying the present invention in the form of a flowchart, the method in this embodiment being for determining the offset of a tool centre point of a measurement probe carried on a robot arm;
  • Figure 6 is a schematic illustration of a robot arm carrying a measurement probe, along with a calibration artefact and a calibration unit for implementing the method of Figure 5;
  • Figure 7 shows the robot arm of Figure 6 when the head of the robot arm has been moved into a sensed state in accordance with the method of Figure 5;
  • Figures 8 to 11 illustrate the head of the robot arm being moved into a plurality of different sensed states in accordance with the method of Figure 5;
  • Figures 12 to 14 show a simplified two-dimensional representation of the head of the robot arm being moved into a plurality of different sensed states
  • Figure 15 show a highly simplified two-dimensional representation of the head of the robot arm being moved into two different sensed states
  • Figure 16 shows the tool centre point offset values determined based on the sensed states and constraints depicted in Figure 15;
  • Figure 17 shows an alternative arrangement embodying the present invention, with the measurement probe is supported on the fixed base and the calibration artefact supported on the moving head of the robot arm;
  • Figure 18 illustrates that an external position measurement device can be used instead of a calibration artefact in an embodiment of the present invention.
  • Figure 19 illustrates the possibility that a toolsetter can be used as the external measurement device.
  • FIG 3 shows a schematic representation of a tool 40 attached to a flange 3 of a robot arm of a type as described above with reference to Figures 1 and 2.
  • the tool 40 has an elongate member 42 that is mounted at an angle to the flange 3 (the mounting angle may be deliberate or it could be inadvertent), with a tip 44 at a distal end of the elongate member 42.
  • the centre 46 of the tip 44 is a particular point of interest because it would typically be the working point of the tool 40, or some other important reference point associated with the tool 40, and in a robot architecture this is commonly referred to as the tool centre point or TCP of the tool 40.
  • the location of the tool centre point 46 relative to the part of the robot to which the tool 40 is attached, i.e. the flange 3 in this case, is an important piece of information.
  • Specifying the coordinates or offset (X, Y, Z) of the tool centre point 46 is a key step when setting up any robot for operational use.
  • the tool centre point 46 is the point in relation to which all robot positioning is defined, and constitutes the origin of the tool coordinate system.
  • the tool centre point 46 might correspond, for example, to the tip of an arc welding gun, the centre of a spot welding gun, the end of a grading tool, or the tip of a drilling tool such as that shown in Figure 1.
  • the location of the tool centre point 46 will therefore depend on the application concerned.
  • the tool centre point 46 that will be jogged around or moved to the desired target position with the desired tool orientation.
  • the first three rotary axes of the robot arm can be controlled to set the position of the wrist centre
  • the three rotary axes of the wrist can be used to change the orientation of the flange 3 relative to the first three axes
  • the position of the key point of the working tool 40 relative to the flange 3 can be determined from the tool centre point (TCP) information.
  • TCP tool centre point
  • Figure 4 schematically illustrates the robot arm 1 being instructed by the controller 8 to move the tool 40 so that the tool centre point 46 of the tool 40 remains in the same position, or at least should ideally remain in the same position.
  • a test is typically performed to verify that the tool centre point 46 has been correctly identified and is sometimes known as a “tool orientation test”.
  • the objective is to assess the robot’s accuracy (and the accuracy of the coordinates X, Y, Z of the tool centre point 46 as shown in Figure 3) by measuring its ability to rotate around the tool centre point 46 that is programmed into the controller 8, ideally without any actual movement of the tool centre point 46 being apparent when the test is being performed.
  • the aim of an embodiment of the present invention to determine the position of the TCP rather than merely verify the position of the TCP as is done with the tool orientation test, the aim of an embodiment of the present invention to determine the position of the TCP.
  • the most common method currently is the pin-to-pin method in which the operator visually aligns two pins with different orientations, one of which is fixed on the machine base and the other of which is moveable by the robot to reference the TCP, with the robot being controlled manually by an operator. This is a convenient method, but it is relatively inaccurate because it depends to a large extent on the skill and experience of the operator; it also requires the tool 40 to be removed and replaced by the pin.
  • an embodiment of the present invention is particularly, though not exclusively, intended to be applicable where the working tool 4, 40 of Figures 1 to 3 is a surface sensing device such as a measurement probe, which is adapted to sense the surface of a workpiece and to determine the coordinates of points on the workpiece.
  • a surface sensing device such as a measurement probe, which is adapted to sense the surface of a workpiece and to determine the coordinates of points on the workpiece.
  • Such surface sensing devices are well known and will not be described in detail here. They can be contact or non-contact surface sensing devices, optical or mechanical.
  • the calibration system of Figure 6 includes a robot arm 1 that is generally equivalent to that described above with reference to Figures 1 and 2, having a plurality of segments 5 connected by a combination of transverse rotary axes 6 and inline rotary axes 7.
  • the robot arm 1 of Figure 6 is carrying a measurement probe 10 rather than a drilling tool or gripper, and the calibration system of Figure 6 also comprises a calibration artefact 20 and a calibration unit 30.
  • the calibration artefact 20 has a known geometry, in this example having a spherical form with a diameter that has been measured accurately in advance, for example using a calibrated coordinate measuring machine or CMM under controlled conditions.
  • the measurement probe 10 depicted in Figure 6 has an elongate stylus 12 and a surface-contacting stylus tip 14 at a distal end of the stylus 12, with the tool centre point 16 being defined at the centre of the stylus tip 14, which is equivalent to what is shown in the schematic illustration of the tool 40 in Figure 3.
  • the stylus tip 14 defines the key point of interest of the measurement probe 10 (the point of interest being the tool centre point 16), just as the tip of the drilling tool 4 of Figure 1 defines the key point of interest (tool centre point) for such a tool.
  • the method of Figure 5 is performed to determine the coordinates (or offset) of the tool centre point 16 associated with the measurement probe 10, with the coordinates (or offset) of the tool centre point 16 being defined relative to a point on the flange 3 of the robot arm 1 to which the measurement probe 10 is coupled.
  • the flange 3 will also be referred to hereinbelow as the head part 3 of the robot arm 1, since it is at the head of the robot arm 1 and at the opposite end to the base part 2.
  • the robot arm 1 has a plurality of rotary joints (transverse rotary axes 6 and inline rotary axes 7) arranged in series between the head part 3 and the base part 2.
  • step SI the calibration unit 30 sets up the machine controller 8 to perform a calibration routine to collect information or data from which the TCP offset can be determined, as will be described in more detail below.
  • the machine controller 8 begins the calibration routine in step Cl by controlling the robot arm 1 to move the head part 3 (on which the measurement probe 10 is supported) relative to the base part 2 (on which the calibration artefact 20 is supported) into a first sensed state, as shown in Figure 7.
  • a sensed state is characterised by a position and orientation of (or position and orientation values for) the head part 3 relative to the base part 2.
  • the head part 3 is in a sensed state when the tool centre point 16 of the measurement probe 10 is itself in a sensed position.
  • a sensed position for the tool centre point 16 is a position in which the stylus tip 14 of the measurement probe 10 is in a sensing relationship with the calibration artefact 20, i.e. touching the calibration artefact 20 in this embodiment where the measurement probe 10 is a contact probe. Because the stylus tip 14 of the measurement probe 10 is in contact with the calibration artefact 20 in this position, the position of the tool centre point 16 has thereby been constrained to a subset of the overall set of possible positions for the tool centre point 16. This is represented by step S2 of Figure 5.
  • the subset of constrained positions in this embodiment is the set of points arranged on a surface that is offset from the calibration artefact 20 by the radius of the stylus tip 14.
  • Using the calibration artefact 20 like this is one way to provide information relating to where the sensed positions are relative to one another, with this information being made available subsequently in step S4.
  • the position of the tool centre point 16 could also be measured directly for each of the sensed positions, and this alternative is explored further below.
  • step C2 the controller 8 determines values for the position and orientation of the head part 3 relative to the base part 2 in this sensed state, based on the existing machine geometry (or parametric model) for the robot arm 1.
  • the controller 8 must already have knowledge of the machine geometry for the robot arm 1 (or a parametric model characterising the geometry of the robot arm 1), and from this it is able to determine representative values for the position and orientation of the head part 3 relative to the base part 2 in a conventional way.
  • the offset of the tool centre point 16 relative to the head part 3 is not relevant to the determination made in step C2. All that is required at this stage is the position and orientation of the head part 3, i.e. the part of the robot arm 1 to which the measurement probe 10 is coupled. It does not matter where the tool centre point 16 actually is, or is assumed to be, relative to the head part 3, merely that in the sensed state there is some knowledge of the position of the tool centre point 16 relative to the base part 2 due to the constraint imposed by the calibration artefact 20. It is also to be noted that the calibration unit 30 does not need (and does not have) knowledge of the machine geometry (or parametric model) for the robot arm 1, so that there is a functional even if not physical separation between the calibration unit 30 and controller 8 in this respect.
  • step S4 position and orientation values for the head part 3 need to be determined for a variety of different sensed states. As shown schematically in Figures 8 to 11, sufficient information can be collected by repeating steps Cl and C2 for four different sensed positions of the tool centre point 16 around the calibration artefact 20, with the head part 3 (and therefore also the measurement probe 10) in three different orientations for each of the four different sensed positions. This amounts to twelve different sensed states and twelve corresponding pairs of position and orientation values for the head part 3.
  • step C3 the controller 8 decides whether further sensed states (and corresponding position and orientation values) are required. If yes, the method returns to step Cl so that the controller 8 can control the head part 3 into a different sensed state, with the tool centre point 16 being constrained by the calibration artefact 20 as represented by step S2, and with position and orientation values for the head part 3 in the new sensed state being determined in step C2. If, on the other hand, it is decided in step C3 that sufficient calibration data have already been collected, e.g. for all twelve sensed states (and corresponding position and orientation combinations) shown in Figures 8 to 11, then control passes to step C4 in which the controller 8 sends the set of position and orientation values determined for each performance of step C2 to the calibration unit 30. Step C4 could also come before step C3, so that the position and orientation values are sent immediately to the calibration unit 30 rather than waiting until all values have been collected.
  • step S3 the calibration unit 30 receives the set of position and orientation values sent from the controller 8, and in step S4 the calibration unit 30 uses these position and orientation values to determine the offset of the tool centre point 26.
  • step S4 the calculation which is performed in step S4 also takes account of the knowledge that in each of the sensed states for which position and orientation data is provided, the position of the tool centre point 16 was constrained relative to the position of the tool centre point 16 in another of the sensed states by virtue of the calibration artefact 20. Since the geometry of the calibration artefact 20 is known, the position and orientation data in combination with the constraint data (e.g.
  • step S3 provides sufficient information to enable the offset of the tool centre point 16 relative to the head 3 to be determined directly in step S3.
  • the tool centre point 16 will in each of the sensed states be located on a spherical surface that is offset from the spherical calibration artefact 20 by the radius of the stylus tip 14, and this provides information about where the sensed positions are relative to one another.
  • Figures 12 to 14 show a simplified two-dimensional representation of Figures 8 to 11, in which the measurement probe 10 is considered to move only within the two-dimensional plane of the drawings page.
  • the measurement probe 10 is moved so as to contact the stylus tip 14 at three different points around the artefact 20, i.e. with the tool centre point 16 being in three different sensed positions pi, p2 and ps around the artefact 20, as shown respectively in Figures 12, 13 and 14.
  • the head part 3 is oriented in two different orientations, corresponding respectively to two different sensed states, e.g. sensed states sn and S12 for sensed position pi of Figure 12.
  • each sensed state for the head part 3 is characterised by two position values (X Y) and an orientation or angle value (R), for example (X21 Y21 R21) for sensed state S21 as shown in Figure 13, or more generally (Xps Yps RPS) where P is the number of the sensed position and S is the number of the sensed state (or orientation).
  • Figure 15 show a highly simplified two-dimensional representation of the head part 3 of the robot arm 1 being moved into two different sensed states sn, S21.
  • this offset is relative to an arbitrary point (or frame of reference) 9 on the head part 3 and does not convey any information about the actual orientation of the measurement probe 10 (and stylus 12), which is clearly not oriented along vector (10, 1).
  • a conventional method to find the tool centre point offset would typically include the offset parameters as parameters in the model which characterises the geometry of the machine, so that the tool centre point offset parameters would be determined or optimised in parallel with other parameters of the model.
  • the offset parameters are determined separately from and/or independently of the other parameters of model, and after the other parameters of model have been determined or optimised.
  • the information received from the controller 8 in step S3 is not specified directly in terms of explicit and final numerical values for position and orientation, and even if some type of minimal processing is required to produce actual numerical values for position and orientation (e.g. scaling or shifting or mapping values from one coordinate space to another), the information should at least specify the position and orientation of the head part 3 relative to the base part 2 without reference to the state and/or geometry of any other part of the robot arm 1 that might affect the position and orientation of the head part 3 relative to the base part 2 (such as the links 5 and joints 6 of the robot arm 1 shown in Figure 6).
  • raw machine coordinate data from the controller 8 (comprising rotary encoder readings and/or joint angles) would not fit this description because, although it contains information from which the position and orientation of the head part 3 relative to the base part 2 could be derived, it does so with reference to the state and/or geometry of other machine components that are arranged in the kinematic chain between the base part 2 and the head part 3, and in doing so requires knowledge of the parametric model of the robot arm 1 in order to process.
  • step S5 the TCP coordinates determined in step S4 are sent to the controller 8 and loaded into the controller 8 in step C5.
  • the robot arm 1 can then be used (or can continue to be used) operationally, with the controller 8 being able to determine more accurately from the new TCP coordinates what movements of the head part 3 are required to bring the stylus tip 14 of the measurement probe 10 precisely into contact with a workpiece to obtain measurement data.
  • the setup of the robot arm 1 may drift over time, or the robot arm 1 may be knocked or moved inadvertently by an operator, so that it is beneficial to perform the method again occasionally or even frequently to determine up-to- date TCP coordinates, so if it is determined in step S6 that new TCP coordinate are needed then the method returns to step SI for another run, otherwise the method remains at step S6 until a new run is deemed to be necessary.
  • a key benefit of the method described above is that the offset of the tool centre point 16 has been determined by the calibration unit 30 based only on the position and orientation values for the head part 3 sent from the controller 8, without any knowledge of the geometry of the robot arm 1 itself. This provides increased operational simplicity and versatility because it does not require integration into the controller 8 but can be provided as an add-on feature that is used in conjunction with a conventional controller 8.
  • the measurement probe 10 is supported on the head part 3 and the calibration artefact 20 is supported on the base part 2, so that the measurement probe 10 is moving relative to the base part 2. It is also possible to reverse this, as shown in Figure 17, so that the measurement probe 10 is supported on the (fixed) base 2 and the calibration artefact 20 is supported on the (moving) head part 3. The method for this reversed arrangement of Figure 17 is entirely equivalent to that described above. Figure 17 also illustrates that the calibration unit 30 can be physically separate from the controller 8.
  • the sensed positions i.e. the positions at which the tool centre point 46 are measured by the position measurement device 50
  • the position measurement device 50 can be a laser-based position measurement device or a camera-based position measurement device, or any other suitable type of position measurement device.
  • the arrangement of Figure 18 also applies to the case where a measurement probe 20 is supported on the head part 3 rather than the general tool 40, in which case there is a position measurement device 50 taking position measurements of another position measurement device in the form of the measurement probe 20.
  • Figure 19 illustrates the possibility that a toolsetter 60 can be used as the measurement device, the toolsetter 60 having a stylus 62 and sensing element 64.
  • the calibration artefact 20 need not be spherical but could be any shape, such as cuboidal, so long as the geometry of the shape is known (this information being used in step S4 of Figure 5), because this is sufficient to constrain the sense positions relative to one another. It will also be appreciated that the present invention is applicable to finding the offset of any feature or other point of interest associated with a tool, and not just a tool centre point of the tool.
  • the head part and base parts can alternatively be referred to more generally as first and second parts of the machine that are moveable by the machine relative to one another.
  • the terms ‘characterisation’ and ‘characterise’ can be used instead of ‘calibration’ and ‘calibrate’ respectively.
  • the calibration unit 30 is shown as forming part of the controller 8. However, as is illustrated in Figure 17, the calibration unit 30 can conveniently be functionally and/or physically separate and/or remote from the controller 8, and merely receiving the information it needs from the controller 8; the calibration unit 30 could even be at a different site to the controller 8 and robot arm 1. The relevant data for step S4 of Figure 5 could even be sent to a remote site for processing, rather than processed on site.
  • the calibration unit 30 is intended to represent means for providing additional functionality associated with an embodiment of the present invention and that is not provided by a conventional controller, either additional functionality for the controller (e.g. to provide the servo control described above when collecting measurement data) or additional functionality outside the controller (e.g. offsite processing of the collected measurement data).
  • a machine controller for controlling the operation of the robot may be a dedicated electronic control system and/or may comprise a computer operating under control of a computer program.
  • the machine controller may comprise a real-time controller to provide low-level instructions to the coordinate positioning machine, and a PC to operate the real-time controller.
  • operation of the coordinate positioning machine can be controlled by a program operating on the machine, and in particular by a program operating on a coordinate positioning machine controller such as the controller 8.
  • Such a program can be stored on a computer-readable medium, or could, for example, be embodied in a signal such as a downloadable data signal provided from an Internet website.

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Abstract

L'invention concerne un procédé de détermination d'un décalage d'une caractéristique (16) associée à un outil (10), le décalage étant défini par rapport à une première partie (3) d'une machine (1) à laquelle l'outil (10) est couplé. Le procédé est caractérisé par la détermination du décalage par rapport à : (a) des valeurs pour la position et l'orientation de la première partie (3) par rapport à une seconde partie (2) de la machine (1) pour chacun d'une pluralité d'états détectés dans chacun desquels la caractéristique (16) se trouve dans une position détectée ; et (b) des informations relatives à l'endroit où les positions détectées sont relatives les unes par rapport aux autres. L'invention concerne un exemple particulièrement avantageux dans lequel le procédé est utilisé pour déterminer le point central d'outil (16) d'une sonde de mesure (10) supportée sur un bras de robot (1) à l'aide d'un artefact (20) placé dans le volume de travail du bras de robot (1).
PCT/EP2023/071007 2022-07-28 2023-07-28 Machine de positionnement par coordonnées WO2024023301A1 (fr)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
EP22306131 2022-07-28
EP22306131.8 2022-07-28

Publications (1)

Publication Number Publication Date
WO2024023301A1 true WO2024023301A1 (fr) 2024-02-01

Family

ID=83115636

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/EP2023/071007 WO2024023301A1 (fr) 2022-07-28 2023-07-28 Machine de positionnement par coordonnées

Country Status (1)

Country Link
WO (1) WO2024023301A1 (fr)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5297238A (en) * 1991-08-30 1994-03-22 Cimetrix Incorporated Robot end-effector terminal control frame (TCF) calibration method and device
WO2009059323A1 (fr) * 2007-11-01 2009-05-07 Rimrock Automation, Inc. Dba Wolf Robotics Procédé et système de détermination d'un point central d'outil pour un robot à l'aide d'une caméra externe
WO2019162697A1 (fr) 2018-02-26 2019-08-29 Renishaw Plc Machine de positionnement par coordonnées
WO2021116685A1 (fr) 2019-12-11 2021-06-17 Renishaw Plc Bras de positionnement de coordonnées

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5297238A (en) * 1991-08-30 1994-03-22 Cimetrix Incorporated Robot end-effector terminal control frame (TCF) calibration method and device
WO2009059323A1 (fr) * 2007-11-01 2009-05-07 Rimrock Automation, Inc. Dba Wolf Robotics Procédé et système de détermination d'un point central d'outil pour un robot à l'aide d'une caméra externe
WO2019162697A1 (fr) 2018-02-26 2019-08-29 Renishaw Plc Machine de positionnement par coordonnées
WO2021116685A1 (fr) 2019-12-11 2021-06-17 Renishaw Plc Bras de positionnement de coordonnées

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
ANONYMOUS: "RoboDK Documentation - TCP calibration", 5 July 2022 (2022-07-05), pages 1 - 3, XP093090018, Retrieved from the Internet <URL:https://web.archive.org/web/20220705144427/https://robodk.com/doc/en/General.html> [retrieved on 20231009] *
ROBODK: "How to Define your Robot Tool (TCP) - RoboDK Robot Software", 6 May 2021 (2021-05-06), XP093090016, Retrieved from the Internet <URL:https://www.youtube.com/watch?v=TM-9vGR2r4k> [retrieved on 20231009] *

Similar Documents

Publication Publication Date Title
EP3759419B1 (fr) Machine de positionnement par coordonnées et procédé d étalonnage
CN108748159B (zh) 一种机械臂工具坐标系自标定方法
US6822412B1 (en) Method for calibrating and programming of a robot application
EP0522411A1 (fr) Calibrage positionnel de joints d&#39;un bras de robot par rapport au vecteur de gravité
US20120283874A1 (en) Robotic work object cell calibration system
WO2003064118A1 (fr) Position d&#39;outil d&#39;usinage de robot et etalonnage d&#39;orientation
KR101797122B1 (ko) 이동형 3차원 좌표 측정기(cmm)의 에러 측정 및 보상 방법
TWI754888B (zh) 校準方法及校準系統
WO2018196232A1 (fr) Procédé d&#39;étalonnage automatique de robot et d&#39;effecteur terminal, et système
US20220105640A1 (en) Method Of Calibrating A Tool Of An Industrial Robot, Control System And Industrial Robot
KR20080088165A (ko) 로봇 캘리브레이션 방법
WO2023170166A1 (fr) Système et procédé d&#39;étalonnage d&#39;un bras de robot articulé
WO2024023301A1 (fr) Machine de positionnement par coordonnées
WO2022025060A1 (fr) Dispositif de commande de robot
Santolaria et al. Kinematic calibration of articulated arm coordinate measuring machines and robot arms using passive and active self-centering probes and multipose optimization algorithm based in point and length constrains
JP5667437B2 (ja) ロボットの外部軸の計測方法、ロボットの教示データ作成方法、およびロボットのコントローラ
WO2024023306A1 (fr) Machine de positionnement par coordonnées
KR101826577B1 (ko) 로봇의 손목 축 움직임을 이용한 툴 보정 방법
WO2024023310A1 (fr) Machine de positionnement par coordonnées
KR20070096627A (ko) 로봇의 위치측정장치 및 방법
RU2762693C1 (ru) Способ повышения точности перемещений промышленного робота в процессе инкрементального формообразования
JPH08141950A (ja) 多関節構造ロボットのキャリブレーション方法
Gaska et al. Determination of influence of the parameters connected with the stabilization of the position on the 5-axis manipulators’ operation accuracy
KR20030069381A (ko) 로봇의 툴 캘리브레이션 방법

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 23748529

Country of ref document: EP

Kind code of ref document: A1