Method for determining actual states of a number of adjusting elements

The present invention is directed to a method for determining actual states of a number of adjusting elements. A position of an additional member relative to a basic member can be set by means of a number of adjusting elements. In order to determine the actual states of the adjusting elements, the additional member is firstly fixed mechanically relative to the basic member in such a way that it has only one degree of freedom. It is then possible to describe the position of the additional member relative to the basic member by means of a single scalar variable. The position of the additional member is then changed. Changes in state effected by the change in position of the additional member are detected, and the actual states of the adjusting elements are determined therefrom.

FIELD OF THE INVENTION

The present invention relates to a determining method for actual states of a number of adjusting elements by means of which it is possible to set a position of an additional member relative to a basic member.

BACKGROUND OF THE INVENTION

With machine tools, manipulating devices and robots, it happens that the driven components (i.e., adjusting elements) are not arranged at right angles to one another. To be operated, such machines require a so-called kinematic coordinate transformation which converts spatial coordinates (as a rule, Cartesian coordinates, in individual cases, also cylindrical or spherical coordinates) into desired values for the machine axes. In these machines, the accuracy of positioning is a function of a multiplicity of factors.

Thus, in particular the parameters of the kinematic transformation must be accurately known. Furthermore, the mathematical model for describing the kinematic transformation should be as complete as possible. Finally, the actual states of the adjusting elements must be exactly known.

The geometric parameters of the kinematic transformation comprise, inter alia, spatial coordinates of midpoints of links, and the mutual spacing of links. Such measurements are carried out as a rule on coordinate measuring machines. The parameters of the kinematic transformation, that is to say the positions of points of the basic member relative to one another, and the positions of points of the additional member relative to one another, can therefore be detected with sufficient accuracy as a rule. However, once these parameters have been detected, it is also still necessary to determine the actual states of the adjusting elements with high accuracy. This frequently constitutes a large problem in starting up a machine. The point is that in the overwhelming number of applications, it is necessary for the actual state to be exactly known in order to be able to adjust the additional member correctly. In the assembled state of the machine, however, the link midpoints are no longer accessible as a rule to direct measurement.

It is conceivable to set the actual states in repeated trials so that the positional accuracy of the additional member in the working space is as high as possible. However, this method is complicated and, moreover, not very accurate.

DE 198 28 181 A1 discloses a method for calibrating the kinematics. In this method, comparisons are made in the entire working space between a measured position and detected actual positions, and the parameters and the actual states of the adjusting elements are determined in such a way that the mean square error is minimized. This method also has only a limited accuracy and is, moreover, very complex mathematically.

SUMMARY OF THE INVENTION

The object of the present invention is to specify a determining method for actual states of a number of adjusting elements which operates simply, reliably, quickly and with high accuracy.

The object is achieved by virtue of the fact that the additional member is fixed mechanically relative to the basic member in such a way that it has only one degree of freedom such that the position of the additional member relative to the basic member can be described by means of a single scalar variable, that the position of the additional member is changed after fixing the latter, and changes effected thereby in the state of the adjusting elements are detected by means of state sensors assigned to the adjusting elements , and that the actual states of the adjusting elements are determined with the aid of the changes in state of the adjusting elements.

The determination of the actual states is preferably performed in the following way that, a first transformation function is determined that specifies for a first of the adjusting elements which change in state occurs for a prescribed value of the variable and a prescribed change in the variable. The first transformation function and the change in state detected for the first adjusting element are used to determine a correlation function that specifies which change in the variable occurs for a prescribed value of the variable and the detected change in state of the first adjusting element. The correlation function is used to determine at least one further transformation function that specifies for a further one of the adjusting elements which change in state occurs for a prescribed value of the variable and of the detected change in state of the first adjusting element. A final value of the variable is determined for which the change in state determined with the aid of the at least one further transformation function corresponds to the detected change in state of the at least one further adjusting element. The final value is used to determine the position of the additional member relative to the basic member, and the actual states of the adjusting elements are determined therefrom.

When the number of adjusting elements is at least three (which is mostly the case), the determination of the final value is preferably performed as follows: Firstly, at least one satisfying value of the variable is determined for which the change in state determined with the aid of a first of the further transformation functions corresponds to the detected change in state of corresponding adjusting element. It is then determined by comparing the changes, determined for the satisfying value, in the state of the other ones of the further transformation functions with the detected changes in state of the corresponding adjusting elements whether the satisfying value is the final value.

The satisfying values can be determined in a particularly simple fashion in this case when an auxiliary function is formed from the difference between the change in state determined with the aid of the first of the further transformation functions and the detected change in state of the corresponding adjusting element, and at least one zero of the auxiliary function is determined.

The zero can be determined in any desired way. Such methods are familiar to any person skilled in the art. It need only be pointed out that the auxiliary function is an ordinary function dependent on a single scalar variable. The zero can therefore be determined, for example, using the generally known Newton method, or in accordance with the so-called regula falsi.

When the auxiliary function is divided by the difference between the variable and determined zero, and the auxiliary function divided by the difference between the variable and determined zero takes the place of the original auxiliary function, all the zeros of the auxiliary function can be determined with certainty.

When the determination of the zeros of the auxiliary function is terminated, and a satisfying value is determined for which the changes in state determined with the aid of the other ones of the further transformation functions corresponds to the determined changes in state of the corresponding adjusting elements, the outlay on determining the final value, and thus the actual states of the adjusting elements is minimum. Again, the determining method then operates particularly quickly.

As a rule, the adjusting elements are assigned controlled-displacement drives by means of which the adjusting elements can be adjusted. In this case, with the exception of a single drive, the drives are preferably switched into a tracking mode, and the change in the position of the additional member is performed by adjusting that one of the adjusting elements whose assigned drive is not switched into the tracking mode.

The actual states of the adjusting elements can—at least partially—be lengths or angles of the adjusting elements, positions of the adjusting elements relative to the basic member, and positions of the adjusting elements relative to the additional member.

The position of the additional member relative to the basic member can comprise a position and/or an orientation of the additional member relative to the basic member. The degree of freedom can be a rotary or a translatory degree of freedom.

When the number of adjusting elements is three, the determining method according to the invention can be applied, for example, with a so-called tripod. However, it can also be applied in principle with a hexapod, for example, in which the number of adjusting elements is six.

The position of the additional member need not be patently changed. It suffices when the change in the position of the additional member is performed differentially.

DETAILED DESCRIPTION OF THE INVENTION

In accordance with the embodiment of an aspect of the present invention illustrated inFIG. 1, a production machine has a basic member1and an additional member2. The additional member2is connected to the basic member1via a number of adjusting elements3. In accordance withFIG. 1, the number of adjusting elements3is three. This also constitutes the minimum number of adjusting elements3, as a rule. In order to distinguish the adjusting elements3from one another, the adjusting elements3are denoted, where necessary, below as adjusting element3a, adjusting element3band adjusting element3c.

In accordance withFIG. 1, the adjusting elements3are connected to the basic member1and the additional member2in an articulated fashion. The adjusting element3acan be longitudinally displaced in this case. As with regards to the adjusting element3a, the length “l” thereof, therefore, constitutes an actual state Z of this adjusting element3a. Alternatively, its angle could be adjustable, for example.

The lengths of the adjusting elements3band3care fixed. In the case of the adjusting element3b, by contrast, its position p can be varied relative to the basic member1. The position of the adjusting element3ccan be adjusted relative to the additional member2. Thus, with reference to the adjusting elements3band3cthe positions p, p′ constitute actual states Z of the respective adjusting elements3b,3c.

The illustration in accordance withFIG. 1is purely exemplary in this case. Of course, any other desired combinations of the actual states Z could take place. For example, it could be possible to adjust the length of all three adjusting elements3, or to position them relative to the basic member1.

The actual states Z of the adjusting elements3fix a position and an orientation of the additional member2relative to the basic member 1—denoted below to the extent required as actual states Za, Zb and Zc for the sake of distinction. A position of the additional member2relative to the basic member1can be set by means of the adjusting elements3. The relationship between the actual states Z and the position is preferably unique in this case. Thus, the position of the additional member2can be used to determine the actual states Z, and the position of the additional member2can be determined from the actual states Z.

As is indicated inFIG. 1symbolically by a drill chuck and a drill, the additional member2is, for example, a tool carrier2of a machine tool. More generally, it can also be regarded as a moving machine element2of a production machine. It must be positioned with high accuracy—in terms of both translation and of rotation, as a rule. This is performed via controlled-displacement drives4that are assigned to the adjusting elements3. The drives4can be used to adjust the adjusting elements3, and thus to change the position of the additional member2. The positioning of the adjusting members3by means of the drives4is performed as a rule in this case with an accuracy of approximately 1 μm, that is to say with high accuracy.

The drives4are driven by a control and evaluation device5, for example a numerical controller5. It is programmed with the aid of a computer program6. The computer program6is fed in this case to the control and evaluation device5via a data medium7, for example a CD-ROM7, on which the computer program6is stored in (exclusively) machine-readable form. The control and evaluation device5operates in the way described in more detail below in conjunction withFIG. 2on the basis of the programming with the aid of the computer program6.

In accordance withFIG. 2, the control and evaluation device5firstly checks in step S1whether it has been given a command for calibrating the machine. If this is the case, the control and evaluation device5branches to step S2in which it demands that the additional member2be fixed mechanically relative to the basic member1. This fixing is undertaken by an operator8, as a rule. The mechanical fixing is performed in this case in such a way that the additional member2has only one degree of freedom. The position of the additional member2relative to the basic member1can therefore be described after the fixing by means of a single scalar variable α.

In accordance withFIG. 1, it is possible, for example, to use a bolt9to fix a predetermined point of the additional member2in such a way that the additional member2can rotate only about a bolt axis9′. In this case, the degree of freedom is a rotatory degree of freedom, specifically a rotation about the bolt axis9′.

As an example, let an arbitrary point of the bolt axis9′ be the origin both of a Cartesian coordinate system of the basic member1, and of a Cartesian coordinate system of the additional member2. Furthermore, let v be a vector of unit length that runs parallel to the bolt axis9′. It is then possible for an arbitrary point P of the basic member coordinate system to be converted into a point P′ of the additional member coordinate system by means of a simple matrix operation. The computing operation is then P′=M·P.

The matrix M is a function in this case only of the angle of rotation α. α is therefore a variable that can be used to describe the position of the additional member2relative to the basic member1.

The matrix M is:

If the angle of rotation α (the variable α) is known, it is thereby possible to convert coordinates of fastening points of the adjusting elements3from the additional member coordinate system to coordinates of the basic member coordinate system, and vice versa. Consequently, the coordinates of corresponding fastening points, for example the fastening points of the adjusting element3a, can be expressed in the same coordinate system. It is thereby also possible, for example, to determine the length I of the adjusting element3aon the basis of knowing both end points in the same coordinate system.

However, as indicated by dashes inFIG. 1, it would also be conceivable to fasten the additional member2on a guide rail10. In this case, the degree of freedom would be a translatory degree of freedom, specifically a displacement along the guide rail10. In the case of a translatory degree of freedom, as well, it is possible to undertake a coordinate conversion in the same way as with a rotatory degree of freedom.

Step S3is executed after step S2. In step S3, the control and evaluation device5waits until the fixing of the additional member2is concluded. For example, it can wait in step3until it receives a confirmation input from the operator8.

After step S3, the control and evaluation device5executes step S4. In step S4, two of the drives4, for example drives4band4c, are switched into a tracking mode. Only a single drive4, here the drive4a, is not switched into the tracking mode.

The control and evaluation device5then exerts differential control on drive4ain step S5. The actual state Za is thereby changed differentially. The position of the additional member2is also changed differentially by this differential change to the actual state Za. For example, the member2is rotated slightly about the bolt9or displaced along the guide rail10. The actual states Zb, Zc of the other adjusting elements3b,3care also changed differentially by this change in the position of the additional member2.

The changes in state ΔZ are detected by the control and evaluation device5in step S6. The detection is performed in this case, for example, by position sensors11that are assigned to the drives4and thus, indirectly, also to the adjusting elements3.

In step S7, the control and evaluation device5then uses the detected changes ΔZ in state of the adjusting elements3to determine the actual states Z of the adjusting elements3. More detail will be given on this step S7later in conjunction withFIG. 3. The determined actual states Z are finally stored in a memory12, in step S8, and the tracking mode of drives4band4cis terminated. The sequence of the steps S2to S7, therefore, corresponds to a determining method in which the actual states Z of the adjusting elements3are determined.

If, in step S1, the control and evaluation device5is not given any command for calibrating the machine, it branches to a step S9. In the step S9, it retrieves the actual states Z—then assumed to be known—from the memory12. It then transfers into the normal mode in step S10.

The determination of the actual states Z with the aid of the detected changes ΔZ in state (i.e., step S7) will now be explained in more detail below in conjunction withFIG. 3.

In accordance withFIG. 3, a first transformation function fa is initially determined in a step S11. The first transformation function fa specifies for one of the adjusting elements3, for example the adjusting element3a, which change ΔZa in state occurs when a prescribed change Δα in the variable a occurs for a prescribed value of the variable α.

Such transformation functions fa are customary and generally known. They are required, inter alia, in order to be able to prescribe changes ΔZ in state or new actual states Z correctly, given known actual states Z such that a desired position of the additional member2relative to the basic member1is assumed.

It is, therefore, possible to determine a correlation function g in a step S12with the aid of the first transformation function fa (α, Δα) and the detected change ΔZa in state of the first adjusting element3a. The correlation function g specifies which change Δα in the variable a occurs for a prescribed value of the variable α and of the detected change ΔZa in state of the first adjusting element3a.

It is also possible to determine the correlation function g straightaway. The point is that the transformation functions f are known—see above—and so the change Δα can be determined directly as a function of the variable α by substitution and iterative approximation for a given change ΔZa in state.

Consequently, a second transformation function fb can be determined in step S13by using the correlation function g (α,ΔZa). The second transformation function fb specifies for a second one of the adjusting elements3, for example the adjusting element3b, which change ΔZb in state occurs for a prescribed value of the variable α and of the detected change ΔZa in state of the first adjusting element3a. It is possible in the same way in step S14to determine a third transformation function fc for the one of the adjusting elements3that still remains, here the adjusting element3c.

In a subsequent step S15, the control and evaluation device5uses the difference between the second transformation function fb and the detected change ΔZb in state of the second adjusting element3bto form an auxiliary function H.

As for any other function dependent on only a single scalar variable, it is, therefore, possible, in step S16, to determine a zero Δ0 for this auxiliary function H that depends only on the variable α. The zero α0 can be determined, for example, in accordance with the generally known Newton method, or in accordance with the likewise generally known regula falsi, or else in accordance with the interval division method, for example.

The zero α0 thus determined is a satisfying value α0 of the variable α for which the change in state determined with the aid of the second transformation function fb corresponds to the detected change ΔZb in state of the second adjusting element3b. This satisfying value α0 is therefore inserted in step S17into the third transformation function fc. A check is then made in step S18as to whether the change in state determined with the aid of the third transformation function fc also corresponds for this satisfying value α0 to the detected change ΔZc in state of the third adjusting element3c.

If there is no correspondence, in a step19the auxiliary function H is divided by the difference between the variable α and the detected zero α0, thus determining a new auxiliary function H that takes the place of the original auxiliary function H. Thereafter, there is a jump back to the step S16.

When, by contrast, the check in the step S18yields a correspondence, the satisfying value α0 is determined as the final value α0. In this case, the position of the additional member2relative to the basic member1is determined in step S20with the aid of the final value α0. The actual states Z of the adjusting elements3can then be determined in step S21with the aid of the position, now known, of the additional member2relative to the basic member1. It is therefore no longer necessary to determine further satisfying values α0. However, it is possible to terminate the determination of the zero α0 of the auxiliary function H.

It was described above in conjunction withFIGS. 1 to 3how the actual states Z of the adjusting elements3can be determined when three adjusting elements3are present. Thus, a description was given of a determining method for the actual states Z of the adjusting elements3of a so called tripod. As a supplement, a method was described in which the additional member2has one rotatory and two translatory degrees of freedom relative to the basic member1. Of course, however, other configurations are also possible and conceivable. For example—again given three adjusting elements3—it is also possible for there to be one translatory and two rotatory degrees of freedom. It can also be that only one translatory movement or only one rotatory movement is possible.

In the general case, by comparison with the basic member1, the additional member2even has both three translatory and three rotatory degrees of freedom. In this case, six adjusting elements3are required to set the position of the additional member2relative to the basic member1. This is illustrated schematically inFIG. 4. However, in this application, as well, the mode of procedure described in conjunction withFIG. 3remains valid without change. Only those ones of the steps S11to S21that relate to the further adjusting element3cneed be applied to a number of adjusting elements3cto3f. These adjusting elements3cto3fcan, however, be handled separately from one another such that the relevant steps S14, S17, S18and S21are now executed repeatedly, specifically once in each case of the adjusting elements3cto3f.

In order to carry out the determining method according to the invention, it is further necessary in the case of the exemplary embodiment in accordance withFIG. 4for five of the drives to be switched over to the tracking mode and for the additional member2to be fixed in five degrees of freedom.

There are, inter alia, the following possibilities for fixing in five degrees of freedom: A rotary joint is mounted on the basic member1, and the additional member2is fastened thereon. In this case, the additional member2has only one degree of freedom, specifically a rotation about this axis. A linear guide10is mounted in any desired aligmnent on the basic member1. Thereafter, the additional member2is fastened on the linear guide in such a way that its orientation remains constant The additional member2, therefore, has only one translatory degree of freedom, specificaiiy a movement in the direction of the guide.

The method according to the invention can even be applied with only two adjusting elements3. The steps S14, S17, S18and S19can be eliminated in this case. As indicated inFIG. 3by dashes, these steps can therefore be skipped in this case.

The advantages of the determining method according to the invention are many and varied. In particular, the highly accurate position sensors11which are present in any case inside the drives can be used to detect the changes ΔZ in state. Again, there is no need to execute complicated travel movements. Rather, it is sufficient, for example, to start a partial program in the case of a machine tool. Furthermore, the determining method according to the invention can be executed entirely automatically. Finally, the determining method according to the invention resorts in particular for the purpose of determining the transformation functions f and the correlation function g to the transformation formulas that are likewise stored in any case in the control and evaluation device5. In particular, the expenditure of time in determining the actual states Z is very low for this reason. It is mostly in the region of a few milliseconds.