METHOD OF AND APPARATUS FOR CREATING MAP OF ARTIFICIAL MARKS, AND METHOD AND APPARATUS FOR MEASURING POSITION OF MOVING OBJECT USING THE MAP

• US 20110098923A1
• Filed: 10/26/2010
• Published: 04/28/2011
• Est. Priority Date: 10/26/2009
• Status: Abandoned Application

• Current Assignee: Electronics and Telecommunications Research Institute, SK Telecom Co., Ltd.
• Original Assignee: Electronics and Telecommunications Research Institute, SK Telecom Co., Ltd.
• Inventors: LEE, Yu-Cheol
• Application Number:
  US12/912,199
• Publication Number:
  US 20110098923A1
• Time in Patent Office: Days
• US Class Current: 701/208
• CPC Class Codes: G01C 15/00 Surveying instruments or accessories not provided for in groups G01C1/00 - G01C13/00
• CPC Class Codes: G05D 1/024 in combination with a laser lasers per se H01S
• CPC Class Codes: G05D 1/0246 using a video camera in combination with image processing means
• CPC Class Codes: G05D 1/0272 comprising means for registering the travel distance, e.g. revolutions of wheels measuring distance traversed on the ground by vehicles, e.g. using odometers G01C22/00
• CPC Class Codes: G05D 1/0274 using mapping information stored in a memory device navigation using map-matching G01C21/30
• CPC Class Codes: G05D 2201/0203 Cleaning or polishing vehicle
• CPC Class Codes: G05D 2201/0207 Unmanned vehicle for inspecting or visiting an area
• CPC Class Codes: G05D 2201/0216 Vehicle for transporting goods in a warehouse, factory or similar

Abstract

A method of creating a map of artificial marks includes acquiring a position in which a moving object is moved, detecting each of the artificial marks to obtain an image thereof, calculating a relative position of the detected artificial mark, calculating a position of the detected artificial mark in a global coordinate system using the relative position, and storing the calculated position and an ID of the detected artificial mark in a map database to create the map of the artificial marks. Further, a method of measuring a position of a moving object includes detecting an artificial mark within a search range calculating a relative position of the detected artificial mark, and calculating a position of the moving object using the calculated relative position and a position in a global coordinate system corresponding to the relative position of the detected artificial mark from the map database.

Claims

1. A method of creating a map of artificial marks installed in an indoor space, the method comprising:

acquiring a position in which a moving object is moved in the indoor space;

detecting each of the artificial marks to obtain an image of the detected artificial mark;

calculating a relative position of the detected artificial mark using the position of the moving object and the image of the detected artificial mark;

calculating a position of the detected artificial mark in a global coordinate system using the calculated relative position; and

storing the calculated position in the global coordinate system and an ID of the detected artificial mark in a map database to create the map of the artificial marks.

2. The method of claim 1, wherein said acquiring a position in which a moving object is moved includes:

measuring the position in which the moving object is moved;

measuring positions of surrounding objects around each of the artificial marks; and

correcting the position of the moving object using the measured position of the moving object and the measured positions of the surrounding objects to produce a corrected position of the moving object,

wherein the corrected position is used to calculate the relative position of the detected artificial mark.

3. The method of claim 2, wherein said correcting the position of the moving object is performed using an extended Kalman filter.

4. The method of claim 1, further comprising:

classfying the detected artificial mark into a candidate artificial mark to be included in the map.

5. The method of claim 4, said classifying the detected artificial mark into the candidate artificial mark comprising:

checking whether the ID of the detected artificial mark is one of IDs of previously detected artificial marks; and

classifying the detected artificial mark into the candidate artificial mark when the ID of the detected artificial mark is not the one of the IDs of the previously detected artificial marks.

6. The method of claim 5, said classifying the detected artificial mark into the candidate artificial mark comprising:

comparing a currently detected distance between the moving object and the detected artificial mark with a previously detected distance between the moving object and the previously detected artificial mark when the ID of the detected artificial mark is one of the IDs of the previously detected artificial marks; and

classifying the detected artificial mark into the candidate artificial mark to be included in the map when the currently detected distance is shorter than the previously detected distance.

7. The method of claim 6, said classifying the detected artificial mark into the candidate artificial mark comprising:

classifying the previously detected artificial mark into the candidate artificial mark to be included in the map, when the currently detected distance is not shorter than the previously detected distance.

8. An apparatus for creating a map of artificial marks installed in an indoor space, the apparatus comprising:

a moving object travelling in the indoor space using a wheel, the moving object including an artificial mark detector mounted to the moving object for detecting each of the artificial marks to obtain an image of the detected artificial mark;

a relative position calculation unit for calculating a relative position of the detected artificial mark using a position in which the moving object is moved and the image of the detected artificial mark; and

a map creation device for calculating a position of the detected artificial mark in a global coordinate system using the calculated relative position; and

a map database storing the calculated position of the detected artificial mark in a global coordinate system.

9. The apparatus of claim 8, further comprising:

an encoder mounted to the wheel of the moving object for measuring the position in which the moving object is moved; and

a laser sensor mounted to the moving object for measuring a position of surrounding objects around each of the detected artificial mark; and

a position correction unit for correcting the position of the moving object using the measured position of the surrounding objects,

wherein the corrected position is used to calculate the relative position of the detected artificial mark by the relative position calculation unit.

10. The apparatus of claim 9, wherein the correction of the position in which the moving object is moved is performed by an extended Kalman filter.

11. The apparatus of claim 8, wherein the artificial mark detector comprises:

a pointer for scanning lasers or infrared light within a search range to detect an artificial mark within the search range; and

a camera for acquiring the image of the detected artificial mark within the search range.

12. The apparatus of claim 8, further comprising:

a candidate mark determining unit adapted to classify the detected artificial mark into a candidate artificial mark to be included in the map.

13. The apparatus of claim 12, wherein the candidate mark determining unit is further adapted to check whether the ID of the detected artificial mark is one of IDs of previously detected artificial marks;

and

classify the detected artificial mark into the candidate artificial mark when the ID of the detected artificial mark is not the one of the IDs of the previously detected artificial marks.

14. The apparatus of claim 12, wherein the candidate mark determining unit is further adapted to:

compare a currently detected distance between the moving object and the detected artificial mark with a previously detected distance between the moving object and the previously detected artificial mark when the ID of the detected artificial mark is one of the IDs of the previously detected artificial marks; and

classify the detected artificial mark into the candidate artificial mark to be included in the map when the currently detected distance is shorter than the previously detected distance.

15. The apparatus of claims 14, wherein the candidate mark determining unit is further adapted to classify the previously detected artificial mark into the candidate artificial mark to be included in the map when the currently detected distance is not shorter than the previously detected distance.

16. The apparatus of claim 9, wherein the relative position of the artificial mark is calculated into the position in the global coordinate system using the following Equation,

X_T=X_C+Δ

x·

cos(Θ

_C)−

Δ

y·

sin(Θ

_C)

Y_T=Y_C+Δ

x·

sin(Θ

_C)+Δ

y·

cos(Θ

_C)

Θ

_T=Θ

_C+Δ

θ

where O_G(X_OG, Y_OG) is an origin in the global coordinate system;

O_L(x_OL, y_OL) is an origin of the artificial mark detector in the local coordinate system;

X_C and Y_C are X-axis and Y-axis positions of the artificial mark detector in the global coordinate system, respectively;

Θ

_C is an installation direction of the artificial mark detector in the global coordinate system;

X_T and Y_T are X-axis and Y-axis positions of the artificial mark in the global coordinate system, respectively; and

Θ

_T denotes an installation direction of the artificial mark in the global coordinate system.

17. A method of measuring a position of a moving object, the method comprising:

acquiring a position in which the moving object is moved in an indoor space;

detecting each of artificial marks installed in the indoor space to obtain an image of the detected artificial mark;

calculating a relative position of the detected artificial mark using the image of the detected artificial mark and the position of the moving object;

obtaining a position in a global coordinate system corresponding to the relative position of the detected artificial mark; and

measuring a position of the moving object using the relative position and the position in the global coordinate system of the detected artificial mark.

18. The method of claim 17, wherein said acquiring a position in which a moving object is moved in the indoor space includes:

measuring the position in which the moving object is moved;

measuring positions of surrounding objects around each of the artificial marks; and

correcting the position of the moving object using the measured position of the moving object and the measured positions of the surrounding objects to produce a corrected position of the moving object,

wherein the corrected position is used to calculate the relative position of the detected artificial mark.

19. An apparatus for measuring a position of a moving object, the apparatus comprising:

a map database storing positions of the artificial marks in a global coordinate system, wherein each of the artificial marks has an ID assigned thereto to distinguish one another;

an artificial mark detector mounted to the moving object for detecting each of the artificial marks within a search range to acquire an image of the detected artificial mark;

a relative position calculation unit for calculating a relative position of the detected artificial mark by analyzing the acquired image; and

a position measuring unit for measuring a position of the moving object using the relative position and a position in a global coordinate system corresponding to the relative position of the detected artificial mark, which is obtained from the map database.

20. The apparatus of claim 19, wherein the position of the moving object is calculated using the following Equation,

Θ

_C=Θ

_T−

Δ

θ

X_C=X_T−

Δ

x·

cos(Θ

_C)+Δ

y·

sin(Θ

_C)

Y_C=Y_T−

Δ

x·

sin(Θ

_C)−

Δ

y·

cos(Θ

_C)

wherein O_G(X_OG^, Y_OGA is an origin in the global coordinate system;

O_L(x_OL, y_OL) is an origin of the artificial mark detector in the local coordinate system;

X_C, and Y_C are X-axis and Y-axis positions of the artificial mark detector in the global coordinate system, respectively;

Θ

_C is an installation direction of the artificial mark detector in the global coordinate system;

X_T and Y_T are X-axis and Y-axis positions of the artificial mark in the global coordinate system, respectively; and

Θ

_T is an installation direction of the artificial mark.