The present invention relates to a method for setting more precisely a position and/or orientation of a device head.
The automation of measurement and assembly tasks using robots is increasingly affecting the construction industry. So far, robots have mainly been used in automated assembly lines, which are characterized by fixed positions and constant conditions. In contrast to assembly lines, construction sites are spatially complex measuring environments that are constantly changing as construction progresses. For assembly tasks on the construction site, such as creating drill holes, creating slots and assembling installation equipment, accuracies in the millimeter range are required. These accuracies in the millimeter range are not achieved by known on-board sensor devices such as LiDAR sensor devices, which severely limits the possible uses of these on-board sensor devices for measuring and assembly tasks by means of robots on construction sites.
In order to maintain the required accuracies in the millimeter range, available prior-art apparatuses on construction sites use external sensor devices that are not connected to the device head on the robot. External sensor devices are designed for example as total stations; a disadvantage of these external sensor devices is that referencing between the external sensor device and the measuring environment must take place before they can be used; moreover, total stations are only suitable for determining the position and not the orientation. Alternatively, active or passive target objects, the positions and/or orientations of which are determined in advance, can be positioned in the measuring environment of the construction site, the position and/or orientation of the device head being determined using the known positions and/or orientations of the target objects. Disadvantages of the target objects is that the target objects must be positioned in the measuring environment of the construction site before the apparatus is used.
The object of the present invention is to develop an apparatus and a method with which the position and/or orientation of a device head can be determined with the required accuracy in the millimeter range. The apparatus should be arranged on the device head.
The method according to the invention for setting more precisely a position and/or orientation of a device head in a measuring environment by means of a distance measuring device and a control device is characterized by a sequence of a first, second, third, fourth and fifth step, wherein:
The idea of the present invention is to first determine the position and/or orientation of the device head by means of a known on-board sensor device and then to set this position and/or orientation of the device head more precisely by means of a distance measuring device connected to the device head, a geometry model of the measuring environment and known standard procedures for the compensation calculation (e.g., method of least methods). Used for example as an on-board sensor device is a LiDAR sensor device, which is connected to the device head and which can determine the position and/or orientation of the device head with an accuracy in the centimeter range. The distance measuring device comprises at least one distance measuring sensor, multiple distance measuring sensors increasing the accuracy or reducing the number of sequences of the first to fifth steps.
The device head is arranged in at least one measuring position in which the sequence of the first to fifth steps is carried out. In the first step of the sequence, the device head is arranged in a measuring position in the measuring environment, with pose data being determined for the measuring position by the control device. In the second step of the sequence, the distance measuring sensors carry out a distance measurement and transmit their measured distance values to the control device. In the third step, corresponding estimated distance values are determined for the measured distance values from the geometry model of the measuring environment and the pose data. The deviations between the measured distance values and the corresponding estimated distance values are calculated in the fourth step of the sequence and stored as error values. In the fifth step, the number of error values is compared with a minimum number.
The further steps of the method depend on the comparison of the number of error values with the minimum number. If the number of error values is less than the minimum number, the device head is moved from the measuring position into a new measuring position and the sequence of the first to fifth steps is carried out for the new measuring position. If the number of error values is greater than or equal to the minimum number, there are sufficient error values with the help of which an error minimization (compensation calculation) for the position and/or orientation of the device head is carried out by the control device and the position and/or orientation of the device head is set more precisely.
In one variant, the first sequence of the first to fifth steps is carried out in a first measuring position, the first measuring position corresponding to the position and/or orientation of the device head that was determined by means of the on-board sensor device, and the position and/or orientation of the device head that was determined by means of the on-board sensor device being used as first pose data for the first sequence. The first measuring position, in which the first sequence of the first to fifth steps is carried out, corresponds to the position and/or orientation of the device head that is to be set more precisely by means of the method according to the invention. The more precise setting is obtained using the error values of the first sequence, this only being performed when the number of error values has reached the minimum number. The number of distance measuring sensors can be used to increase the number of error values that are determined in a sequence.
In an alternative variant, the sequence of the first to fifth steps is carried out twice in a first measuring position and a second measuring position, the first measuring position corresponding to the position and/or orientation of the device head determined by means of the on-board sensor device, the second measuring position being different from the first measuring position and the movement of the device head from the first measuring position into the second measuring position being recorded by a further on-board sensor device in the form of first movement data. The first measuring position, in which the first sequence of the first to fifth steps is carried out, corresponds to the position and/or orientation of the device head that is to be set more precisely by means of the method according to the invention.
The second pose data for the second measuring position are preferably determined from the first pose data of the first measuring position and the first movement data. The second pose data for the second measuring position are required in the third step of the sequence of the first to fifth steps to determine corresponding estimated distance values for the measured distance values in the geometry model of the measuring environment.
Alternatively, the second pose data for the second measuring position are determined from optimized first pose data for the first measuring position and the first movement data, the optimized first pose data being determined from the position and/or orientation of the device head that was determined by means of the on-board sensor device, by error minimization (compensation calculation) by means of the error values of the first sequence. The aim of the method according to the invention is to set more precisely the position and/or orientation of the device head that was determined by means of the on-board sensor device.
In a further alternative variant, the sequence of the first to fifth steps is carried out at least three times, the movement of the device head from one measuring position into a new measuring position being recorded by a further on-board sensor device in the form of movement data. The first measuring position, in which the first sequence of the first to fifth steps is carried out, corresponds to the position and/or orientation of the device head that is to be set more precisely by means of the method according to the invention. The device head is moved from the first measuring position into a second measuring position, the movement of the device head from the first into the second measuring position being recorded by the further on-board sensor device as first movement data, and the device head is moved from the second measuring position into a third measuring position, the movement from the second into the third measuring position being recorded by the further on-board sensor device as second movement data.
The pose data for the new measuring position are preferably determined from the first pose data of the first measuring position and the movement data. The pose data for the new measuring position are required in the third step of the sequence of the first to fifth steps to determine corresponding estimated distance values for the measured distance values in the geometry model of the measuring environment.
Alternatively, the pose data for the new measuring position are determined from optimized first pose data and the movement data, the optimized first pose data being determined from the position and/or orientation of the device head that was determined by means of the on-board sensor device, by error minimization (compensation calculation) by means of the error values of the sequences carried out in the first to fifth steps. The further on-board sensor device, which is connected to the device head, records the movement of the device head between all measuring positions.
In a further development of the method, in the case that the number of error values is greater than or equal to the minimum number, within the error minimization (compensation calculation) an error measure is determined. This error measure evaluates the quality or accuracy with which the position and/or orientation of the device head is set more precisely.
The error measure is preferably compared with a maximum error, wherein, for the case where the error measure is greater than the maximum error, the device head is moved into a new measuring position and the sequence of the first to fifth steps is carried out for the new measuring position. The sequence of the first to fifth steps is carried out until the position and/or orientation of the device head has been set more precisely with the required quality or accuracy.
The present invention also relates to an apparatus for setting more precisely a position and/or orientation of a device head by means of the method of the present invention. The position and/or orientation of the device head is first determined by means of a known on-board sensor device and this position and/or orientation of the device head is then set more precisely by means of the apparatus according to the invention.
The apparatus preferably has a distance measuring device, which comprises a number of M, M≥1 distance measuring sensors and which is connected to the device head, and a control device, which is connected in a communicating manner to the distance measuring device and an on-board sensor device connected to the device head. The distance measuring device comprises one or more distance measuring sensors, the measuring directions of which differ from one another. A larger number of distance measuring sensors increases the accuracy, or the number of sequences of the first to fifth steps can be reduced.
The apparatus particularly preferably has a further on-board sensor device, which is attached to the device head and which is connected in a communicating manner to the control device. The further on-board sensor device records the movement of the device head from one measuring position into a new measuring position in the form of movement data, which are transmitted to the control device.
Exemplary embodiments of the invention are described hereinafter with reference to the drawings. It is not necessarily intended for this to illustrate the exemplary embodiments to scale; instead, where useful for explanation, the drawings are produced in a schematic and/or slightly distorted form. With regard to additions to the teachings that can be seen directly from the drawings, reference is made to the relevant prior art. It should be taken into account here that various modifications and variations relating to the form and the detail of an embodiment may be undertaken without departing from the general concept of the invention. The features of the invention disclosed in the description, the drawings and the claims can be essential for the development of the invention both individually and in any combination. In addition, all combinations of at least two of the features disclosed in the description, the drawings and/or the claims fall within the scope of the invention. The general concept of the invention is not limited to the exact form or the detail of the preferred embodiment shown and described hereinafter or limited to subject matter that would be limited compared to the subject matter claimed in the claims. For given dimensioning ranges, values within the stated limits should also be disclosed as limit values and can be used and claimed as desired. For the sake of simplicity, identical reference signs are used hereinafter for identical or similar parts or parts having identical or similar functions.
In the exemplary embodiment, the device head 10 is connected to a robot arm 12 which is mounted on a work platform 13. The robot arm 12 is designed as a multi-axis robot arm with multiple axes of rotation and the work platform 13 can be adjusted in one plane via motor-driven wheels that are mounted on two axes. The robot arm 12 consists of multiple rigid members that are connected by swivel joints or sliding joints, the swivel or sliding joints being able to be adjusted by controlled drives. The number of swivel or sliding joints required depends on the type of device head 10 and the planned application.
By combining the robot arm 12 with the work platform 13, the spatial area of the device head 10 can be increased in size. The work platform 13 makes it possible to position the device head 10 mounted on the robot arm 12 at least approximately in the measuring environment 11, the approximate positioning taking place in two dimensions in the plane. Instead of the motor-adjustable work platform 13, the robot arm 12 may be mounted on a manually adjustable work platform. A motor-adjustable work platform 13 allows the device head 10 to be positioned without an operator, whereas a manually adjustable work platform 13 has to be adjusted by the operator. Instead of the adjustable work platform 13, the robot arm 12 may be connected to a standing foot that allows the robot arm 12 to stand securely; the standing foot can be adjusted by the operator in order to increase the size of the spatial area. In principle, the device head 10 can also be used without a robot arm and/or work platform. The number of degrees of freedom of the device head 10 can vary greatly and is dependent on the type of device head 10 and the planned application. The device head 10 may be adjustable in one or more directions of translation, in one or more directions of rotation or in a combination of directions of translation and directions of rotation.
The position and/or orientation of the device head 10 is determined by means of an on-board sensor device 14 and then set more precisely by means of an apparatus 15 for setting more precisely the position and/or orientation of the device head 10. The apparatus 15 comprises a distance measuring device 16 and a control device 17, which is connected in a communicating manner to the on-board sensor device 14 and to the distance measuring device 16. The on-board sensor device 14 is used to determine the position and/or orientation of the device head 10; a LiDAR sensor device may be used for example as the on-board sensor device 14. The distance measuring device 16 comprises a number of M, M≥1 distance measuring sensors 18, the measuring directions of which differ from one another. In the exemplary embodiment, the distance measuring device 16 has three distance measuring sensors 18, which are arranged at right angles to one another. The distance measuring device 16 is connected to the device head 10 and serves to set more precisely the position and/or orientation of the device head 10 that was determined by means of the on-board sensor device 14.
In order to set the position and/or orientation of the device head 10 more precisely, the device head 10 is arranged in different measuring positions, in which the distance measuring sensors 18 of the distance measuring device 16 carry out a distance measurement. The movement of the device head 10 from one measuring position into a new measuring position is recorded by a further on-board sensor device 19, which is connected to the device head 10, in the form of movement data; the further on-board sensor device 19 is formed for example as an acceleration sensor.
The measuring environment 11 is mapped in a geometry model 21 which is shown in
The method according to the invention for setting more precisely the position and/or orientation of the device head 10 is characterized by a sequence of a first, second, third, fourth and fifth step, the sequence being carried out at least once, preferably multiple times (N times, N≥2). The device head 10 is arranged in different measuring positions and the sequence of the first to fifth steps is carried out in each measuring position. In the exemplary embodiment, the sequence of the first to fifth steps is carried out three times (N=3). The device head 10 is arranged in the measuring environment 11 in three measuring positions, which are referred to as the first measuring position MP1 (
In the first step of the first sequence, the device head 10 is arranged in the measuring environment 11 in the first measuring position MP1 (
The further steps of the method depend on the comparison of the number A of error values with the minimum number Amin. If the number A of error values is less than the minimum number Amin, the device head 10 is moved from the first measuring position MP1 into the second measuring position MP2 (
In the first step of the second sequence, the device head 10 is moved from the first measuring position MP1 into the second measuring position MP2 (
In the second step of the second sequence, the distance measuring sensors 18 carry out a distance measurement and transmit their measured distance values dm_j2 for j=1 . . . M to the control device 17; in the exemplary embodiment, the three distance measuring sensors 18 determine three measured distance values dm_12, dm_22, dm_32. For the second measuring position MP2, in the third step of the second sequence, corresponding estimated distance values de_j2 for j=1 . . . M are determined for the measured distance values dm_j2 from the geometry model 21; in the exemplary embodiment, three estimated distance values de_12, de_22, de_32 are determined. In the fourth step of the second sequence, the deviations Δj2 for j=1 M between the measured distance values dm_j2, j=1 M and the corresponding estimated distance values de_j2, =1 M are calculated and stored as error values; in the exemplary embodiment, the second sequence produces three error values Δ12, Δ22, Δ32. In the fifth step of the second sequence, the number A of error values is determined and compared with the minimum number Amin. In the exemplary embodiment, the number six of error values is smaller than the minimum number Amin, so that a third sequence of the first to fifth steps is carried out.
In the first step of the third sequence, the device head 10 is moved from the second measuring position MP2 into the third measuring position MP3 (
In the second step of the third sequence, the distance measuring sensors 18 carry out a distance measurement and transmit their measured distance values dm_j3 for j=1 . . . M to the control device 17; in the exemplary embodiment, the three distance measuring sensors 18 determine three measured distance values dm_13, dm_23, dm_33. For the third measuring position MP3, in the third step of the third sequence the geometry model 21 is used to determine for the measured distance values dm_j3 corresponding estimated distance values de_j3 for j=1 M; in the exemplary embodiment, three estimated distance values de_13, de_23, de_33 are determined. In the fourth step of the third sequence, the deviations Δj3 for j=1 . . . M between the measured distance values dm_j3 and the corresponding estimated distance values de_j3 are calculated and stored as error values; in the exemplary embodiment, the third sequence produces three error values Δ13, Δ23, Δ33. In the fifth step of the third sequence, the number A of error values is determined and compared with the minimum number Amin. In the exemplary embodiment, the number A of error values after completion of the third sequence is nine, which is greater than the minimum number Amin. Using the nine error values, a compensation calculation for the position and/or orientation of the device head 10 is carried out (error minimization) and the position and/or orientation of the device head 10 is set more precisely by the control device 17. The compensation calculation is performed for example by means of the method of least squares. The more precisely set position and/or orientation of the device head 10 results from the compensation calculation.
In a further development of the method, in the case that the number A of error values is greater than or equal to the minimum number Amin, within the compensation calculation the control device 17 determines an error measure δ, which indicates the quality or accuracy with which the position and/or orientation of the device head 10 is set more precisely. The error measure δ is compared with a maximum error δmax, which indicates the allowed inaccuracy. If the error measure δ is greater than the maximum error δmax, the device head 10 is moved from the third measuring position MP3 into a new measuring position, in which the sequence of the first to fifth steps is carried out again; the new measuring position is referred to as the fourth measuring position MP4. The movement of the device head 10 from the third measuring position MP3 into the fourth measuring position MP4 is recorded in the form of third movement data by the further on-board sensor device 19.
In a further development of the method according to the invention, the quality of the error values Δj1 that are determined in the sequences can be evaluated by the control device 17 by means of suitable calculation methods, and error values of poor quality can be disregarded in the compensation calculation (error minimization). Strong deviations between the measured distance values and the corresponding estimated distance values may occur if the distance measuring sensors 18 are directed at edges in the measuring environment 11, since even small angular deviations can lead to large changes in the measured distance values.
Number | Date | Country | Kind |
---|---|---|---|
19199077.9 | Sep 2019 | EP | regional |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/EP2020/076583 | 9/23/2020 | WO |