System and method for calibrating articulated robot arm
Through the coordination of optical beam and sensor units, machine parameters are optimized, and the position error problem of non-Cartesian coordinate positioning machines in the calibration process is solved, and its positioning accuracy is improved, making it more suitable for use in manufacturing environments.
Patent Information
- Application Number
- CN202380027040.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Priority Date
- 2022-03-11
- Filing Date
- 2023-03-08
- Publication Date
- 2024-11-08
AI Technical Summary
Non-Cartesian coordinate positioning machines, especially articulated robot arms, have position errors and uncertainties during calibration, resulting in lower accuracy than traditional three-axis Cartesian machines, making it difficult to meet positioning accuracy requirements suitable for manufacturing environments.
The optical beam emission and sensor unit are used to coordinate with the processor for calibration. By moving the sensor unit along the optical beam over multiple degrees of freedom, the machine parameters are optimized to improve positioning accuracy using the measurement results.
Improves the positioning accuracy of non-Cartesian coordinate positioning machines, making them more suitable for tasks such as assembly in manufacturing environments, and is suitable for a wider range of coordinate measurement needs.
Smart Images

Figure CN118922278A_ABST
Abstract
Description
[0001] The present invention relates to a coordinate positioning machine. The present invention particularly, but not exclusively, relates to a system for calibrating or otherwise characterizing at least some aspects of a coordinate positioning machine. The present invention is particularly applicable to coordinate positioning machines of non-Cartesian type, such as hexapods, measuring arms, or articulated robots, for example.
[0002] Articulated robots are commonly used in a variety of manufacturing applications, such as assembly, welding, gluing, painting, pick and place (e.g. for printed circuit boards), packaging and labeling, palletizing, and product inspection. They benefit from versatility and robustness, large reach distances, and high mobility, making them ideal for use in production environments.
[0003] In the attached figure Figure 1 Schematically illustrated is an articulated robot (or simply "robot") comprising an articulated robot arm 1 extending from a fixed base 2 to a movable flange 3, wherein the flange 3 supports a tool (or end effector) 4. Typically, the flange 3 is provided with a coupling that allows the tool 4 to be easily interchangeable, so that a variety of tools or end effectors can be employed depending on the relevant application; examples include grippers, vacuum suction cups, cutting tools (including mechanical cutting tools and laser cutting tools), drilling tools, milling tools, deburring tools, welding tools and other specialized tools.
[0004] The arm 1 comprises a plurality of segments 5 connected by a mixture of transverse rotation axes 6 and inline (or longitudinal) rotation axes 7, forming a mechanical linkage from one end to the other. Figure 1 In the example shown, there are three transverse rotation axes 6 and three in-line rotation axes 7, for a total of six rotation axes, which alternate between transverse rotation axes 6 and in-line rotation axes 7. Additional in-line rotation axes 7 (not shown) may also be provided between the last transverse rotation axis 6 and the flange 3. Figure 1 ), to provide for convenient rotation of the tool 4 about its longitudinal axis, thereby forming a total of seven rotation axes.
[0005] Figure 2 Another common arrangement is shown in the arm 1 of FIG. 1 , which includes the additional in-line rotation axis 7 between the last transverse rotation axis 6 and the flange 3 as described above, and which also omits the Figure 1 The second in-line rotation axis 7 in the embodiment (connected in series from the bottom end to the head end) forms a total of six rotation axes. Figure 2 The tool 4 in is a gripper. Figure 1The arm 1 is a schematic diagram of the well-known IRB 140 six-axis industrial robot from ABB Robotics. The last three axes 6, 7 form the "wrist" of the robot arm 1, where the center of the wrist is located at the center of the last lateral rotation axis 6. The center of the wrist is invariant to rotation of these three rotation axes 6, 7 of the wrist, so that operation of these three rotation axes 6, 7 changes the orientation of anything attached to the wrist (in this case the gripper 4) without changing the position of the center of the wrist, where the first three rotation axes 6, 7 of the robot arm 1 determine the position of the center of the wrist. The wrist can be easily detached from the rest of the arm 1.
[0006] Figure 1 and Figure 2 The articulated robot arm 1 is an example of a non-Cartesian coordinate positioning machine because it is different from conventional three-axis (X, Y, Z) coordinate measuring machines (see, for example, PCT / GB 2020 / 052593 Figure 1 ) whose axes are not arranged orthogonally according to the Cartesian coordinate system. Figure 1 and Figure 2 The arm 1 is also an example of a "serial kinematic" coordinate positioning machine, as its axes of movement are arranged in series. In this sense, this machine is similar to a conventional 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 instead arranged in parallel.
[0007] Each joint or axis in a coordinate positioning machine introduces position error or uncertainty. Figure 1 and Figure 2 In the series kinematic machine shown, these errors accumulate due to the series nature of the linkage. While this accumulation of position errors does not occur in the same sense in a parallel kinematic machine, it is important to calibrate the machine in order to map out these errors or uncertainties, regardless of the type of machine.
[0008] Calibrating any type of non-Cartesian machine is a significant challenge and is particularly important for Figure 1 and Figure 2 This is particularly true for the articulated arms shown, which have multiple axes of rotation that: (a) are arranged in series; (b) are not fixed relative to each other; and (c) can be combined in complex ways to position the tool in the work volume. Calibrating a Cartesian machine is generally simpler because such a machine has three well-defined axes that are fixed relative to each other in an orthogonal arrangement, with each axis being largely independent of the others. For an articulated robot, the position and orientation of each axis depends on the position and orientation of every other axis, so that the calibration will be different for each different machine pose.
[0009] A common goal of many calibration techniques is to specify a parametric model of the machine in question, in which the geometry of the machine is characterized using a set of model parameters (also called machine parameters). These parameters are initially assigned uncalibrated values as a starting point for the machine geometry. During calibration, the machine is moved to a number of different poses (based on current estimates of the machine parameters). For each pose, the actual pose is measured using a calibrated measurement device so that an indication of the error between the assumed machine pose and the actual machine pose can be determined. The task of calibrating the machine then amounts to determining a set of values for the various machine parameters that minimize the error, using known numerical optimization or error minimization techniques.
[0010] For Figure 1 and Figure 2 For the robot arm shown, these machine parameters may include various geometric parameters such as the length of each segment 5 and the rotational angle offset of each rotational axis or joint 6, 7 (the angle from the encoder plus the calibration offset gives the actual angle), as well as various mechanical parameters such as joint compliance and friction. When properly calibrated, with all these machine parameters known, it is possible to predict with greater certainty what position the tool 4 will actually be in when the robot controller 8 commands the various axes or joints 6, 7 to move to different respective positions. In other words, the machine parameters resulting from such calibration provide a more accurate characterization of the machine geometry. These concepts, which generally relate to the calibration of coordinate positioning machines and in particular the calibration of robot arms, are explored in more detail in WO 2019 / 162697 A1 and WO 2021 / 116685 A1.
[0011] Even after using known calibration techniques, due to the calibration Figure 1 and Figure 2 The challenges associated with non-Cartesian machines shown, are that errors are often still present. As a result, the accuracy of such a machine is typically not as good as that of a traditional three-axis Cartesian machine, for example, which means it will typically be used for assembly (e.g., pick and place) tasks in a manufacturing environment, such as Figure 2 Arrangements are shown where speed, range and flexibility are more important than absolute positioning accuracy.
[0012] In view of the above, it is desirable to find a method for calibrating Figure 1 and Figure 2 The improved system and method of non-Cartesian coordinate positioning machines shown are used not only to improve their positioning accuracy for existing assembly tasks, but also to improve their positioning accuracy until they become suitable for use as coordinate measuring machines themselves. Such system and method can also be more generally applicable to Figure 1 and Figure 2Coordinate positioning machines of types other than the robotic arms shown.
[0013] According to a first aspect of the invention, there is provided a system for calibrating or otherwise characterizing a machine, the system comprising: a transmitting unit; a sensor unit; and a processor (or a characterization unit or a calibration unit). The transmitting unit is operable to transmit (or arrange or provide) an optical beam (or other form of optical or non-optical guide) into (or through or within) a working volume of the machine. The sensor unit is (can be coupled to the machine and) can be moved by the machine (relative to the transmitting unit) to a plurality of sensor unit positions along the beam. The sensor unit is operable to measure, for each of the plurality of sensor unit positions, a transverse (or lateral) beam position at a plurality of measurement positions along the beam (a transverse beam position is a position in a transverse plane or in a plane transverse to the beam) (these are 'measurements' or 'actual measurements'). From the measurements, the position of the sensor unit relative to the beam (or transmitting unit or machine), or the change in the position of the sensor unit relative to the beam (or transmitting unit or machine) from one sensor unit position to another sensor unit position can be derived in at least three degrees of freedom (e.g., three or four degrees of freedom) (in each of the degrees of freedom). The processor unit (or characterization unit or calibration unit) is operable to use the measurement results to calibrate or otherwise characterize the machine.
[0014] Typically, the first entity is able to move relative to the second entity in up to six degrees of freedom, of which up to three are translational degrees of freedom and up to three are rotational degrees of freedom. The three translational degrees of freedom can be represented as X, Y, Z (corresponding to translations along the X, Y, Z axes), and the three rotational degrees of freedom can be represented as A, B, C (corresponding to rotations around the X, Y, Z axes, respectively). Using this coordinate system, if Z is considered to correspond to (or be aligned with) the axis defined by the beam, then: (a) X, Y are considered to be lateral translational degrees of freedom; (b) Z is considered to be longitudinal translational degrees of freedom; (c) A, B are considered to be lateral rotational degrees of freedom (also known as pitch, yaw); and (d) C is considered to be longitudinal rotational degrees of freedom (also known as roll). It will be appreciated that the degrees of freedom are arbitrarily assigned letters, and it is also possible, for example, to represent the rotational degrees of freedom corresponding to X, Y, Z as C, B, A, respectively.
[0015] According to a second aspect of the present invention, there is provided a sensor unit for use in a system according to the first aspect of the present invention, the sensor unit being capable of being moved by the machine to a plurality of sensor unit positions along the beam, and the sensor unit being capable of being operated to measure, for each of the plurality of sensor unit positions, a lateral beam position at a plurality of measurement positions along the beam, wherein the position of the sensor unit relative to the beam (or the change in the position of the sensor unit relative to the beam from one sensor unit position to another sensor unit position) can be derived in at least three degrees of freedom based on the measurement results.
[0016] According to a third aspect of the invention, there is provided a method for calibrating or otherwise characterizing a machine, the method comprising: (a) emitting an optical beam into a working volume of the machine, or at least causing the optical beam to be emitted into the working volume of the machine; (b) controlling the machine so that a sensor unit according to the second aspect of the invention moves along the beam to a plurality of sensor unit positions along the beam; (c) for each of the plurality of sensor unit positions, using a sensor unit to measure a lateral beam position at a plurality of measurement positions along the beam, wherein the position of the sensor unit relative to the beam (or the change in the position of the sensor unit relative to the beam from one sensor unit position to another sensor unit position) can be derived in at least three degrees of freedom based on the measurement results; and (d) using the measurement results to calibrate or otherwise characterize the machine.
[0017] The method may comprise repeating steps (b) and (c) for the same beam emitted in step (a), or at least for a beam emitted from the same position and at the same angle, but using a sensor unit path which deviates from the sensor unit path previously used to perform steps (b) and (c), wherein the position of the sensor unit relative to the beam can be derived from the combination of measurement results in a rotational (roll) degree of freedom about an axis defined by the beam.
[0018] As part of a method embodying the invention, the movement of the sensor unit along the beam to collect measurement data is also referred to herein as a "stroke". The position of the sensor unit relative to the beam can be derived (from the measurements) in two transverse translational degrees of freedom (along the first and second transverse axes of the beam, or along the first and second axes transverse to the beam) and at least one transverse rotational degree of freedom (around the transverse axis of the beam, or around at least one rotational degree of freedom around an axis transverse to the beam, which axis may be the same as one of the first and second transverse axes). The axis defined by the beam may be denoted as the Z axis, wherein the two transverse translational degrees of freedom are X, Y, and the at least one transverse rotational degree of freedom is at least one of A, B (at least one of pitch, yaw).
[0019] The position of the sensor unit relative to the beam in the lateral rotational degree of freedom can be derived from a corresponding pair of measurement positions (based on measurement results) separated by a fixed and / or known and / or measured spacing. Each of the pair of measurement positions can provide a measurement result in the same direction and / or dimension or along the same direction and / or dimension. Each measurement position in the pair of measurement positions can provide a measurement result from which the position in the same direction and / or dimension or along the same direction and / or dimension can be derived. The pair of measurement positions can be separated by a fixed but unknown or unmeasured spacing, or at least separated by a spacing that is only known or measured to a certain level of accuracy (for example, to an accuracy of no more than the actual spacing, or no more than 50% of the actual spacing, or no more than 10% of the actual spacing, or no more than 5% of the actual spacing, or no more than 1% of the actual spacing, or no more than 0.1% of the actual spacing).
[0020] The position of the sensor unit relative to the beam can be derived in two lateral rotational degrees of freedom (eg in both A and B, or for both pitch and yaw).
[0021] The sensor unit is further operable to provide additional measurements from which the position of the sensor unit relative to the beam can be derived in a longitudinal rotational degree of freedom (e.g. about an axis defined by the beam or the Z-axis). This degree of freedom may be referred to as roll. These measurements may be provided by a dedicated roll sensor (such as described in WO 2008 / 122808) or by two offset passes along the same beam as described herein.
[0022] The processor unit is operable to calibrate or otherwise characterize the machine based on a comparison between expected measurements from the sensor unit (or information such as relative position information derived from the measurements) and actual measurements from the sensor unit (or information such as relative position information derived from the actual measurements). In this context, expected may be considered to mean expected based on a set of model parameters characterizing the geometry of the machine.
[0023] The system may comprise a control unit operable to control the machine to move the sensor unit along the beam. The control unit may be operable to control the machine to move the sensor unit along the beam based on a set of model parameters (of the parameterized model) characterizing the geometry of the machine. The control unit may be operable to generate a series of position requirements to control the machine to move in this manner.
[0024] The processor unit is operable to update model parameters (of the parameterized model) based on the above comparison. This may be performed to provide a closer match between expected measurements and actual measurements. In doing so, it is intended that the new set of model parameters thereby better characterizes the geometry of the machine than the existing set of model parameters.
[0025] The control unit is operable to control the movement (at least part of the movement) of the machine so that the sensor unit follows a predetermined path along the beam at least in the absence of any additional movement applied or imposed, for example, by a servomechanism. The path of the sensor unit may define the position and orientation of the sensor unit relative to the beam.
[0026] The control unit is operable (in cooperation with the processor unit) to servo-control movement of the machine (at least part of the movement) in dependence on the measurements from the sensor unit to maintain (or at least attempt to maintain) a substantially constant (or otherwise known or predetermined) measurement from the sensor unit for each of the sensor unit positions along the beam. The servo movement may be applied in addition to or in combination with any movement along the predetermined path.
[0027] The separation may be measured by moving the sensor unit relative to the transmitting unit such that the beam is incident in sequence at each measurement position of the pair of measurement positions, wherein the separation is determined based on the model parameters.
[0028] The processor unit may be separate from the control unit (eg located at a separate location), or these units may be effectively the same unit (or at least provided by the same unit).
[0029] The sensor unit may comprise a sensor at each of the measurement locations, each sensor being adapted to sense the beam (or to measure the location of incidence of the beam) in one or two lateral dimensions or directions.
[0030] The sensor unit may have multiple entry points that cause the beam to be at different respective angles while still passing through the same measurement location.
[0031] The coupling between the sensor unit and the machine may be adapted to substantially coincide at least one of the measurement locations with a point of interest associated with the machine.
[0032] A point of interest associated with a machine may be the tool center point (where the tool is mounted to the machine).
[0033] The coupling between the sensor unit and the machine may be adapted to provide for rotation of the sensor unit relative to the machine about a predetermined point on the coupling.The predetermined point is preferably arranged to substantially coincide with a point of interest (eg a tool centre point).
[0034] The transmitting unit is operable to transmit the beam into the working volume of the machine from multiple positions and / or in multiple directions.
[0035] The sensor unit may be moved by the machine (e.g., coupled to the head end of the machine), while the transmitting unit is fixed (e.g., coupled to the base platform of the machine during movement). Alternatively, the transmitting unit may be moved by the machine (e.g., coupled to the head end of the machine), while the sensor unit is fixed (e.g., coupled to the base platform of the machine during movement).
[0036] The optical beam may be a laser beam or a light beam. However, it will be appreciated that the optical beam actually acts as an optical guide that can be sensed by an appropriate form of optical sensor in the sensor unit, and the present invention is not limited to the use of an optical beam as a guide. Some other type of energy beam, such as an electron beam, may be used instead, using an appropriate sensor in the sensor unit depending on the type of energy beam used. Preferably, a non-contact form of guide is used, but a mechanical guide, such as a metal rod or a straight edge of a metal sheet (such as a ruler) may also be used. In a more general case, the phrase "launching the optical beam into the working volume" may be replaced by the phrase "arranging the guide in the working volume". The guide (which may also be referred to as a sensor unit guide or a guide for a sensor unit) does not need to define a straight path, only that the path defined by the guide has a known form; for example, the guide may have a known radius of curvature.
[0037] The system may further comprise a linear measurement device for providing measurements related to the longitudinal (linear) translational degree of freedom. This would thereby enable up to five degrees of freedom to be determined from the sensor unit, wherein an additional degree of freedom is determined from the measurement device, thereby providing a system capable of characterizing the machine based on up to six degrees of freedom.
[0038] The sensor unit may comprise means (e.g. a reflector) for returning at least a portion of the beam to the transmitting unit (or some other receiver unit), and wherein the transmitting unit (or other receiver unit) comprises an interferometric sensor which uses the reference beam and the return beam to provide measurements related to the longitudinal (linear) translational degree of freedom. This would thereby enable up to five degrees of freedom to be determined from the sensor unit, wherein an additional degree of freedom is determined from the measurement means, thereby providing a system capable of characterizing a machine based on up to six degrees of freedom.
[0039] Characterizing the machine may include one or more of: calibrating the machine; validating the machine; performing a health check on the machine; evaluating positioning errors of the machine; and setting up the machine.
[0040] The geometry of the machine is characterized by a set of model parameters, and calibrating the machine may include determining a new set of model parameters that better characterizes the geometry of the machine than an existing set of model parameters.
[0041] The machine may include (or be) a coordinate positioning machine. The machine may include (or be) a non-Cartesian and / or parallel kinematic machine. The machine may include (or be) a robotic arm.
[0042] Each of the features described above in relation to the first aspect of the invention also applies, where appropriate, to each of the further aspects of the invention set out below.
[0043] According to a fourth aspect of the invention, there is provided an directional sensor unit which can be mounted in a fixed orientation to a non-Cartesian machine to perform a method for characterizing the machine, and which can be moved relative to the machine between a plurality of different fixed orientations so as to enable the method to be performed using machines of a plurality of different configurations (or postures) for the same sensing operation.
[0044] According to a fifth aspect of the invention, there is provided a method of calibrating or otherwise characterizing a non-Cartesian coordinate positioning machine, the method comprising: (a) emitting an optical beam into a working volume of the machine, or at least causing the optical beam to be emitted into the working volume of the machine; (b) controlling the machine to move a sensor unit along the beam to a plurality of sensor unit positions along the beam; (c) taking a measurement using the sensor unit for each of the plurality of sensor unit positions, thereby being able to derive the position of the sensor unit relative to the beam in at least three degrees of freedom; (d) repeating steps (a) to (c) for the beam at a plurality of different emission positions and / or angles; and (e) using the measurement results to calibrate or otherwise characterize the machine. The sensor unit may be a sensor unit according to the second aspect of the invention, or it may be another type of sensor unit.
[0045] According to a sixth aspect of the present invention, a computer program is provided which, when run by a computer or a machine controller, causes the computer or the machine controller to execute a method according to the third or fifth aspect of the present invention (or at least any step of the method that can be executed by a computer program or caused to be executed by a computer program).
[0046] According to another aspect of the present invention, a computer-readable medium is provided, in which computer program instructions are stored, and these computer program instructions are used to control a computer or a machine controller to perform the method according to the third or fifth aspect of the present invention (or at least any step of the method that can be executed by a computer program or caused to be executed by a computer program).
[0047] According to another aspect of the present invention, a machine controller is provided, which is configured to control a machine to perform a method according to the third or fifth aspect of the present invention (or at least any step of the method that can be performed by or caused to be performed by the controller).
[0048] Reference will now be made, by way of example, to the accompanying drawings, in which:
[0049] Discussed above Figure 1 is a schematic illustration of a coordinate positioning arm in the form of an articulated robot;
[0050] Also discussed above Figure 2 Is with Figure 1 Schematic illustration of an articulated robot with different rotation axis arrangements;
[0051] Figure 3 is a schematic illustration of a system for calibrating a coordinate positioning machine in the form of an articulated robotic arm embodying the present invention;
[0052] Figure 4A and Figure 4B Two possible types of two-dimensional sensors for use in a sensor unit embodying the invention are shown;
[0053] Figure 5 Demonstrated Figure 3 a sensor unit of an alternative sensor arrangement to the illustrated sensor arrangement;
[0054] Figure 6 Demonstrated Figure 3 and Figure 5 a sensor unit of an alternative sensor arrangement to the illustrated sensor arrangement;
[0055] Figure 7 It is shown how, in a method embodying the invention, measurement data is collected from a sensor unit as a robot arm moves the sensor unit along a laser beam;
[0056] Figure 8 It is shown how additional measurement data can be collected by repeating the process for a number of different beam orientations;
[0057] Fig. 9 It is shown how additional measurement data can be collected by repeating the process for a number of different beam positions and orientations;
[0058] Fig.10 A simplified form of a sensor unit with two one-dimensional sensors is shown to facilitate explanation;
[0059] Fig.11 Shown Fig.10The sensor unit moves along the laser beam according to a predetermined path, but with some undesired translational and rotational deviations from the path;
[0060] Fig.12 for explaining how to determine the rotational deviation based on the lateral beam positions measured by the two sensors of the sensor unit;
[0061] Fig.13 Shown Fig.10 The sensor unit moves along the laser beam according to a predetermined path, but with some undesired translational deviation from the path;
[0062] Fig.14 Shown Fig.10 The predetermined path of the sensor unit need not be a path designed to maintain perfect alignment of the sensor unit with the laser beam along its length;
[0063] Fig.15 Shown Fig.10 The sensor unit is moved along the laser beam according to a predetermined path, but with a superimposed servo movement that corrects for undesired translational and rotational deviations to maintain the sensor unit aligned with the beam;
[0064] Fig.16 Shown Fig.10 The purpose of the superimposed servo movement of the sensor unit may be to maintain the sensor unit at a constant angle relative to the beam, rather than to align it perfectly with the beam;
[0065] Fig.17 Shows something like Figure 6 The sensor unit shown is a sensor unit, but the sensor is conveniently mounted externally;
[0066] Fig.18 shows the laser beam entering Fig.17 alternative access paths for the sensor unit to enable the calibration run to be repeated along the same beam with the head at different angles;
[0067] Fig.19 To explain the measurement Fig.17 a method for determining the spacing between sensors in a sensor unit;
[0068] Fig. 20 is a three-dimensional representation of two two-dimensional sensors forming part of a sensor unit embodying the invention for measuring relative motion in four degrees of freedom;
[0069] Fig.21 is a three-dimensional representation of four one-dimensional sensors forming part of a sensor unit embodying the invention for measuring relative motion in four degrees of freedom;
[0070] Fig. 22 is a diagram showing the use of three measurement positions from which relative motion can be determined in three degrees of freedom including pitch;
[0071] Fig.23 is a diagram showing the use of four measurement positions from which relative motion can be determined in four degrees of freedom including pitch and yaw;
[0072] FIG. 24A to FIG. 24C A schematic is shown showing how a single sensor can be moved between multiple measurement locations, rather than having a sensor at each measurement location;
[0073] Fig.25A and Fig.25B Schematic showing the use of movable optical components to create multiple measurement positions for a static sensor;
[0074] Fig.26 Demonstrates the effective in-line position of the distal sensor as the optical path of the reflected beam spreads out;
[0075] Fig. 27 shows a sensor unit with a rotation joint having a center of rotation coinciding with the actual position of a distal sensor of the sensor unit;
[0076] Fig.28 Shows Fig. 27 a sensor unit that is coupled to the robot arm via a rotary joint and is moved along the laser beam as part of a calibration routine;
[0077] Fig.29 It shows how a rotary joint can be used to change the mounting angle of the sensor unit so that additional calibration data can be collected along the same laser beam;
[0078] Fig.30 shows collecting additional calibration data after changing the direction of the laser beam and with the sensor unit mounted at different angles via a swivel joint;
[0079] Fig.31 shows collecting additional calibration data after changing both the position and direction of the laser beam and with the sensor unit mounted at different angles via a swivel joint;
[0080] Fig.32 A separate linear measurement device coupled to the robotic arm via a spherical adapter is shown, the linear measurement device being used to collect calibration data related to the additional degree of freedom; and
[0081] Fig.33 shows how the sensor unit itself can be Fig.32 The ball adapter is mounted to the robot arm;
[0082] Fig.34 An alternative arrangement is shown in which the sensor unit is coupled to a fixed base of the machine and the transmitting unit is coupled to a moving part of the machine;
[0083] Fig.35 A method of calibrating or otherwise characterizing a machine according to an embodiment of the present invention is presented in the form of a flow chart;
[0084] Fig.36 It is demonstrated that an embodiment of the invention is applied to characterize a linear axis provided by a track along which a robotic arm can move;
[0085] Fig.37 shows how performing two passes along the same beam when the sensor unit is at different respective lateral or radial or transverse positions relative to the beam can be used to determine the roll degree of freedom; and
[0086] Fig.38 Shows how to use the same Fig.37 The same sensor reading is interpreted as a translation.
[0087] Figure 3 A robot arm 1 is shown, which is generally similar to the robot arm described above with reference to Figure 1 and Figure 2 The described robot arm has a plurality of segments 5 connected by a combination of transverse rotation axes 6 and in-line rotation axes 7 . Figure 3 A calibration system for calibrating a robot arm 1 according to an embodiment of the present invention is also shown. The calibration system comprises a sensor unit 10, a transmitting unit 20, and a processor unit 30.
[0088] The transmitting unit 20 is operable to transmit a laser beam 21 into the working volume of the robot arm 1. The sensor unit 10 coupled to the robot arm 1 via the flange 3 is movable relative to the transmitting unit 20 by the robot arm 1 to a plurality of sensor unit positions along the beam 21, the relative movement being controlled by the controller 8.
[0089] The sensor unit 10 includes a first two-dimensional sensor 11 and a second two-dimensional sensor 12, which are used to measure the lateral (or sideways) two-dimensional position of the beam 21 within the sensor unit 10, that is, the two-dimensional position of the beam 21 in a plane transverse (e.g., orthogonal) to the beam 21 at two corresponding measurement positions along the beam 21.
[0090] Figure 4AAn example two-dimensional sensor 11, 12 comprising a two-dimensional array of sensor pixels is shown in When a beam 21 is incident on the sensor 11, 12, the two-dimensional lateral position X, Y of the beam 21 can be determined based on the row and column of sensor pixels having the strongest response.
[0091] Alternatively, instead of using Figure 4A The dense two-dimensional sensor pixel array shown can be used as Figure 4B The two-dimensional sensor shown is based on a four-element design. There are four output signals Q1, Q2, Q3, and Q4 from the sensors 11, 12, and from the relative strengths of these output signals the two-dimensional lateral X, Y position of the incident beam 21 can be determined using known equations.
[0092] As another alternative, a position sensitive detector (PSD) may be used for the sensors 11, 12. This type of detector has a single isotropic sensing area, rather than being based on Figure 4A and Figure 4B Typically, a PSD will have four outputs, such as Figure 4B A four-element sensor is shown in which the incident beam 21 causes a change in the local resistance and therefore also a change in the electron flow (current) in the four outputs. From these four output signals, the two-dimensional lateral X, Y position of the incident beam 21 can be calculated again using known equations.
[0093] exist Figure 3 In the case of the sensor unit 10 shown, the laser beam 21 is first incident on the first sensor 11 (at the first measuring position) and then incident on the second sensor 12 (at the second measuring position), wherein the beam 21 passes through the first sensor 11 to the second sensor 12 behind the first sensor 11. Although it is possible to use a semi-transparent detector for the first sensor 11, for example, Figure 5 An alternative optical arrangement for a sensor unit 10 is shown which uses a beam splitter 13 and sensors 11, 12 at right angles to the beam splitter 13 and at different respective spacings. This is optically equivalent to Figure 3 The in-line version of the sensor unit 10 shown also avoids the need for a translucent detector. Figure 6, another configuration of the sensor unit 10 is shown, which uses a beam splitter 13 to direct a portion of the beam 21 to a first sensor 11, which is arranged on one side of the sensor unit 10 at right angles to the incident beam 21, and uses a reflector 14 to direct the remainder of the beam 21 to a second sensor 12, which is arranged in the optical path of the beam 21, after the beam splitter 13, and the second sensor is also positioned on one side of the sensor unit 10. It will be appreciated that the second sensor 12 does not have to be at right angles to the incident beam 21, and it may also be arranged on the other side of the sensor unit 10 compared to the first sensor 11. Other configurations of the sensor unit 10 will be discussed further below (see, for example, FIG. 24A to FIG. 24C and Fig.25A and Fig.25B ). See below for reference Fig.26 and Fig. 27 Further discussion and Figure 6 Certain advantages are associated with the sensor unit 10 .
[0094] Now refer to Figure 7 A method of calibrating a robot arm 1 using a sensor unit 10 is described. First, the robot arm 1 is controlled using a controller 8 to move the sensor unit 10 toward the lower end of the beam 21. The controller 8 then adjusts the position of the sensor unit 10 relative to the beam 21 until the beam 21 is centered over the two sensors 11, 12. At this sensor unit position A, the sensor unit 10 is known to be aligned with the beam 21 as the beam 21 passes through the center of the two sensors 11, 12. The machine coordinates of this sensor unit position A are recorded.
[0095] The robot arm 1 is then controlled using the controller 8 to move the sensor unit 10 towards the upper end of the beam 21. The controller 8 then adjusts the position of the sensor unit 10 relative to the beam 21 until the beam 21 is again centered over the two sensors 11, 12 ("zero position" or "zero pose"). At this sensor unit position B, as the beam 21 passes through the center of the two sensors 11, 12, it is known that the sensor unit 10 is again aligned with the beam 21. The machine coordinates of this sensor unit position B are recorded.
[0096] At sensor unit position B, instead of rotating the sensor unit 10 to align the beam 21 with the center of the two sensors 11, 12, it is also possible to maintain the same orientation of the sensor unit 10 (i.e., the same as for the other position A) and command the robot 1 to adjust the X, Y, Z position of the sensor unit 10 so as to align only one of the sensors 11, 12 with the beam 21 (e.g., the one of the sensors 11, 12 that is considered as a reference for the coordinate system X, Y, Z, A, B, C of the sensor unit 10, see more below with reference to Fig.1210). Any misalignment at the other of the sensors 11, 12 may be small enough not to cause any problems. This is beneficial because it is then relatively simple to command the robot to adjust only the X, Y, Z position of the sensor unit 10 to move it along the beam 21 between sensor unit positions without having to adjust the A, B, C orientation of the sensor unit 10. Preferably, the sensors 11, 12 used as a reference for this translation in X, Y, Z are also arranged to coincide with the tool center point (TCP), as described below with reference to Figure 28 to Figure 31 discussed.
[0097] The path of the sensor unit 10 is then calculated by the controller 8, which will attempt to move the sensor unit 10 from position B to position A in a straight line, always keeping the sensor unit 10 perfectly aligned with the beam 21. The path is determined based on the existing machine parameters, and so although it is expected (based on these machine parameters) that the sensor unit 10 will remain aligned with the beam 21 as it moves along the beam, this is not the case in practice because the machine parameters do not perfectly represent the geometry of the machine. The purpose of the calibration method is to produce a new set of machine parameters that will better represent the geometry of the machine, thereby resulting in an improved calibration.
[0098] The robot arm 1 is then controlled using the controller 8 so that the sensor unit 10 moves relative to the transmitting unit 20 along the calculated path, starting from sensor unit position B and ending at sensor unit position A, the sensor unit 10 passing through a number of intermediate sensor unit positions. At each of these intermediate sensor unit positions, the machine coordinates (i.e., the rotary encoder readings representing all rotary joint angles) and the lateral two-dimensional measurements from the two sensors 11, 12 are recorded.
[0099] If the calibration is perfect, the beam 21 will remain perfectly centered on the two sensors 11, 12 at each of the intermediate sensor unit positions, i.e. the lateral position will always be X = 0 and Y = 0. However, in practice, the calibration is not perfect and the lateral position of the beam 21 on the sensors 11, 12 will vary from X = 0 and Y = 0.
[0100] When all measurements from the sensors 11, 12 have been collected from the trip from sensor unit position B to sensor unit position A, these measurements are passed to the processor unit 30. The processor unit 30 performs a numerical optimization or error minimization routine as previously described, which involves a comparison between the actual measurements from the sensor unit 10 and the expected measurements from the sensor unit 10 (i.e., as expected based on an existing set of model parameters characterizing the geometry of the machine). Based on this comparison, the processor unit 30 updates the model parameters so as to provide a closer match between the expected measurements (i.e., expected based on the new set of model parameters) and the actual measurements (from the previous trip). In other words, the updated model parameters better represent the geometry of the machine than the previous version of the model parameters.
[0101] For example, if a programmed path from B to A (or vice versa) is expected to produce sensor readings of X=0 and Y=0 for each sensor unit position (because the path is programmed to achieve this, at least in theory), and the actual sensor reading for one of the sensor unit positions is X=3 and Y=2, then after the model parameters have been optimized, the expected sensor readings for the same set of actuator position demands (i.e., the commanded angles for each rotary joint) should be closer to X=3 and Y=2 (rather than X=0 and Y=0 as before). However, it should be noted that the error minimization routine attempts to minimize the overall error over all calibration data, so it is possible that some expected measurements will be slightly further away from the actual measurements, while many others will be closer (so that the overall calibration is improved).
[0102] To further improve the calibration, several passes may be performed, for each pass the laser beam 21 being emitted into the working volume of the machine in a different direction, such as Figure 8 , and the measurements from all strokes are fed into a numerical optimization or error minimization routine. This results in a more thorough calibration, as the robot arm 1 is moved into more different poses or configurations, with calibration data collected for more different combinations of rotary joint angles. The calibration can be further improved by moving the transmit unit 20 to one or more different transmit positions and collecting more measurement data from each of these transmit positions, preferably transmitting the beam 21 at a plurality of different angles for each transmit position, such as Fig. 9 shown.
[0103] To illustrate the concept of expected measurement results and actual measurement results in the above method, Fig.10 A simplified representation of a sensor unit 10 is shown, wherein each sensor 11 , 12 is shown as a one-dimensional sensor with five different positions 0 to 4 . Fig.11The sensor unit 10 is shown at several sensor unit positions along the beam 21, starting at [2,2] (i.e., the beam 21 is incident at lateral position 2 on the first sensor 11 and the second sensor 12). This is the "zero" starting position A as described above, in which the sensor unit 10 is aligned with the beam 21. However, for the next three sensor unit positions, the sensor readings are [1,2], then [0,1], then [1,3], whereas the expected sensor reading for each sensor unit position is [2,2], so that instead of a purely linear motion of the sensor unit 10 relative to the beam 21, an undesirable relative rotation is introduced due to the non-ideal calibration of the robot arm 1. In this simple example, the comparison between the expected sensor reading and the actual sensor reading is determined as "actual minus expected" as follows: [0,0] [-1,0] [-2,-1] [-1,1], which would ideally be [0,0] for each sensor unit position after the model parameters have been optimized.
[0104] The amount of undesired rotation, and therefore the amount of correction that will need to be applied in calibration to eliminate it, can be determined by comparing the lateral positions of the beam 21 on the respective sensors 11, 12 (i.e. taking the difference between them), and also taking into account the spacing between the sensors 11, 12. Fig.12 As shown, if the difference in lateral position from one sensor to the other is denoted as 'y', and the spacing between the sensors is denoted as 'd', then using simple trigonometric functions, they are related by:
[0105]
[0106] And therefore:
[0107]
[0108] Therefore, in order to determine the angle information, it is necessary to know the spacing 'd' between the sensors 11, 12. However, it should be noted that it is not generally required to know this spacing with a high degree of accuracy, as this angle information is used in the error minimization routine to determine how large (and in what direction) adjustments need to be made for each iteration in the iterative routine, for example when performing a gradient descent type algorithm, (for example, if there is some uncertainty about the accuracy of the angle information), smaller steps may be taken in the gradient descent rather than larger steps, although this may take longer to reach a steady state (i.e., find a local minimum in the error minimization routine). The method for determining the spacing between the sensors 11, 12 is further explained below.
[0109] The lateral position of the sensor unit 10 relative to the beam 21 may be derived from measurements from the sensor 11, or from the sensor 12, or from a combination of measurements from the sensors 11, 12. It may be convenient to place the center of the coordinate system of the sensor unit 10 (e.g. X, Y, A, B when considering four degrees of freedom) on one of the sensors 11, 12, so that only one of the sensors 11, 12 is used to determine the lateral position X, Y, and the combination of sensors is used to determine the angular position A, B (or Fig.12 The lateral position X and angular position A in a simplified one-dimensional example. For example, Fig.12 , the lateral position X will be 1 (i.e. the position where beam 21 is incident on sensor 11), and the angular position A will be θ (determined based on the combination of lateral position 1 from sensor 11 and lateral position 3 from sensor 12, as described above). It may be convenient to align the coordinate system with whichever of sensors 11, 12 is closest to machine 1, so in Figure 3 In this case, this would be sensor 12 rather than sensor 11, but either is possible. Figure 28 to Figure 31 Explore this concept further.
[0110] Fig.13 Another example is shown where the actual measurement is [2,2][3,3][4,4][2,2], where the comparison value is [0,0][1,1][2,2][0,0], so that in this case there is no undesired rotation (no rotation error), but there is some linear drift (linear error). Furthermore, after optimization, ideally, this linear drift will be calibrated so that the comparison value at each sensor unit position will be [0,0]. Fig.14 The example presented in shows that it is not necessary to start and end each stroke with the beam 21 centered on the two sensors 11, 12, but any calibration path can be programmed so that the beam remains incident on both sensors throughout the stroke. Fig.14 In , a linear path is programmed to start with a sensor reading of [0,1] and end with a reading of [3,4]. If the actual readings along the path are Fig.14 As shown, i.e. [0,1][1,2][2,3][3,4], the sensor unit 10 has moved along the beam without any rotational or translational drift, and the calibration cannot be improved in this example.
[0111] Using the calibration method described above, the sensor unit 10 is moved along a pre-programmed path from one end of the laser beam 21 to the other, collecting measurement data from the sensor unit 10 at each sensor unit position along the path. For an imperfect calibration, the actual sensor measurement data will deviate from the expected sensor measurement data along the path, and the purpose of the calibration method is to analyze these deviations in order to produce a calibration that will eliminate or at least reduce these deviations (in subsequent strokes or subsequent operational use of the robot arm 1). Rather than allowing these deviations to occur during the calibration method, an alternative approach is to actively adjust or servo the movement of the robot during the calibration stroke in order to attempt to keep the sensor unit 10 aligned with the beam 21 at all times, rather than as Fig.11 and Fig.13 Make it drift as shown.
[0112] With this alternative approach, the path is programmed as before and the control unit 8 operates to move the sensor unit 10 along this pre-programmed path, but the control unit 8 is also able to operate (in collaboration with the processor unit 3) to serve the movement of the machine based on measurements from the sensor unit 10 (these sensor measurements act as feedback in a servo loop) so as to attempt to maintain substantially constant measurements from the sensor unit 10 for each of the sensor unit positions along the beam 21. Fig.15 This alternative approach is shown in , where the sensor reading is actively maintained at [2,2] under servo control throughout the stroke. Of course, the sensor reading does not have to be maintained at [2,2], but can be maintained at [1,2] (e.g. Fig.16 ) or any other set of sensor readings. In any case, it is known that the sensor unit 10 moves along a straight line and at a constant angle relative to the beam 21, and any adjustments from the servo control are to offset the effects of calibration errors.
[0113] For this alternative servo method, a similar analysis regarding the adjustment of the model parameters can be performed as for the previous method, as it involves a comparison between actual measurements from the sensor unit 10 and expected measurements from the sensor unit 10. In this case, due to the servo control, the actual measurements are always [2, 2], and the expected measurements for a particular sensor unit position will be based on the expected position of the sensor unit 10 using the same position demand (as adjusted by the servo control) based on an existing set of model parameters that characterize the geometry of the machine, resulting in the actual measurements for that sensor unit position [2, 2]. Based on this comparison, the processor unit 30 updates the model parameters in order to provide a closer match between the expected measurements and the actual measurements, so that the updated model parameters better represent the geometry of the machine than the previous version of the model parameters.
[0114] The servo method is advantageous because it means that it is not necessary to calibrate the sensors 11, 12 themselves, as the beam remains substantially static at a single point on both sensors 11, 12, and any small deviations are quickly corrected by the servo control. Advantageously, the position signal from one of the sensors 11, 12 can be used to control X, Y during the servo movement, while the position signal from the other of the sensors 11, 12 can be used to control the 'yaw' and 'pitch' of the head (taking into account the position signal from the other sensor and the spacing between the sensors to derive the angle). Likewise, as described above in relation to the first method, for the servo method, it is not necessary to measure the spacing between the sensors 11, 12 with high accuracy, as it is more important that the spacing between the sensors is fixed, rather than knowing exactly what the spacing is. For example, for a sensor spacing of 100mm, an accuracy of no more than 1mm may be sufficient. This is because in order for the servo control to be effective, it is not necessary to know the exact angle, as the servo is actually based on making small changes to the angle (and observing how this affects the sensor measurements) rather than commanding an exact absolute angle. This is an advantage of the method according to an embodiment of the invention, as it is only necessary to have a fixed (although not exactly known) spacing.
[0115] Fig.17 Shown with Figure 6 A sensor unit 10 of similar form is shown, but the sensors 11, 12 are conveniently mounted to an external surface for ease of access and maintenance. Fig.17 and Figure 6 Similarly, the normal path of the laser beam 21 through the sensor unit 10 and onto the two sensors 11 , 12 is shown. Fig.18 , the beam is incident on the beam splitter 13 from the side opposite to the first sensor 11, a portion of the beam 21 passes through the first sensor 11, while the remainder is directed to the reflector 14 and then reflected to the second sensor 12. The sensor unit 10 thus has multiple entry points for the beam 21 at different respective angles while still passing through the same sensor measurement location. This is advantageous because it enables a first calibration pass to be performed with the laser beam 21 using a first internal path (where the beam enters at a first angle), and a second calibration pass to be performed with the same oriented laser beam 21 but using a second internal path through the sensor unit 10 (where the beam enters at a second angle different from the first angle). The robot arm 1 will use a series of very different poses for the first pass than for the second pass, and the overall calibration will therefore be more complete (in a manner similar to Figure 8 and Fig. 9 method).
[0116] Now refer to Fig.19 A method for measuring the distance between sensors 11, 12 is described. The sensor unit shown in the figure is similar to the one in Fig.17 and Fig.18 . First, the robot arm 1 is controlled to move the sensor unit 10 so that the laser beam 21 passes through the sensor unit 10 along a first path 22 at a certain angle so that the laser beam is directly incident on the first sensor 11 without passing through the beam splitter 13. The exact angle of entry is not important, as long as the beam avoids any internal components; for example, any path in a cone formed by rotating the path 22 around the line connecting the reflector 14 to the sensor 12 is sufficient. If the reflector 14 is instead a beam splitter, the beam can also be made to pass directly through the beam splitter as a continuation of the line connecting the reflector 14 to the sensor 12. Then, the robot arm 1 is controlled to move the sensor unit 10 so that the laser beam 21 passes through the sensor unit 10 along a second path 23 (at the same angle as the path 22) so that the laser beam is directly incident on the second sensor 12 without being blocked by the reflector 14. The spacing between the two sensors 11, 12 can then be determined as the distance the sensor unit 10 has moved. Even based on a rough calibration of the robot arm 1 , this is a sufficiently accurate measurement of the spacing between the sensors 11 , 12 , since, as mentioned above, it is not important to know this spacing with a high degree of accuracy.
[0117] Fig. 20 The sensor 11 and the sensor 12 are provided. Figure 4B A three-dimensional representation of two sensors 11, 12 of the type shown (forming part of a sensor unit 10). For simplicity, these sensors are arranged in a row along the laser beam 21 (e.g. Figure 3 ) rather than in an offset arrangement (as shown Figure 6 Each of the sensors 11, 12 is a two-dimensional sensor, measuring the lateral (or sideways) position of the laser beam 21 in two directions (or dimensions) X and Y. However, it will be appreciated that each of the two-dimensional sensors 11, 12 may be formed by two one-dimensional sensors, such as Fig.21 As shown. Fig.21In the sensor arrangement of , the first two-dimensional sensor 11 is formed by a first one-dimensional sensor 11x for measuring the beam position in the X direction and a second one-dimensional sensor 11y for measuring the beam position in the Y direction. The position measurement results from these two sensors 11x, 11y can be used together to provide the two-dimensional position of the beam 21. Similarly, the second two-dimensional sensor 12 is formed by a first one-dimensional sensor 12x for measuring the beam position in the X direction and a second one-dimensional sensor 12y for measuring the beam position in the Y direction. Of course, it is also possible to use a two-dimensional sensor as one of the sensors 11, 12, and to use two one-dimensional sensors as the other of the sensors 11, 12.
[0118] Fig. 22 A sensor arrangement for a sensor unit 10 is shown, the sensor unit being operable to measure a transverse beam position at three measurement positions Y1, X1, Y2 along the beam 21 (wherein the measurement position 'X1' is indicated by an 'X' in the upper left corner and a '1' in the lower right corner) for each of a plurality of sensor unit positions along the beam 21. From these three measurements, the position of the sensor unit 10 relative to the beam 21 (or the transmitting unit 20) can be derived in three degrees of freedom (3DOF): two transverse translational degrees of freedom (along transverse axes X, Y, where axis Z is the longitudinal axis) and one transverse rotational degree of freedom (about the X transverse axis, also referred to as 'pitch'). Of the three degrees of freedom, the two translational degrees of freedom X, Y can be derived from the X and Y measurements taken at the measurement positions X1 and Y1 respectively, while the rotational degree of freedom can be derived from the Y measurement taken at the two spaced apart measurement positions Y1 and Y2. The pitch angle θ can be determined from the distance dY between the two measurement positions Y1, Y2 and the difference y between the position measurement results of these measurement positions Y1, Y2 (also as described above with reference to Fig.12 discussed):
[0119]
[0120] exist Fig. 22 In the arrangement shown, the measurement locations X1 and Y1 may be coincident (using a single 2D sensor) or substantially coincident (but using two separate 1D sensors) or spaced apart (using two separate 1D sensors).
[0121] and Fig. 22 compared to, Fig.23The sensor arrangement shown includes a fourth measurement position X2 which provides a transverse beam position measurement in the X direction (or dimension). By adding this fourth measurement position X2, the position of the sensor unit 10 relative to the beam 21 (or transmitting unit 20) can now be derived in four degrees of freedom (4DOF), wherein 'yaw' (rotation about the Y transverse axis) can also be measured in a similar manner to the reference Fig. 22 The manner described for 'pitch' results. Likewise, the measured positions X2 and Y2 may be coincident (using a single 2D sensor) or substantially coincident (but using two separate 1D sensors) or spaced apart (using two separate 1D sensors). Fig. 22 and Fig.23 Any of the sensor arrangements constitute embodiments of the present invention.
[0122] Reference again Fig. 22 , it is obvious that the sensor at position Y2 can be rotated 90 degrees to provide an additional position X2 (such as Fig.23 ), thereby providing relative position information in four degrees of freedom (4DOF) rather than three degrees of freedom (3DOF). For each sensor unit position, this rotation can be completed in a single pass: move to the new sensor unit position, measure at measurement position Y2, then rotate to create measurement position X2, then move to the next sensor unit position, measure X2, then rotate to create Y2, measure, etc. Or a full pass along laser beam 21 can be performed with the Y2 configuration, and another pass can be performed with the X2 configuration, measuring at the same sensor unit position along beam 21.
[0123] use Fig.24A and Fig. 24B This concept is further explored in the illustrated sensor unit 10, which has a single two-dimensional sensor 12 that can be moved between two (e.g., kinematically defined) positions 15 and 16 by a piston 17 (in which two sensors 11 and 12 are actually created). The positions 15 and 16 are separated by a fixed distance. This concept is Fig.24C Further extending the invention, the sensor unit has a single one-dimensional sensor 11 which can be moved between two fixed positions 15 and 16 and can also be rotated between two fixed angular positions, thereby providing a single one-dimensional sensor. Fig.23 All four measurement positions X1, Y1, X2, Y2.
[0124] In addition to moving the sensor itself, this can also be achieved by optical means, such as by moving an optical component between two positions to create two different path lengths for the laser to the same sensor in the same position, or by switching in delay lines or additional optical paths, or by switching in additional components to increase the optical path length. Fig.25A and Fig.25B Only one example is shown in FIG. 1 , which has a single two-dimensional sensor 11, a reflector 19 facing the sensor 11, and a beam splitter 13 mounted on a rotating stage 25. The beam splitter 13 can be Fig.25A The first position shown is rotated to Fig.25B In the second position shown, in the first position the beam 21 is directed directly to the sensor 11, in the second position the beam 21 is directed to the reflector 19 and then back to the sensor 11. This actually creates two measurement positions for the sensor unit 10 and is therefore equivalent to, for example Figure 3 , Figure 5 ,and Figure 6 Of course, Fig.25A and Fig.25B The two-dimensional sensor 11 may be replaced by a one-dimensional sensor and a device for rotating the one-dimensional sensor 90 degrees, thereby recreating the Fig.23 All four measurement locations shown.
[0125] Now refer to Fig.26 and Fig. 27 Description of the invention with sensors 11, 12 (and more specifically sensor 12) on one side of incident beam 21 Figure 6 Where the distance between the reflector 14 and the sensor 12 is indicated as 'd', when the optical path of the beam 21 after the beam splitter 13 is "unfolded", it is apparent that the sensor 12 is substantially in line with the input beam 21 and is located at the same distance 'd' from the reflector 14 after the reflector 14. Fig.26 , (a similar "unfolding" can be performed with respect to another sensor 11 to show where it would be if it were to be aligned with the input beam 21). This enables the sensor 12 to be located practically outside the main housing of the sensor unit 10, such as Fig.26as depicted. This therefore creates space for a swivel joint 18, which is used to form a connection between the sensor unit 10 and the robot arm 1. The swivel joint 18 may have a plurality of graduated rotational positions, or it may be continuously adjustable. Furthermore, the center of rotation of the swivel joint 18 is preferably arranged to coincide with the actual sensor position (12), so that the sensor unit 10 may be rotated about the swivel joint 18 to change the orientation of the sensor 12 without also moving (translating) the sensor 12 in X, Y, Z. Even more advantageously, when the sensor unit is mounted to the robot arm 1, the center of rotation of the swivel joint 18 may also be arranged to coincide with a position of interest of the robot arm 1, such as the tool center point (TCP), as will now be referred to. Figure 28 to Figure 31 Explained.
[0126] Fig.28 The sensor unit 10 is shown coupled to the robot arm 1 via a swivel joint 18, wherein the swivel joint coupling is designed so that the center of the swivel joint 18 coincides with the currently programmed TCP of the robot arm 1. The robot arm 1 is then controlled to perform a movement of the sensor unit 10 along the beam 21 as described above. In general, robot control is complex due to the way in which the various swivel joints 5, 6 interact and combine, but it is relatively simple to command the robot arm 1 relative to the current TCP, such as translating the TCP in X, Y, Z or rotating the robot's head around the TCP in A, B, C (i.e. keeping the TCP in the same position in X, Y, Z). Thus, having the sensor 12 actually coincident with the TCP enables the robot arm 1 to be more easily controlled as it moves along the beam 21, because the position of the sensor 12 in X, Y, Z can be controlled via the TCP, and likewise the overall orientation of the sensor unit 10 can be controlled separately by commanding the robot arm 1 to rotate around the TCP in A, B, C (without changing the position of the sensor 12 in X, Y, Z), i.e. translation and rotation can be handled and controlled independently.
[0127] like Fig.29 As shown, the sensor unit 10 can then be rotated about the rotary joint 18 so that another stroke can be performed for the same orientation of the beam 21, thereby Fig.28 The rotary joints 5 , 6 are employed in a different combination than the strokes performed in the embodiment of the present invention, thereby providing a better overall calibration of the robot arm 1 . Fig.30 Another pass is shown with beam 21 emitted from the same position but at a different angle, while Fig.31 Another stroke is shown performed with the beam 21 emitted from different positions, in each case the rotary joint 18 allowing the sensor unit 10 to be mounted in a flexible manner to the robot arm 1 at different angles relative to the head of the robot arm 1 .
[0128] It should be noted that the above-mentioned benefits of arranging the sensor 12 to be substantially coincident with the TCP apply independently of the presence or otherwise of the rotary joint 18. In other words, even if the coupling between the machine 1 and the sensor unit 10 does not have a rotary joint (such as Figure 3 As shown), when the sensor unit 10 is coupled to the machine 1, it is beneficial to arrange one of the two sensors 11, 12 (conveniently, the sensor 12 closest to the machine 1) to coincide with the TCP for the same reasons as above.
[0129] It should also be noted that if Figure 28 to Figure 31 The concepts shown are independently applicable to any directional sensor unit that is mounted in a fixed orientation to a non-Cartesian machine to perform a method for characterizing the machine, and that can be moved between a plurality of different fixed orientations relative to the machine (and can also be moved in a similar manner to Fig.17 and Fig.18 The method can be performed in a plurality of different sensing directions as shown) to enable the method to be performed using a plurality of differently configured machines for the same sensing operation. This is particularly applicable if the sensor unit is of a type capable of making measurements whereby the position of the sensor unit relative to the beam can be derived in at least three degrees of freedom (3+DOF).
[0130] US2016 / 0243703 A1 describes a system in which a single laser beam interacts with a single sensor, and from which no information can be derived about the relative rotational degrees of freedom used for calibration. Even in the case of using two sensors and two laser beams, the spacing between the sensors is neither fixed nor known, so no information about the relative rotational degrees of freedom can be derived. Unlike US2016 / 0243703 A1, embodiments of the present invention are conveniently capable of measuring relative motion in at least three (preferably four) degrees of freedom using only a single laser beam.
[0131] The XM-60 calibration device manufactured and sold by Renishaw plc is designed to measure the relative motion of a receiver unit relative to a transmitting unit in all six degrees of freedom (6DOF) for machine calibration purposes. However, the calibration device requires four laser beams to be emitted from the transmitting unit. The fourth beam is incident on a two-dimensional sensor for measuring horizontal and vertical straightness based on how the beam moves in the X, Y directions on the sensor as the receiver unit moves along the beam. The fourth beam is also used to measure roll (rotation around the longitudinal axis of the beam) by sensing how the linear polarization of the beam rotates as the receiver unit moves along the beam. The other three degrees of freedom (pitch, yaw, linear straightness) are determined by interferometry of the other three laser beams, i.e. measuring the distance (or change in distance) and thereby determining pitch, yaw, and linear straightness.
[0132] Unlike the XM-60, embodiments of the present invention are able to conveniently measure relative motion in four degrees of freedom (4DOF) using only a single laser beam instead of four. Embodiments of the present invention can be enhanced by adding a roll sensor as used in the XM-60, so that relative position can be measured in five degrees of freedom (X, Y, pitch, roll, yaw) using only a single laser beam. Such a roll sensor is described in WO 2008 / 122808, which is incorporated herein by reference. Thus, the only missing degree of freedom (of the six degrees of freedom) is the measurement of linear straightness, i.e., the rotation of the axis along the laser beam ( Fig.23 The Z axis in the coordinate system shown).
[0133] Return to reference Fig.19 , with reference to which it is described that the robot 1 itself can be used to measure the spacing between the sensors 11 and 12. If the spacing between the sensors 11 and 12 is known by some other means (e.g., by a separate coordinate measuring machine), then this known spacing can be used to provide measurement information related to the last linear degree of freedom (along the beam). This can be done by moving the sensor unit 10 along Fig.19 This is achieved by moving the main beam path 21 shown, but beam 21 enters the sensor unit 10 at an angle corresponding to paths 22, 23, so that the angled beam 21 is incident on sensors 11 and 12 in either order (via paths 22, 23, respectively). The known spacing between sensors 11, 12 can then be used to calibrate or otherwise characterize the linear degrees of freedom along path 21.
[0134] A calibration system embodying the invention may also be provided with a separate linear measurement device (or strut or ballbar) 41 to enable calibration of this last degree of freedom, e.g. Fig.32 As shown. Such a linear measuring device 41 is described in detail in our related WO 2019 / 162697, which is incorporated herein by reference. The linear measuring device 41 can be mounted to the robot arm 1 instead of the sensor unit 10 for collecting measurements along the longitudinal axis (i.e. where the laser beam 21 is located). The linear measuring device 41 can be used to collect measurements in a variety of different orientations, so that the joints of the robot 1 will also be in a wider variety of states accordingly to improve the overall calibration.
[0135] WO 2019 / 162697 also describes how the linear measuring device 41 can be advantageously mounted, as well as Fig.32As shown, via a spherical adapter 44 and a corresponding coupling 47 on the linear measuring device 41, the linear measuring device 41 can be pivoted exactly around the TCP 48. The spherical adapter 44 is attached to the robot arm 1 so that the tool (e.g., a welding tool) can remain in position on the robot arm 1 even when performing calibration, with the center of the spherical adapter 44 coinciding with the TCP 48. The other end of the linear measuring device 41 has a ball 45, which is rotatably coupled to the mounting 42. Further details of the spherical adapter concept can be found in WO 2019 / 162697.
[0136] like Fig.33 As shown, Fig.32 The spherical adapter 44 can also be used to mount the sensor unit 10 itself by providing the sensor unit 10 with an internal (e.g., motion) cup cavity 81, and wherein the sensor unit 10 is magnetically coupled to the spherical adapter 44 via the internal cup cavity 81. The internal cup cavity 81 has a substantially partially spherical concave surface, the radius of which matches the radius of the spherical adapter 44 (the internal cup cavity 81 is preferably provided with a motion contact feature as described in WO 2019 / 162697). The center of the partially spherical surface of the internal cup cavity 81 is also arranged to coincide with the actual position of the sensor 12, so that the sensor unit 10 can move around the spherical adapter 44 to change the orientation of the sensor 12 without also moving (translating) the sensor 12 in X, Y, and Z, which is consistent with the above reference to Fig.26 and Fig. 27 As described above, since the center of the ball adapter 44 is coincident with the TCP, the sensor 12 itself is also coincident with the TCP and remains coincident as it moves around the ball adapter 44 to different orientations. In the case of a sufficiently strong magnetic coupling force between the sensor unit 10 and the ball adapter 44, no additional retaining features will be required, which is feasible in practice because the sensor unit 10 is contactless and therefore not subject to any destabilizing forces (except gravity and acceleration forces, both of which are generally manageable).
[0137] Instead of using a separate linear measurement device (or ballbar) 41 for the sixth (linear) degree of freedom, some of the beam 21 may instead be returned to the transmitting unit 20 (e.g. by using a retroreflector in the sensor unit 10) so that the sixth (linear) degree of freedom can be determined interferometrically, i.e. based on interference between the returned (measurement) beam and a reference beam, as is well known (and as used in the XM-60 and XL-80 calibration devices manufactured and sold by Renishaw plc).
[0138] The above description focuses on a system for calibrating a machine (such as a robotic arm) that not only identifies errors associated with a parameterized model used to characterize the machine's geometry, but also corrects or accounts for those errors to provide better calibration. The technique can also be used to identify or assess machine errors without actually correcting them, such as as part of a machine validation procedure to assess the overall performance of the machine. The technique can also be used when setting up a machine. It should be considered, therefore, that the present invention relates to a system and method for characterizing a machine in a general sense, including calibration, validation, and the like.
[0139] In the various embodiments shown and described herein, the processor unit 30 is shown as forming part of the controller 8, but the processor unit 30 may be separate from the controller 8 and / or remote from the controller. For example, the measurement data may be sent to a remote site for processing rather than being processed on-site. The processor unit 30 is intended to represent a device for providing additional functionality associated with embodiments of the present invention and not provided by conventional controllers, which may be additional functionality for the controller (e.g., providing the above-mentioned servo control when collecting measurement data) or additional functionality external to the controller (e.g., performing off-site processing on the collected measurement data).
[0140] The calibration system embodying the invention has the advantage of using an optical (i.e. contactless) coupling between the moving and fixed parts of the machine, and therefore, it does not introduce additional loads which might otherwise affect the accuracy of the measurements (and therefore the validity of the resulting machine calibration or verification), as would be the case with a mechanical form of a multidimensional measuring arm. The sensor unit 10 itself can be of very light construction so that it does not provide any significant additional load due to its weight, and the tool can be left in place while this calibration is being carried out, the sensor unit 10 being attached only during a quick calibration routine, in which the load on the robot arm 1 is substantially the same as in actual use.
[0141] The sensor unit 10 may take sensor measurements only when moving, or only when stationary, or a combination of both. A motion sensor, such as an accelerometer, may be added to sense when the sensor unit 10 is moving to ensure that measurements are taken only when moving or only when stationary. Such a motion sensor may also be used to compensate for vibration effects caused by defects in the drive system of the machine or other environmental factors that may cause the machine to vibrate. It would also be advantageous to measure the ambient light level (e.g., based on a comparison between sensor readings with the laser beam 21 turned on and off) and compensate for the ambient light level based on the sensor readings.
[0142] Although the above description shows that the sensor unit 10 is mounted to the movable element of the machine and the transmitting unit 20 is mounted to the fixed base 2 of the machine, the situation can also be reversed, so that the transmitting unit 20 is mounted to the movable element and the sensor unit 10 is mounted to the base 2, such as Fig.34 However, it is considered preferable to have the sensor unit 10 mounted to the moving element because, if the transmitting unit 20 is instead mounted to the moving element, unexpected small angular variations of the moving element of the machine (e.g. due to machine vibrations) will result in large position variations at the far end of the laser beam (this will be particularly noticeable in the case of a robotic arm), but this can be mitigated by using a larger sensor (capable of measuring a wider range of lateral beam positions).
[0143] although Fig. 20 The two two-dimensional sensors 11, 12 (and Fig.21 , Fig. 22 , Fig.23 The equivalent in FIG) is shown with aligned X and Y axes, but it is also possible to have the sensors 11, 12 have axes rotated relative to each other so that their axes are not aligned. In this case, the angle between them also needs to be known (for Fig. 20 The arrangement shown assumes the angle is zero, ie the angle is known but is zero).
[0144] exist Fig.35 A method of calibrating or otherwise characterizing a machine according to an embodiment of the invention is outlined in the flowchart of . In step S1, a laser beam is emitted from a transmitting unit into a working volume of the machine. In step S2, the machine is controlled to move a sensor unit along the laser beam relative to the transmitting unit to a plurality of sensor unit positions along the beam; either the sensor unit or the transmitting unit may be moved by the machine, but preferably the sensor unit is moved. In step S3, for each of the plurality of sensor unit positions, the sensor unit is used to make a measurement, whereby the position of the sensor unit relative to the beam can be derived in at least three degrees of freedom (3+DOF). In step S4, it is determined whether a sufficient number of measurements have been made. If not, the position and / or orientation of the beam is changed in step S5, and the method returns to step S1 to collect further measurements along the beam at its new position and / or orientation. If yes, then in step S6, the measurements are used to calibrate or otherwise characterize the machine. It should be noted that this approach has not previously been considered for characterizing (e.g., calibrating) non-Cartesian coordinate positioning machines (particularly articulated robotic arms) that do not include a series of fixed linear axes (as in a three-axis Cartesian CMM), regardless of whether the sensor unit is of the type previously described herein (see, e.g., Figure 6); it is sufficient that the sensor unit is of any type capable of making measurements from which the position of the sensor unit relative to the beam can be derived in at least three degrees of freedom. For example, the XM-60 device manufactured and sold by Renishaw plc (see above for more information) would be suitable for use as the sensor unit in this method. The XM-60 is typically intended to calibrate each of the three linear axes of a Cartesian CMM individually, but the Applicant has appreciated that such a calibration device may in this context be used to collect measurements in six degrees of freedom (6DOF) along a plurality of lines across the working volume, none of which correspond to actual machine axes.
[0145] Although primarily described in conjunction with characterizing (e.g., calibrating) an articulated robotic arm, it will be appreciated that embodiments of the invention are applicable to characterizing (e.g., calibrating) any type of coordinate positioning machine, including, for example, the various types described in the opening section of this application, whether non-Cartesian or Cartesian, and whether serial kinematic or parallel kinematic. Embodiments of the invention are even applicable to characterizing a single machine axis (e.g., a single axis of a three-axis Cartesian CMM). This extends to Fig.36 An example is shown in which a robot arm 1 is mounted to a linear track 40 (or linear axis), in which case a sensor unit 10 as described herein can be mounted to the robot arm 1 and the entire robot arm 1 moves along the track 40 (with the robot joints locked), wherein the sensor unit 10 moves along the laser 21 emitted from the transmitting unit 20, which is actually equivalent to characterizing the linear axis of the track 40 on which the robot arm 1 is mounted; this should be understood to constitute an embodiment of the present invention, since the machine being calibrated or otherwise characterized in this example includes a linear axis provided by the track 40.
[0146] Fig.37 It is shown how the roll degree of freedom can be determined using the sensor unit 10 by performing two (first and second) passes along the same beam 21 (ie transmitting from the same position at the same angle), as an alternative to using a dedicated roll sensor as described above. Fig.37 The diagram is based on Figure 4A A two-dimensional sensor of the type shown is used, but of course any suitable sensor or combination of sensors as described herein may be used. In a second stroke, the sensor unit 10 is moved by the robot arm 1 along a path that is laterally displaced relative to the beam 21 compared to the path of the first stroke. The sensor readings from both strokes can be used to derive information about the roll degree of freedom of each sensor unit position. Fig.38 shows how to combine the Fig.37The same sensor reading is interpreted as a translation. It is also possible to use a pair of beams 21 so that only a single pass along the beam pair would need to be performed, but this would require the beams to be parallel or at least at a known angle relative to each other, which may be more difficult to achieve in practice.
[0147] Where it is described herein that the position of the sensor unit 10 relative to the beam 21 in at least three degrees of freedom can be derived from measurements, it will be appreciated that this does not mean that such a position is actually derived or determined or calculated from measurements in any or all of these degrees of freedom as part of the method. It is only necessary to be able to derive such a position of the sensor unit relative to the beam from the measurements, as this means that the measurements contain sufficient position information to enable the machine to be calibrated or otherwise characterized. For example, in the case of a calibration routine for updating a set of model parameters of a machine, the set of raw measurements may be processed directly as part of an iterative error minimization algorithm, without the need to derive (for example as an intermediate step) the actual position of the sensor unit relative to the beam in each of the at least three degrees of freedom. Thus, in Fig.12 In the example shown, the actual value of θ may not be determined as part of the method, even though this angle information is implicitly used in the method via lateral position measurements from the spaced apart sensors 11 , 12 .
[0148] The above described embodiment is based on a laser beam 21 which acts as a guide along which the sensor unit 10 moves. It will be appreciated that the present invention is not limited to the specific use of a laser beam. Any optical beam may be used, whether or not it has the characteristics of a laser beam. For example, a normal (non-laser) light beam may be used and sensed in a similar manner. The optical beam actually acts as an optical guide which may be sensed by a suitable form of sensor in the sensor unit. The present invention is not even limited to the use of an optical beam as a guide. Some other type of energy beam, such as an electron beam, may be used instead, using a suitable sensor in the sensor unit depending on the type of energy beam used. In this sense, the exact form of the guide is irrelevant, since all that is required is that the guide is arranged in the working volume, and that the sensor unit can be moved by the machine along the guide to a plurality of sensor unit positions and can be operated to measure the lateral position of the guide at a plurality of measurement positions along the guide for each of the plurality of sensor unit positions (by any means suitable for the type of guide used), wherein the position of the sensor unit relative to the guide can be derived in at least three degrees of freedom from the measurement results. Preferably, a non-contact form of guide is used, but a mechanical guide may be used, such as a metal rod or a straight edge of a rigid metal sheet (such as a ruler), wherein the sensor is of the type used to measure the lateral position relative to the guide (e.g. a linear variable differential transformer or LVDT sensor). The guide need not even be straight, but just of a known form. Thus, although the use of a laser beam is a very convenient way of providing a non-contact guide of known form (i.e. straight), other forms of guides should be understood to be within the scope of the invention.
[0149] A machine controller for controlling the operation of a robot (or other type of coordinate positioning machine) may be a dedicated electronic control system and / or may include a computer operating under the control of a computer program. For example, the machine controller may include: a real-time controller for providing low-level instructions to the coordinate positioning machine; and a PC for operating the real-time controller. It will be appreciated that the operation of the coordinate positioning machine may be controlled by a program operating on the machine, in particular by a program operating on a coordinate positioning machine controller (such as controller 8). Such a program may be stored on a computer readable medium, or may be embodied in a signal, such as a downloadable data signal provided from an Internet website, for example. The appended claims should be interpreted as covering the program itself, or as a record on a carrier, or as a signal, or in any other form.
Claims
1. A system for characterizing a machine, the system comprising: a transmitting unit operable to transmit an optical beam into a working volume of the machine; a sensor unit movable by the machine to a plurality of sensor unit positions along the beam and operable to measure, for each of the plurality of sensor unit positions, a transverse beam position at a plurality of measurement positions along the beam, wherein a position of the sensor unit relative to the beam can be derived in at least three degrees of freedom from the measurement results; as well as A processor unit is operable to characterize the machine using the measurements.
2. The system of claim 1, wherein: The position of the sensor unit relative to the beam can be determined in two transverse translational degrees of freedom and in at least one transverse rotational degree of freedom.
3. The system of claim 2, wherein: The position of the sensor unit relative to the beam in the transverse rotational degree of freedom can be derived from a corresponding pair of measurement positions spaced apart by a fixed spacing.
4. A system as claimed in claim 2 or 3, wherein: The position of the sensor unit relative to the beam can be determined in two lateral rotational degrees of freedom.
5. A system as claimed in any preceding claim, wherein: The sensor unit is further operable to provide further measurements from which the position of the sensor unit relative to the beam in the longitudinal rotational degree of freedom can be derived.
6. A system as claimed in any preceding claim, wherein: The processor unit is operable to characterize the machine based on a comparison between expected measurements from the sensor unit and actual measurements from the sensor unit.
7. A system as claimed in any preceding claim, wherein: The geometry of the machine is characterized by a set of model parameters.
8. A system as claimed in claim 7 when dependent on claim 6, wherein The processor unit is operable to update the model parameters based on the comparison.
9. The system of claim 7 or 8, wherein: Characterizing the machine includes determining a new set of model parameters that better characterizes the geometry of the machine than an existing set of model parameters.
10. A system as claimed in any preceding claim, comprising a control unit operable to control the machine to move the sensor unit along the beam.
11. A system as claimed in claim 10 when dependent on claim 7, wherein The control unit is operable to control the machine to move the sensor unit along the beam based on the set of model parameters.
12. The system of claim 10 or 11, wherein: The control unit is operable to control movement of the machine such that the sensor unit follows a predetermined path along the beam.
13. The system of claim 10, 11 or 12, wherein: The control unit is operable to servo movement of the machine in dependence on measurements from the sensor unit to maintain substantially constant measurements from the sensor unit for each of the sensor unit positions along the beam.
14. A system as claimed in any one of claims 10 to 13 when dependent on claims 3 and 7, wherein The control unit is operable to move the sensor unit relative to the transmitting unit such that the beam is incident at each of the pair of measurement positions in turn, and wherein the processor unit is operable to determine the separation based on the model parameters.
15. The system of any one of claims 10 to 14, wherein: The processor unit is separate from the control unit.
16. A system as claimed in any preceding claim, wherein: The sensor unit comprises a sensor at each of the measurement locations, each sensor being adapted to sense the beam in one or two lateral dimensions or directions.
17. A system as claimed in any preceding claim, wherein: The sensor unit has multiple entry points that cause the beam to be at different respective angles while still passing through the same measurement location.
18. A system as claimed in any preceding claim, wherein: The coupling between the sensor unit and the machine is adapted to cause at least one of the measurement locations to substantially coincide with a point of interest associated with the machine.
19. The system of claim 18, wherein: The point of interest associated with the machine is a tool center point.
20. A system as claimed in any preceding claim, wherein: The coupling between the sensor unit and the machine is adapted to enable the sensor unit to rotate relative to the machine about a predetermined point on the coupling.
21. A system as claimed in claim 20 when dependent on claim 18, wherein The predetermined point substantially coincides with the point of interest.
22. A system as claimed in any preceding claim, wherein: The transmitting unit is operable to transmit the beam into the working volume of the machine from a plurality of positions and / or in a plurality of directions.
23. A system as claimed in any preceding claim, wherein: The sensor unit is moved by the machine and the transmitting unit is fixed, or wherein the transmitting unit is moved by the machine and the sensor unit is fixed.
24. A system as claimed in any preceding claim, wherein: The optical beam is a laser beam or some other type of energy beam, such as a light beam or an electron beam, or some other form of guide, such as a non-contact and / or optical guide, or even a mechanical guide, such as a straight edge of a rigid structure.
25. A system as claimed in any preceding claim, further comprising a linear measurement device for providing measurements related to the longitudinal translational degree of freedom.
26. A system as claimed in any preceding claim, wherein: The sensor unit comprises a reflector for returning at least a portion of the beam to the transmitting unit, and wherein the transmitting unit comprises an interferometric sensor for providing measurements related to the longitudinal translational degree of freedom using a reference beam and a return beam.
27. A system as claimed in any preceding claim, wherein: Characterizing the machine includes one or more of: calibrating the machine; validating the machine; performing a health check on the machine; evaluating positioning errors of the machine; and setting up the machine.
28. A system as claimed in any preceding claim, wherein: The machine comprises a coordinate positioning machine.
29. A system as claimed in any preceding claim, wherein: The machines include non-Cartesian and / or parallel kinematic machines.
30. A system as claimed in any preceding claim, wherein: The machine includes a robotic arm.
31. A sensor unit for use in a system as claimed in any preceding claim, the sensor unit being movable by the machine to a plurality of sensor unit positions along the beam, and the sensor unit being operable to measure, for each of the plurality of sensor unit positions, a lateral beam position at a plurality of measurement positions along the beam, wherein the position of the sensor unit relative to the beam can be derived in at least three degrees of freedom based on the measurement results.
32. An directional sensor unit capable of being mounted in a fixed orientation to a non-Cartesian machine to perform a method for characterizing the machine, and the directional sensor unit capable of being moved between a plurality of different fixed orientations relative to the machine so that the method can be performed using the plurality of differently configured machines for the same sensing operation.
33. A method of characterizing a machine, the method comprising: (a) transmitting an optical beam into a working volume of the machine; (b) controlling the machine to move the sensor unit along the beam to a plurality of sensor unit positions along the beam; (c) for each of the plurality of sensor unit positions, measuring, using the sensor unit, a lateral beam position at a plurality of measurement positions along the beam, wherein the position of the sensor unit relative to the beam is derivable in at least three degrees of freedom from the measurement results; as well as (d) using the measurements to characterize the machine.
34. A method as claimed in claim 33, comprising repeating steps (b) and (c) for the same beam emitted in step (a), but using a path of the sensor unit that deviates from the sensor unit path used in the previous execution of steps (b) and (c), and the position of the sensor unit relative to the beam can be derived in the rotational degree of freedom around the axis defined by the beam based on the combination of measurement results.
35. A method of characterizing a non-Cartesian coordinate positioning machine, the method comprising: (a) transmitting an optical beam into a working volume of the machine; (b) controlling the machine to move the sensor unit along the beam to a plurality of sensor unit positions along the beam; (c) for each of the plurality of sensor unit positions, taking a measurement using the sensor unit, whereby the position of the sensor unit relative to the beam can be derived in at least three degrees of freedom; (d) repeating steps (a) to (c) at a plurality of different transmit positions and / or angles for the beam; and (e) using the measurements to characterize the machine.
36. The method of claim 33, 34 or 35, wherein: The sensor unit is a sensor unit as claimed in claim 31 or 32.
37. A computer program which, when executed by a computer or machine controller, causes the computer or machine controller to perform the method of any one of claims 33 to 36.
38. A computer readable medium having stored therein computer program instructions for controlling a computer or machine controller to perform the method of any one of claims 33 to 36.
39. A machine controller configured to control a machine to perform the method according to any one of claims 33 to 36.
Citation Information
Cited By
Robot motion indication light spot position rapid acquisition device based on four PSDs
CN119795244A
