# US 2022/0365216 A1 · Method for Setting More Precisely a Position and/or Orientation of a Device Head

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 2022/0365216 A1
- Document ID: US20220365216A1
- Status: Published application
- Kind: A1
- Application number: 17/763,081
- Filed: 2020-09-23
- Published: 2022-11-17
- Earliest claimed: 2019-09-24
- Assignees: Hilti Aktiengesellschaft
- Applicants: Hilti Aktiengesellschaft
- Inventors: Sascha KORL; Abel GAWEL; Hermann BLUM; Timothy SANDY; Marco HUTTER; Roland SIEGWART
- Web page: https://patentgrep.com/patent/US20220365216A1

## CPC

- B25J 9/162: {Mobile manipulator, movable base with manipulator arm mounted on it}
- G01S 17/88: Lidar systems specially adapted for specific applications
- B25J 9/1692: {Calibration of manipulator}
- B25J 9/1694: {characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion}
- G05B 2219/37504: Differential use of sensors, to double precision
- G05B 2219/39017: Forward calibration, find actual pose world space for given joint configuration
- G05B 2219/40548: Compare measured distances to obstacle with model of environment
- B25J: MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES ({manipulators specially adapted for use in surgery A61B34/70; manipulators used in cleaning hollow articles B08B9/04}; manipulators associated with rolling mills B21B39/20; manipulators associated with forging machines B21J13/10; {manipulators associated with picking-up and placing mechanisms B23P19/007}; means for holding wheels or parts thereof B60B30/00; {vehicles with ground-engaging propulsion means, e.g. walking members B62D57/02, B62D57/032; devices for picking-up and depositing articles or materials between conveyors B65G47/90, B65G47/91; manipulators with gripping or holding means for transferring packages B65H67/065}; cranes B66C; {manipulators used in the protection or supervision of pipe-line installations F17D5/00; walking equipment adapted for nuclear steam-generators F22B37/006}; manipulators specially adapted for, or associated with, nuclear reactors G21C; {apparatus used for handling wafers during manufacture or treatment of semiconductor H10P72/50})
- G01S: RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G05B: CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS (systems for controlling or regulating non-electric variables G05D; systems for regulating electric or magnetic variables G05F; control devices or systems insofar as characterised by mechanical features only G05G)

## Abstract

A method for setting more precisely a position and/or an orientation of a device head in a measuring environment by a distance measuring device which has a number of M, M≥1, distance measuring sensors and which is connected to the device head. A control device is communicatively connected to the distance measuring device and an on-board sensor device. The position and/or the orientation of the device head is determined by the on-board sensor device and the position and/or the orientation of the device head determined by the on-board sensor device is set more precisely by the control device.

## Claims

### Claim at position 1

-13. (canceled)

### Claim 14

A method for setting more precisely a position and/or an orientation of a device head (10) in a measuring environment (11) by a distance measuring device (16) which comprises a number of M, M≥1, distance measuring sensors (18) and which is connected to the device head (10), and a control device (17) which is communicatively connected to the distance measuring device (16) and an on-board sensor device (14), comprising the steps of:
determining the position and/or the orientation of the device head (10) by the on-board sensor device (14) and transmitting the position and/or the orientation of the device head (10) determined by the on-board sensor device (14) to the control device (17);
a sequence of a first step, a second step, a third step, a fourth step, and a fifth step, wherein:
in the first step of the sequence, the device head (10) is arranged in a measuring position (MP1, MP2, MP3) in the measuring environment (11) with pose data being determined for the measuring position (MP1, MP2, MP3);
in the second step of the sequence, the distance measuring sensors (18) carry out a distance measurement and transmit respective measured distance values (dm_j1, dm_j2, dm_j3) to the control device (17);
in the third step of the sequence, a geometry model (21) of the measuring environment (11) stored in the control device (17) and the pose data for the measuring position (MP1, MP2, MP3) are used to determine for the measured distance values (dm_j1, dm_j2, dm_j3) corresponding estimated distance values (de_j1, de_j2, de_j3);
in the fourth step of the sequence, deviations (Δj1, Δj2, Δj3) between the measured distance values (dm_j1, dm_j2, dm_j3) and the corresponding estimated distance values (de_j1, de_j2, de_j3) are calculated and stored as error values (Δj1, Δj2, Δj3); and
in the fifth step of the sequence, a number (A) of error values is compared with a minimum number (Amin);
wherein, for a first case where the number (A) of error values is less than the minimum number (Amin), the device head (10) is moved from the measuring position (MP1, MP2) into a new measuring position (MP2, MP3) and the sequence of the first step to fifth step is carried out for the new measuring position (MP2, MP3); and
wherein, for a second case where the number (A) of error values is greater than or equal to the minimum number (Amin), the error values (Δj1, Δj2, Δj3) are used to carry out an error minimization for the position and/or the orientation of the device head (10) and the position and/or orientation of the device head (10) determined by the on-board sensor device (14) is set more precisely by the control device (17).

### Claim 15 (depends on 14)

The method as claimed in claim 14, wherein the first sequence of the first to fifth steps is carried out in a first measuring position (MP1), wherein the first measuring position (MP1) corresponds to the position and/or the orientation of the device head (10) that is determined by the on-board sensor device (14), and wherein the position and/or the orientation of the device head (10) that is determined by the on-board sensor device (14) is used as the first pose data for the first sequence.

### Claim 16 (depends on 14)

The method as claimed in claim 14, wherein the sequence of the first to fifth steps is carried out twice in a first measuring position (MP1) and a second measuring position (MP2), wherein the first measuring position (MP1) corresponds to the position and/or the orientation of the device head (10) that is determined by the on-board sensor device (14), wherein the second measuring position (MP2) is different from the first measuring position (MP1), and wherein a movement of the device head (10) from the first measuring position (MP1) into the second measuring position (MP2) is recorded by a further on-board sensor device (19) in a form of first movement data.

### Claim 17 (depends on 16)

The method as claimed in claim 16, wherein the second pose data for the second measuring position (MP2) are determined from the first pose data of the first measuring position (MP1) and the first movement data.

### Claim 18 (depends on 16)

The method as claimed in claim 16, wherein the second pose data for the second measuring position (MP2) are determined from optimized first pose data and the first movement data and wherein the optimized first pose data is determined from the position and/or the orientation of the device head (10) that is determined by the on-board sensor device (14) by error minimization by the error values (Δd′).

### Claim 19 (depends on 14)

The method as claimed in claim 14, wherein the sequence of the first to fifth steps is carried out at least three times with movement of the device head (10) from one measuring position (MPLMP2) into a new measuring position (MP2, MP3) being recorded by a further on-board sensor device (19) in a form of movement data.

### Claim 20 (depends on 19)

The method as claimed in claim 19, wherein pose data for the new measuring position (MP2, MP3) are determined from first pose data of the first measuring position (MP1) and the movement data.

### Claim 21 (depends on 19)

The method as claimed in claim 19, wherein the pose data for the new measuring position (MP2, MP3) are determined from optimized first pose data and the movement data, wherein the optimized first pose data is determined from the position and/or the orientation of the device head (10) that is determined by the on-board sensor device (14) by error minimization by the error values (Δj1, Δj2) of the sequences of the first to fifth steps carried out.

### Claim 22 (depends on 14)

The method as claimed in claim 14, wherein, in the second case where the number (A) of error values is greater than or equal to the minimum number (Δmin), within the error minimization an error measure (δ) is determined.

### Claim 23 (depends on 22)

The method as claimed in claim 22, wherein the error measure (δ) is compared with a maximum error (δmax), wherein, for a third case where the error measure (δ) is greater than the maximum error (δmax), the device head (10) is moved into a new measuring position (MP4) and the sequence of the first to fifth steps is carried out for the new measuring position (MP4).

### Claim 24 (depends on 14)

An apparatus (15) for setting more precisely a position and/or an orientation of a device head (10) which performs the method as claimed in claim 14.

### Claim 25 (depends on 24)

The apparatus as claimed in claim 24, wherein the apparatus (15) has a distance measuring device (16) which comprises a number of M, M≥1, of distance measuring sensors (18) and which is connected to the device head (10), and a control device (17) which is communicatively connected to the distance measuring device (16) and an on-board sensor device (14) connected to the device head (10).

### Claim 26 (depends on 25)

The apparatus as claimed in claim 25, wherein the apparatus (15) has a further on-board sensor device (19) which is attached to the device head (10) and which is communicatively connected to the control device (17).
