Method for determining a relative position of a mobile unit by comparing scans of an environment and mobile unit

• US 7,696,894 B2
• Filed: 07/31/2006
• Issued: 04/13/2010
• Est. Priority Date: 07/29/2005
• Status: Expired due to Fees

• Current Assignee: Siemens AG
• Original Assignee: Siemens AG
• Inventors: Fiegert, Michael, Soika, Martin
• Primary Examiner(s): Wu, Daniel
• Assistant Examiner(s): WILSON, BRIAN P
• Application Number:
  US11/495,560
• Publication Number:
  US 20070026872A1
• Time in Patent Office: 1,352 Days
• Field of Search: 340/686.1
• US Class Current: 340/686.1
• CPC Class Codes: G01S 15/42 Simultaneous measurement of distance and other co-ordinates indirect measurement G01S15/46
• CPC Class Codes: G01S 17/42 Simultaneous measurement of distance and other co-ordinates indirect measurement G01S17/46
• CPC Class Codes: G01S 5/0284 Relative positioning

Abstract

In the method for determining a relative position of a mobile unit by comparing scans of an environment, scans of an environment of the mobile unit are recorded continuously by a distance sensor and stored in a memory. Furthermore the processing unit compares a first scan with a second scan, with a relative position of the mobile unit at the time of the second scan being determined in relation to a position at the time of the first scan. The method is characterized by the fact that the processing unit compares the first scan iteratively with subsequent scans, with a new relative position of the mobile unit at the time of the relevant subsequent scan being determined relative to the position at the time of the first scan, and with the last relative position determined in each case being taken into account as a-priori information.

Claims

1. A method for determining a relative position of a mobile unit, comprising:

continuously recording scans of an environment of the mobile unit using a distance sensor;

storing the scans in a memory;

using a processing unit, comparing a first scan with a second scan;

determining a relative position of the mobile unit at a time of the second scan in relation to a position of the mobile unit at a time of the first scan;

iteratively comparing the first scan with subsequent scans to determine a new relative position of the mobile unit at a time of the relevant subsequent scan in relation to the position of the mobile unit at the time of the first scan; and

evaluating the relative position of the mobile unit at the time of a current scan using an immediately preceding relative position as a-priori information.

2. The method as claimed in claim 1, wherein

the processing unit compares each subsequent scan with the first scan and at least one further scan to respectively determine first and further relative positions, and

the processing unit computes a corrected relative position from the first and further relative positions with the aid of a correction filter.

3. The method as claimed in claim 1,

wherein the distance sensor is a laser scanner.

4. The method as claimed in claim 2,

wherein the correction filter computes the corrected relative position by averaging the first and further relative positions.

5. The method as claimed in claim 4,

wherein the first and further relative positions each specify a probability distribution about the position of the mobile unit.

6. The method as claimed in claim 2,

wherein at least three relative positions are determined respectively using at least three different prior scans, and

the correction filter only takes account of those relative positions which are equivalent to each other or are similar.

7. The method as claimed in claim 1, wherein

on the basis of the a-priori information in the memory a search is made for an earlier scan with an earlier position which is similar to an assumed current position produced from a current scan,

the earlier scan is compared with the current scan, and

the earlier position is accepted as the current position if a similarity between the earlier scan and the current scan exceeds a predetermined threshold value.

8. The method as claimed in claim 1, wherein absolute position information is additionally taken into account as a-priori information.

9. The method as claimed in claim 2, wherein

the processing unit iteratively compares different chains of scan pairs.

10. The method as claimed in claim 1, wherein

the method is applied online while the mobile unit is on the move, and

the relative position at the time of each current scan is compared with the immediately preceding relative position to.

11. The method as claimed in claim 1, wherein

the relative position at the time of each current scan is compared with the immediately preceding relative position to determine an error value,

a restart is performed as soon as the error value exceeds a predetermined threshold value or as soon as a distance between the position of the mobile unit at the time of the first scan and the position of the mobile unit at the time of the current scan exceeds a range of the distance sensor, and

when the restart is performed, instead of iteratively comparing the first scan with subsequent scans, the current scan is iteratively compared with subsequent scans.

12. The method as claimed in claim 1, wherein the processing unit selects and executes the following methods at different times depending on the resources available and the position determining needs:

a first method wherein

the processing unit compares each subsequent scan with the first scan and at least one further scan to respectively determine first and further relative positions,

the processing unit computes a corrected relative position from the first and further relative positions with the aid of a correction filter, and

the correction filter computes the corrected relative position by averaging the first and further relative positions;

a second method wherein

the processing unit compares each subsequent scan with the first scan and at least two other scans to determine three relative positions, and

the correction filter only considers those relative positions that are substantially the same

a third method wherein

on the basis of the a-priori information in the memory a search is made for an earlier scan with an earlier position which is similar to an assumed current position produced from a current scan,

the earlier scan is compared with the current scan, and

the earlier position is accepted as the current position if a similarity between the earlier scan and the current scan exceeds a predetermined threshold value; and

a fourth method wherein

the relative position at the time of each current scan is compared with the immediately preceding relative position to determine an error value,

a restart is performed as soon as the error value exceeds a predetermined threshold value or as soon as a distance between the position of the mobile unit at the time of the first scan and the position of the mobile unit at the time of the current scan exceeds a range of the distance sensor, and

when the restart is performed, instead of iteratively comparing the first scan with subsequent scans, the current scan is iteratively compared with subsequent scans.

13. A mobile unit for determining the relative position of the mobile unit comprising a distance sensor, a memory, and a processing unit, which is configured to execute a method in claim 1.

14. A computer-readable medium storing a program for controlling a computer to perform a method determining a relative position of a mobile unit, the method comprising:

continuously recording scans of an environment of the mobile unit using a distance sensor;

storing the scans in a memory;

using a processing unit, comparing a first scan with a second scan;

determining a relative position of the mobile unit at a time of the second scan in relation to a position of the mobile unit at a time of the first scan;

iteratively comparing the first scan with subsequent scans to determine a new relative position of the mobile unit at a time of the relevant subsequent scan in relation to the position of the mobile unit at the time of the first scan; and

evaluating the relative position of the mobile unit at the time of a current scan using an immediately preceding relative position as a-priori information.