KR20180078736A - Apparatus and method for generating indoor map using duplication grid analysis - Google Patents

Apparatus and method for generating indoor map using duplication grid analysis Download PDF

Info

Publication number
KR20180078736A
KR20180078736A KR1020160183805A KR20160183805A KR20180078736A KR 20180078736 A KR20180078736 A KR 20180078736A KR 1020160183805 A KR1020160183805 A KR 1020160183805A KR 20160183805 A KR20160183805 A KR 20160183805A KR 20180078736 A KR20180078736 A KR 20180078736A
Authority
KR
South Korea
Prior art keywords
grid
map
grids
local map
unit
Prior art date
Application number
KR1020160183805A
Other languages
Korean (ko)
Other versions
KR101962855B1 (en
Inventor
김성신
조현학
김은경
장은석
Original Assignee
부산대학교 산학협력단
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 부산대학교 산학협력단 filed Critical 부산대학교 산학협력단
Priority to KR1020160183805A priority Critical patent/KR101962855B1/en
Publication of KR20180078736A publication Critical patent/KR20180078736A/en
Application granted granted Critical
Publication of KR101962855B1 publication Critical patent/KR101962855B1/en

Links

Images

Classifications

    • GPHYSICS
    • G09EDUCATION; CRYPTOGRAPHY; DISPLAY; ADVERTISING; SEALS
    • G09BEDUCATIONAL OR DEMONSTRATION APPLIANCES; APPLIANCES FOR TEACHING, OR COMMUNICATING WITH, THE BLIND, DEAF OR MUTE; MODELS; PLANETARIA; GLOBES; MAPS; DIAGRAMS
    • G09B29/00Maps; Plans; Charts; Diagrams, e.g. route diagram
    • G09B29/003Maps
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • G01C21/206Instruments for performing navigational calculations specially adapted for indoor navigation
    • GPHYSICS
    • G09EDUCATION; CRYPTOGRAPHY; DISPLAY; ADVERTISING; SEALS
    • G09BEDUCATIONAL OR DEMONSTRATION APPLIANCES; APPLIANCES FOR TEACHING, OR COMMUNICATING WITH, THE BLIND, DEAF OR MUTE; MODELS; PLANETARIA; GLOBES; MAPS; DIAGRAMS
    • G09B29/00Maps; Plans; Charts; Diagrams, e.g. route diagram
    • G09B29/003Maps
    • G09B29/004Map manufacture or repair; Tear or ink or water resistant maps; Long-life maps

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Business, Economics & Management (AREA)
  • Educational Administration (AREA)
  • Educational Technology (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

According to the present invention, provided are an apparatus and a method to: convert a local map, measured about an environment of a large range of an area based on a range which a sensor is able to measure, into a local map grid; and generate an indoor map by using a part overlapped with a global map. The present invention comprises: a line extracting unit which extracts a line of an obstacle by converting data measured from a distance measurement sensor into coordinate data; a local map grid generating unit which generates a local map grid by generating a grid of the corresponding point based on a distance between the distance measurement sensor and a point within the line extracted from the line extracting unit; a redundant grid area extracting unit which extracts a grid mutually overlapped from a grid area of the generated local map grid and a previously stored global map grid; a robot position correcting unit which corrects a robot position according to the rotation and movement of a robot through a singular value decomposition (SVD) which is an SVD algorithm based on the redundant grid extracted from the redundant grid area extracting unit; and a global map updating unit which updates local map grid coordinates based on the robot position corrected in the robot position correcting unit and updates a grid based on the degree of the extracted redundant grid area, thereby updating an overall global map.

Description

중복 그리드 기법을 이용한 실내 지도 생성 장치 및 방법{Apparatus and method for generating indoor map using duplication grid analysis}[0001] The present invention relates to an indoor map generating apparatus and method using a redundant grid method,

본 발명은 SLAM(Simultaneous Localization And Mapping)의 기술 중 한 분야로서 환경의 맵 생성 및 생성된 맵을 기반으로 한 위치측정에 관한 것으로, 특히 범위가 넓은 영역의 환경을 센서가 측정 가능한 범위를 기반으로 계측된 로컬 맵을 로컬 맵 그리드로 변환을 하고, 글로벌 맵과 중첩된 부분을 이용하여 실내 지도를 생성하기 위한 장치 및 방법에 관한 것이다.The present invention relates to SLAM (Simultaneous Localization And Mapping) technology. The present invention relates to generation of a map of an environment and position measurement based on the generated map. In particular, To an apparatus and method for converting a measured local map into a local map grid and generating an indoor map using a portion overlapped with the global map.

로봇이 주어진 작업을 수행하기 위해서는 현재 위치를 정확히 아는 기술이 중요하다. 수많은 타입의 모바일 로봇 중에서 유도 라인을 위한 랜드마크를 설치할 수 없는 환경 내에서는 자체적으로 맵을 생성해서, 맵 내에서 위치를 측정할 수 있는 방법이 이용된다.In order for a robot to perform a given task, it is important to know the exact position of the robot. Among the many types of mobile robots, there is a method of generating a map on its own and measuring its position in the map in an environment where a landmark for a guidance line can not be installed.

환경의 맵을 생성 시에는 환경 내에서 센서가 인식할 수 있는 거리 정보를 바탕으로 환경을 부분적으로 인식하여, 맵을 추가적으로 연결하여 생성해야한다. 이러한 방법 중에는 SLAM(Simultaneous Localization And Mapping) 기술이 있으며, 그 중에서 맵을 그리드 영역으로 분할하여 그리드 기반으로 주어진 문제를 해결하는 방법이 있다. When generating the map of the environment, the environment should be partially recognized based on the distance information that can be recognized by the sensor in the environment, and the map must be additionally connected and generated. Among these methods, there is SLAM (Simultaneous Localization And Mapping) technology. Among them, there is a method of solving a given problem based on grid by dividing a map into grid areas.

그러나 그리드를 이용한 SLAM은 맵을 일정 크기의 그리드로 분할을 해서 이용하기 때문에 메모리 사용량이 많으며, 계산시간이 복잡하다. 특히, 환경의 크기가 크고 분기점과 같은 특징점이 많은 환경에서는 계산 시간이 많이 걸리게 되는 문제점이 있어, 이를 효율적으로 줄일 수 있는 방법이 필요하다. However, since the SLAM using the grid divides the map into a grid of a certain size, the memory usage is high and the calculation time is complicated. In particular, there is a problem that the environment takes a large amount of time in an environment having a large size and a large number of feature points such as a turning point. Therefore, a method for efficiently reducing the problem is needed.

공개특허공보 제10-2015-0115282호 (공개일자 2015.10.14)Japanese Patent Application Laid-Open No. 10-2015-0115282 (published on October 10, 2015) 등록특허공보 제10-1503904호 (등록일자 2015.03.12)Patent Registration No. 10-1503904 (Registration date 2015.03.12)

본 발명은 상기와 같은 문제점을 해결하기 위해 안출한 것으로서, 범위가 넓은 영역의 환경을 센서가 측정 가능한 범위를 기반으로 계측된 로컬 맵을 로컬 맵 그리드로 변환을 하고, 글로벌 맵과 중첩된 부분을 이용하여 실내 지도를 생성하기 위한 장치 및 방법을 제공하는데 그 목적이 있다.SUMMARY OF THE INVENTION The present invention has been conceived to solve the problems as described above, and it is an object of the present invention to provide a method and apparatus for converting a local map measured on the basis of a range measurable by a sensor into a local map grid, And to provide an apparatus and a method for generating an indoor map using the indoor map.

본 발명의 다른 목적들은 이상에서 언급한 목적으로 제한되지 않으며, 언급되지 않은 또 다른 목적들은 아래의 기재로부터 당업자에게 명확하게 이해될 수 있을 것이다.Other objects of the present invention are not limited to the above-mentioned objects, and other objects not mentioned can be clearly understood by those skilled in the art from the following description.

상기와 같은 목적을 달성하기 위한 본 발명에 따른 중복 그리드 기법을 이용한 실내 지도 생성 장치의 특징은 거리 측정 센서로부터 측정되는 데이터를 좌표 데이터로 변환하여 장애물의 라인을 추출하는 라인 추출부와, 상기 라인 추출부에서 추출된 라인 내의 점과 거리 측정 센서와의 거리를 기반으로 해당 점의 그리드를 생성하여 로컬 맵 그리드를 생성하는 로컬 맵 그리드 생성부와, 미리 저장되어 있는 글로벌 맵 그리드와 상기 생성된 로컬 맵 그리드의 그리드 영역 중 서로 겹치는 그리드를 추출하는 중첩 그리드 영역 추출부와, 상기 중첩 그리드 영역 추출부에서 추출된 중첩 그리드를 기반으로 특이값 분해 알고리즘인 SVD(Singular Value Decomposition)를 통한 로봇의 회전 및 이동에 따른 로봇 위치를 보정하는 로봇 위치 보정부와, 상기 로봇 위치 보정부에서 보정된 로봇 위치를 기반으로 로컬 맵 그리드 좌표를 갱신하고, 상기 추출된 겹치는 그리드 영역의 정도를 기반으로 그리드를 갱신하여 전체 글로벌 맵을 갱신하는 글로벌 맵 갱신부를 포함하여 구성되는데 있다.According to another aspect of the present invention, there is provided an indoor map generating apparatus using a redundant grid method, comprising: a line extracting unit for extracting a line of an obstacle by converting data measured by a distance measuring sensor into coordinate data; A local map grid generator for generating a grid of the point based on a distance between a point in the line extracted by the extractor and the distance measuring sensor to generate a local map grid, An overlapping grid area extracting unit for extracting a grid overlapping among the grid areas of the map grid based on the overlapping grid extracted by the overlapping grid area extracting unit, and a rotating unit for rotating and rotating the robot through singular value decomposition (SVD) A robot position correcting unit for correcting the robot position according to the movement, Update the local map grid coordinates based on the position correction in the robot unit, it is composed by including the extracted based on the degree of overlapping grid area update the grid to update global map to update the whole global map portion.

바람직하게 상기 글로벌 맵 그리드는 기존에 저장되어 있는 경우는 저장되어 있는 글로벌 맵 그리드를 이용하고, 기존에 저장되어 있지 않은 경우는 로컬 맵 그리드 생성부에서 생성된 로컬 맵 그리드를 글로벌 맵 그리드로 저장하여 이용하는 것을 특징으로 한다.Preferably, the global map grid uses the stored global map grid if it is stored, and if not, stores the local map grid generated by the local map grid generator as a global map grid .

바람직하게 상기 로컬 맵 그리드 생성부는 추출된 모든 라인의 점 개수를 산출하는 점 개수 산출부와, 거리 측정 센서와 추출된 라인 내의 점까지의 거리를 산출하는 거리 산출부와, 상기 거리 산출부에서 산출된 거리를 기반으로 거리에 따른 그리드 크기를 다르게 설정하는 그리드 크기 설정부와, 상기 그리드 크기 설정부에서 설정된 그리드 크기로 해당 점에 대응하여 그리드를 생성하여 로컬 맵 그리드에 추가하는 그리드 생성부로 구성되는 것을 특징으로 한다.Preferably, the local map grid generator comprises: a point number calculating unit for calculating the number of points of all the extracted lines; a distance calculating unit for calculating a distance to the point in the extracted line from the distance measuring sensor; And a grid generating unit for generating a grid corresponding to a corresponding point in the grid size set by the grid size setting unit and adding the grid to the local map grid based on the grid size set by the grid size setting unit, .

바람직하게 상기 그리드 크기 설정부는 거리가 멀수록 그리드 크기를 더 크게 설정하는 것을 특징으로 한다.Preferably, the grid size setting unit sets the grid size to be larger as the distance increases.

바람직하게 상기 글로벌 맵 갱신부는 겹치는 영역에 두 그리드의 중점이 모두 포함되는 경우는 겹치는 영역의 크기로 하나의 그리드로 갱신하고, 겹치는 영역에 하나의 그리드 중점만이 포함되는 경우는 두 그리드를 모두 포함하는 영역의 크기로 하나의 그리드로 갱신하고, 또한 겹치는 영역에 두 그리드의 중점 중 어느 하나도 포함되지 않는 경우는 두 그리드가 각각 독립적인 영역으로 그리드를 갱신하는 것을 특징으로 한다.Preferably, the global map updating unit updates one grid with the size of the overlapping region when both the midpoints of the two grids are included in the overlapping region. If only one grid midpoint is included in the overlapping region, And the grid is updated to a region where the two grids are independent of each other when the center of gravity of the two grids is not included in the overlapping region.

상기와 같은 목적을 달성하기 위한 본 발명에 따른 중복 그리드 기법을 이용한 실내 지도 생성 방법의 특징은 (A) 거리 측정 센서를 통해 측정된 데이터가 획득되면, 기구학을 이용하여 로봇의 위치를 산출하는 단계와, (B) 라인 추출부를 통해 거리 측정 센서로부터 측정되는 데이터를 좌표 데이터로 변환하고, 측정된 장애물의 라인을 추출하는 단계와, (C) 상기 추출된 라인 내의 점과 거리 측정 센서와의 거리를 기반으로 로컬 맵 그리드 생성부에서 해당 점의 그리드를 생성하여 로컬 맵 그리드를 생성하는 단계와, (D) 중첩 그리드 영역 추출부를 통해 미리 저장되어 있는 글로벌 맵 그리드와 상기 생성된 로컬 맵 그리드를 비교하여 그리드 영역 중 서로 겹치는 그리드를 추출하여 대응점 쌍으로 저장하는 단계와, (E) 상기 추출된 대응점 쌍을 갖는 중첩 그리드를 기반으로 로봇 위치 보정부에서 특이값 분해 알고리즘을 통한 로봇의 회전값 및 이동값을 산출하고, 이를 기반으로 로봇 위치를 보정하는 단계와, (F) 글로벌 맵 갱신부를 통해 상기 보정된 로봇 위치를 기반으로 로컬 맵 그리드 좌표를 갱신하고, 상기 추출된 겹치는 그리드 영역의 정도를 기반으로 그리드를 갱신하여 전체 글로벌 맵을 갱신하는 단계를 포함하여 이루어지는데 있다.According to another aspect of the present invention, there is provided a method of generating an indoor map using a redundant grid method, the method comprising: (A) calculating data of a position of a robot using kinematics, (B) converting the data measured from the distance measuring sensor through the line extracting unit into coordinate data and extracting a line of the measured obstacle, (C) calculating a distance between the point in the extracted line and the distance measuring sensor A step of generating a local map grid by generating a grid of corresponding points in a local map grid generating unit based on the local map grid generated by the local map grid generating unit, and (D) comparing the previously stored global map grid with the generated local map grid Extracting grids overlapping each other among the grid areas and storing them as pairs of corresponding points; and (E) Calculating a rotation value and a movement value of the robot using the singular value decomposition algorithm in the robot position correcting unit based on the lead and correcting the robot position based thereon; Updating the local map grid coordinates based on the extracted grid area, and updating the grid based on the extracted degree of the overlapped grid area to update the entire global map.

바람직하게 상기 (C) 단계는 점 개수 산출부를 통해 추출된 모든 라인의 점 개수를 산출하는 단계와, 라인에서 산출되는 점을 하나씩 순차적으로 선택하여 모든 점이 선택될 때까지 거리 산출부를 통해 거리 측정 센서와 각 점까지의 거리를 산출하는 단계와, 그리드 크기 설정부를 통해 산출된 거리를 기반으로 거리에 따른 그리드 크기를 다르게 설정하여, 모든 점에 대응되는 그리드를 생성하는 단계와, 그리드 생성부를 통해 상기 생성된 그리드를 로컬 맵 그리드에 추가하여 로컬 맵 그리드를 생성하는 단계를 포함하여 이루어지는 것을 특징으로 한다.Preferably, the step (C) includes the steps of calculating the number of points of all the lines extracted through the point number calculating unit, and sequentially selecting the points calculated in the line one by one, Generating a grid corresponding to all points by setting a grid size according to a distance on the basis of the distance calculated through the grid size setting unit to generate a grid corresponding to all points; And generating the local map grid by adding the generated grid to the local map grid.

바람직하게 상기 (D) 단계는 로컬 맵 그리드 생성부에서 생성된 로컬 맵 그리드가 하나씩 순차적으로 하여 모든 그리드를 선택하는 단계와, 글로벌 맵 그리드가 하나씩 순차적으로 하여 모든 그리드를 선택하는 단계와, 상기 선택된 로컬 맵 그리드 및 글로벌 맵 그리드의 비교를 통해 글로벌 맵 그리드와 로컬 맵 그리드 영역 중 서로 겹치는 그리드를 추출하는 단계와, 상기 추출된 서로 겹치는 그리드를 대응점 쌍으로 저장하는 단계를 포함하는 것을 특징으로 한다.Preferably, the step (D) includes the steps of: selecting all the grids by sequentially generating the local map grids generated by the local map grid generating unit; selecting all the grids one by one by the global map grids; Extracting a grid overlapping among the global map grid and the local map grid area through comparison between the local map grid and the global map grid, and storing the extracted overlapping grids as pairs of corresponding points.

바람직하게 상기 (E) 단계는 중첩 그리드 영역 추출부에서 추출된 대응점 쌍을 갖는 중첩 그리드의 모든 로컬 맵 그리드 및 모든 글로벌 맵 그리드를 검출하는 단계와, 상기 검출된 모든 로컬 맵 그리드의 중점 및 모든 글로벌 맵 그리드의 중점을 검출하는 단계와, 상기 검출된 로컬 맵 그리드의 중점을 기준으로 각 로컬 맵 그리드의 대칭점을 각각 산출하는 단계와, 상기 검출된 글로벌 맵 그리드의 중점을 기준으로 각 글로벌 맵 그리드의 대칭점을 각각 산출하는 단계와, 상기 산출된 로컬 맵 그리드의 대칭점 및 글로벌 맵 그리드의 대칭점의 특이점 분할을 위한 행렬에서 발생되는 오류를 해소하기 위한 행렬 가중치(W)를 다음 식

Figure pat00001
을 이용하여 산출하는 단계와, 상기 산출된 행렬 가중치를 기반으로 특이값 분해 알고리즘을 수행하여 로컬 맵 그리드의 대칭점 및 글로벌 맵 그리드의 대칭점을 행렬로 생성하는 단계와, 상기 생성된 행렬로 분해된 값을 이용하여 오류를 보정하기 위한 오류 가중치와 함께, 로봇의 회전값 및 이동값을 산출하여 로봇 위치를 보정하는 단계를 포함하여 이루어지는 것을 특징으로 한다.Preferably, the step (E) includes the steps of: detecting all local map grids and all global map grids of overlapping grids having pairs of corresponding points extracted by the overlapping grid region extraction unit; Calculating a symmetric point of each local map grid on the basis of the detected center point of the local map grid, calculating a center point of each global map grid based on the detected center point of the global map grid, (W) for eliminating an error occurring in a matrix for dividing the calculated point of symmetry of the local map grid and the singular point of the symmetric point of the global map grid,
Figure pat00001
Generating a symmetric point of the local map grid and a symmetric point of the global map grid by performing a singular value decomposition algorithm on the basis of the calculated matrix weight; And correcting the robot position by calculating a rotation value and a movement value of the robot together with an error weight for correcting the error by using the error weight.

바람직하게 상기 (F) 단계는 보정된 로봇 위치를 기반으로 로컬 맵 그리드 좌표를 갱신하는 단계와, 로컬 맵 그리드가 하나씩 순차적으로 모든 그리드를 선택하는 단계와, 글로벌 맵 그리드가 하나씩 순차적으로 모든 그리드를 선택하는 단계와, 상기 선택된 로컬 맵 그리드 및 글로벌 맵 그리드의 영역 중 서로 겹치는 그리드를 추출하는 단계와, 상기 추출된 그리드의 겹치는 영역의 정도를 기반으로 겹쳐지는 영역에 위치하는 그리드의 개수를 산출하는 단계와, 상기 산출되는 그리드의 개수를 기반으로 영역을 설정하여 그리드를 갱신하는 단계와, 상기 갱신되는 그리드를 이용하여 글로벌 맵을 갱신하는 단계를 포함하여 이루어지는 것을 특징으로 한다.Preferably, the step (F) includes the steps of: updating the local map grid coordinates based on the corrected robot position; selecting all the grids sequentially, one by one, and the global map grid sequentially Extracting a grid overlapping one of the regions of the selected local map grid and the global map grid; calculating a number of grids located in the overlapping region based on the degree of the overlapping region of the extracted grid; Updating the grid by setting an area based on the number of the calculated grids, and updating the global map using the updated grid.

바람직하게 상기 그리드의 개수 산출은 그리드들이 겹치는 영역에 각 그리드의 중점이 위치하는 그리드 개수를 산출하는 것을 특징으로 한다.Preferably, the number of grids is calculated by calculating the number of grids in which the midpoints of the grids are located in the overlapping regions of the grids.

바람직하게 상기 그리드를 갱신하는 단계는 상기 산출되는 그리드의 개수(ocpc)가 2개 이상인 경우는 겹치는 영역의 크기로 하나의 그리드를 갱신하는 단계와, 상기 산출되는 그리드의 개수(ocpc)가 1개인 경우는 두 그리드를 모두 포함하는 영역의 크기로 하나의 그리드를 갱신하는 단계와, 상기 산출되는 그리드의 개수(ocpc)가 0개인 경우는 두 그리드가 각각 독립적인 영역으로 그리드를 갱신하는 단계를 포함하여 이루어지는 것을 특징으로 한다.Preferably, the step of updating the grid includes updating one grid to a size of the overlapping region when the number of generated ocpc is two or more, and if the number ocpc of the calculated ocpc is one A step of updating one grid with the size of an area including both grids, and a step of updating the grid with areas where the two grids are independent when the number of calculated grids (ocpc) is 0 .

이상에서 설명한 바와 같은 본 발명에 따른 중복 그리드 기법을 이용한 실내 지도 생성 장치 및 방법은 다음과 같은 효과가 있다.As described above, the indoor map generating apparatus and method using the redundant grid technique according to the present invention have the following effects.

첫째, 그리드를 기반으로 하는 SLAM 기술의 문제점을 보완한 기술로서, 각 다른 크기의 그리드를 이용하게 되며, 이는 해당 특징점의 불확실성을 나타내는 크기로 볼 수 있음에 따라 위치를 측정할 시 보다 정밀하게 측정할 수 있는 효과가 있다.First, as a technique to overcome the problems of the grid-based SLAM technique, grids of different sizes are used, which can be viewed as a size indicating the uncertainty of the corresponding feature points, There is an effect that can be done.

둘째, 모바일 로봇의 유도를 위해서는 유선/무선 타입의 유도 시스템이 필요하지만, 환경의 조건에 따라 시스템을 이용할 수 없는 환경이 존재하며, 주변 환경의 외란 등에 의해 이용할 수 없는 경우에 해당 방법을 모바일 로봇에 적용할 수 있다. 예로서, 반도체 공장 등에서는 유선/무선 타입 사용 불가능함으로 주변 환경을 인식하여 로봇을 유도해야 한다.Second, a wired / wireless type guidance system is required for guiding a mobile robot. However, when there is an environment in which the system can not be used according to the conditions of the environment, and the mobile robot can not be used due to disturbance of the surrounding environment, . For example, in a semiconductor factory or the like, it is impossible to use a wired / wireless type so that the robot must be guided to recognize the surrounding environment.

도 1 은 본 발명의 실시예에 따른 중복 그리드 기법을 이용한 실내 지도 생성 장치의 구성을 나타낸 블록도
도 2 는 도 1에서 로컬 맵 그리드 생성부의 구성을 상세히 나타낸 블록도
도 3 은 본 발명의 실시예에 따른 중복 그리드 기법을 이용한 실내 지도 생성 방법을 설명하기 위한 흐름도
도 4 는 도 3에서 로컬 맵 그리드를 생성하는 과정을 상세히 설명하기 위한 흐름도
도 5 는 도 3에서 로컬 맵 그리드를 생성하는 과정을 상세히 설명하기 위한 구성도
도 6 은 도 3에서 글로벌 맵과 로컬 맵 그리드의 겹치는 그리드 영역을 추출하는 과정을 설명하기 위한 흐름도
도 7 은 도 3에서 로봇의 위치 보정 과정을 설명하기 위한 흐름도
도 8 은 도 3에서 글로벌 맵의 갱신을 설명하기 위한 흐름도
도 9 는 도 3에서 글로벌 맵의 갱신을 설명하기 위한 구성도
1 is a block diagram illustrating a configuration of an indoor map generating apparatus using a redundant grid technique according to an embodiment of the present invention;
FIG. 2 is a block diagram showing in detail the configuration of the local map grid generating unit in FIG.
3 is a flowchart illustrating a method of generating an indoor map using a redundant grid technique according to an embodiment of the present invention.
FIG. 4 is a flowchart illustrating a process of generating a local map grid in detail in FIG.
FIG. 5 is a block diagram illustrating in detail the process of generating a local map grid in FIG.
FIG. 6 is a flowchart for explaining a process of extracting a grid area overlapping a global map and a local map grid in FIG. 3
FIG. 7 is a flowchart for explaining a position correction process of the robot in FIG.
FIG. 8 is a flowchart for explaining updating of the global map in FIG.
FIG. 9 is a diagram for explaining updating of the global map in FIG.

본 발명의 다른 목적, 특성 및 이점들은 첨부한 도면을 참조한 실시예들의 상세한 설명을 통해 명백해질 것이다.Other objects, features and advantages of the present invention will become apparent from the detailed description of the embodiments with reference to the accompanying drawings.

본 발명에 따른 중복 그리드 기법을 이용한 실내 지도 생성 장치 및 방법의 바람직한 실시예에 대하여 첨부한 도면을 참조하여 설명하면 다음과 같다. 그러나 본 발명은 이하에서 개시되는 실시예에 한정되는 것이 아니라 서로 다른 다양한 형태로 구현될 수 있으며, 단지 본 실시예는 본 발명의 개시가 완전하도록하며 통상의 지식을 가진자에게 발명의 범주를 완전하게 알려주기 위해 제공되는 것이다. 따라서 본 명세서에 기재된 실시예와 도면에 도시된 구성은 본 발명의 가장 바람직한 일 실시예에 불과할 뿐이고 본 발명의 기술적 사상을 모두 대변하는 것은 아니므로, 본 출원시점에 있어서 이들을 대체할 수 있는 다양한 균등물과 변형예들이 있을 수 있음을 이해하여야 한다.A preferred embodiment of an indoor map generating apparatus and method using a redundant grid technique according to the present invention will be described with reference to the accompanying drawings. The present invention may, however, be embodied in many different forms and should not be construed as limited to the embodiments set forth herein. Rather, these embodiments are provided so that this disclosure will be thorough and complete, and will fully convey the scope of the invention to those skilled in the art. It is provided to let you know. Therefore, the embodiments described in the present specification and the configurations shown in the drawings are merely the most preferred embodiments of the present invention and are not intended to represent all of the technical ideas of the present invention. Therefore, various equivalents It should be understood that water and variations may be present.

도 1 은 본 발명의 실시예에 따른 중복 그리드 기법을 이용한 실내 지도 생성 장치의 구성을 나타낸 블록도이다.FIG. 1 is a block diagram illustrating a configuration of an indoor map generating apparatus using a redundant grid technique according to an embodiment of the present invention. Referring to FIG.

도 1에서 도시하고 있는 것과 같이, 본 발명의 실내 지도 생성 장치는 거리 측정 센서로부터 측정되는 데이터를 좌표 데이터로 변환하여 장애물의 라인을 추출하는 라인 추출부(100)와, 상기 라인 추출부(100)에서 추출된 라인 내의 점과 거리 측정 센서와의 거리를 기반으로 해당 점의 그리드를 생성하여 로컬 맵 그리드를 생성하는 로컬 맵 그리드 생성부(200)와, 미리 저장되어 있는 글로벌 맵 그리드와 상기 생성된 로컬 맵 그리드의 그리드 영역 중 서로 겹치는 그리드를 추출하는 중첩 그리드 영역 추출부(400)와, 상기 중첩 그리드 영역 추출부(400)에서 추출된 중첩 그리드를 기반으로 특이값 분해 알고리즘인 SVD(Singular Value Decomposition)를 통한 로봇의 회전 및 이동에 따른 로봇 위치를 보정하는 로봇 위치 보정부(500)와, 상기 로봇 위치 보정부(500)에서 보정된 로봇 위치를 기반으로 로컬 맵 그리드 좌표를 갱신하고, 상기 추출된 겹치는 그리드 영역의 정도를 기반으로 그리드를 갱신하여 전체 글로벌 맵을 갱신하는 글로벌 맵 갱신부(600)로 구성된다.As shown in FIG. 1, the indoor map generating apparatus of the present invention includes a line extracting unit 100 for converting data measured from a distance measuring sensor into coordinate data and extracting a line of an obstacle, A local map grid generator 200 for generating a grid of the point based on the distance between the point in the line extracted by the distance map and the distance measuring sensor to generate a local map grid, An overlapping grid area extraction unit 400 for extracting a grid overlapping one of the grid areas of the local map grid based on the overlapping grid extracted by the overlapping grid area extraction unit 400, A robot position correcting unit 500 for correcting the robot position according to the rotation and the movement of the robot through the robot position correcting unit 500, Update the local map grid coordinates based on the position and the robot, is composed of the updated overlapping grid grid based on the degree of area determination to update the whole global map by updating the global map (600).

이때, 상기 글로벌 맵 그리드는 기존에 저장되어 있는 경우는 저장되어 있는 글로벌 맵 그리드를 이용하고, 기존에 저장되어 있지 않은 경우는 로컬 맵 그리드 생성부(200)에서 생성된 로컬 맵 그리드를 글로벌 맵 그리드로 저장하여 이용한다.At this time, if the global map grid has been stored, the global map grid is used. If the global map grid is not stored, the local map grid generated by the local map grid generator 200 is used as a global map grid .

한편, 상기 로컬 맵 그리드 생성부(200)는 도 2에서 도시하고 있는 것과 같이, 추출된 모든 라인의 점 개수를 산출하는 점 개수 산출부(210)와, 거리 측정 센서와 추출된 라인 내의 점까지의 거리를 산출하는 거리 산출부(220)와, 상기 거리 산출부(220)에서 산출된 거리를 기반으로 거리에 따른 그리드 크기를 다르게 설정하는 그리드 크기 설정부(230)와, 상기 그리드 크기 설정부(230)에서 설정된 그리드 크기로 해당 점에 대응하여 그리드를 생성하여 로컬 맵 그리드에 추가하는 그리드 생성부(240)로 구성된다. 이때, 상기 그리드 크기 설정부(230)는 거리가 멀수록 그리드 크기를 더 크게 설정하게 된다. 2, the local map grid generating unit 200 includes a point number calculating unit 210 for calculating the number of points of all the extracted lines, A grid size setting unit 230 for setting a grid size depending on the distance on the basis of the distance calculated by the distance calculating unit 220, And a grid generator 240 for generating a grid corresponding to the corresponding point with a grid size set in the grid 230 and adding the generated grid to the local map grid. At this time, the grid size setting unit 230 sets the grid size to be larger as the distance increases.

그리고 상기 글로벌 맵 갱신부(600)는 겹치는 영역에 두 그리드의 중점이 모두 포함되는 경우는 겹치는 영역의 크기로 하나의 그리드로 갱신하고, 겹치는 영역에 하나의 그리드 중점만이 포함되는 경우는 두 그리드를 모두 포함하는 영역의 크기로 하나의 그리드로 갱신하고, 또한 겹치는 영역에 두 그리드의 중점 중 어느 하나도 포함되지 않는 경우는 두 그리드가 각각 독립적인 영역으로 그리드를 갱신한다.When the center of the two grids is included in the overlapping area, the global map updating unit 600 updates the overlapped area with one grid, and if there is only one grid center point in the overlapping area, In the case where any of the midpoints of the two grids is not included in the overlapping area, the two grids update the grid into independent areas.

이와 같이 구성된 본 발명에 따른 중복 그리드 기법을 이용한 실내 지도 생성 장치의 동작을 첨부한 도면을 참조하여 상세히 설명하면 다음과 같다. 도 1 또는 도 2와 동일한 참조부호는 동일한 기능을 수행하는 동일한 부재를 지칭한다. The operation of the indoor map generating apparatus using the redundant grid method according to the present invention will now be described in detail with reference to the accompanying drawings. Like reference numerals in FIG. 1 or FIG. 2 denote the same members performing the same function.

도 3 은 본 발명의 실시예에 따른 중복 그리드 기법을 이용한 실내 지도 생성 방법을 설명하기 위한 흐름도이다.3 is a flowchart illustrating a method of generating an indoor map using a redundant grid technique according to an embodiment of the present invention.

도 3을 참조하여 설명하면, 먼저 거리 측정 센서를 통해 측정된 데이터가 획득되면(S100), 기구학을 이용하여 로봇의 위치를 산출한다(S200). 이때, 상기 거리 측정 센서는 일반적으로 0~80m 정도를 측정하고 있으며, 이에 따라 로봇의 주변 80m 내 장애물들과의 거리를 측정할 수 있게 된다.Referring to FIG. 3, when the measured data is obtained through the distance measuring sensor (S100), the position of the robot is calculated using the kinematics (S200). At this time, the distance measuring sensor generally measures about 0 ~ 80m, and thus it is possible to measure the distance to obstacles within 80m of the robot.

이어 라인 추출부(100)를 통해 거리 측정 센서로부터 측정되는 데이터를 좌표 데이터로 변환하고(S300), 측정된 장애물의 라인을 추출한다(S400). The data measured from the distance measuring sensor is converted into coordinate data through the line extracting unit 100 (S300), and the measured line of the obstacle is extracted (S400).

그리고 로컬 맵 그리드 생성부(200)는 이렇게 추출된 라인 내의 점과 거리 측정 센서와의 거리를 기반으로 해당 점의 그리드를 생성하여 로컬 맵 그리드를 생성한다(S500). 상기 S500 단계에 따른 상세한 방법은 아래에서 도 4 및 도 5를 참조하여 설명하도록 한다.The local map grid generator 200 generates a grid of points based on the distance between the points in the extracted line and the distance measuring sensor to generate a local map grid (S500). The detailed method according to step S500 will be described below with reference to FIGS. 4 and 5. FIG.

이어 기존의 글로벌 맵이 저장되어 있는 경우(S600), 중첩 그리드 영역 추출부(400)를 통해 글로벌 맵 그리드와 상기 생성된 로컬 맵 그리드를 비교하여 그리드 영역 중 서로 겹치는 그리드를 추출하여 대응점 쌍으로 저장한다(S700). 상기 S700 단계에 따른 상세한 방법은 아래에서 도 6을 참조하여 설명하도록 한다. 한편, 기존의 글로벌 맵이 저장되어 있지 않은 경우는(S600), 상기 생성된 로컬 맵 그리드를 글로벌 맵으로 저장하여 이용한다(S1000).If the existing global map is stored (S600), the global map grid is compared with the generated local map grid through the overlapping grid area extracting unit 400 to extract the overlapping grids among the grid areas and store them as pairs of corresponding points (S700). The detailed method according to the step S700 will be described below with reference to FIG. On the other hand, if the existing global map is not stored (S600), the generated local map grid is stored as a global map (S1000).

이렇게 추출된 대응점 쌍을 갖는 중첩 그리드를 기반으로 로봇 위치 보정부(500)에서 특이값 분해 알고리즘인 SVD(Singular Value Decomposition)를 통한 로봇의 회전값 및 이동값을 산출하고, 이를 기반으로 로봇 위치를 보정한다(S800). 이때, 상기 SVD는 고유값 분해의 까다로운 조건을 무시하고 모든

Figure pat00002
행렬에 대해 적용이 가능하다. 그리고 상기 S800 단계에 따른 상세한 방법은 아래에서 도 7을 참조하여 설명하도록 한다. Based on the superimposed grid having the pair of extracted points thus extracted, the robot position correcting unit 500 calculates the rotation value and the movement value of the robot using SVD (Singular Value Decomposition), which is a singular value decomposition algorithm, (S800). At this time, the SVD ignores the difficult conditions of eigenvalue decomposition,
Figure pat00002
It is applicable to matrix. The detailed method according to step S800 will be described below with reference to FIG.

그리고 글로벌 맵 갱신부(600)를 통해 상기 보정된 로봇 위치를 기반으로 로컬 맵 그리드 좌표를 갱신하고, 상기 추출된 겹치는 그리드 영역의 정도를 기반으로 그리드를 갱신하여 전체 글로벌 맵을 갱신한다(S900). 상기 S900 단계에 따른 상세한 방법은 아래에서 도 8 및 도 9를 참조하여 설명하도록 한다.Then, the local map grid coordinates are updated based on the corrected robot position through the global map updating unit 600, and the global map is updated based on the extracted degree of the overlapped grid area (S900) . The detailed method according to step S900 will be described below with reference to FIGS. 8 and 9. FIG.

이때, 상기 그리드의 갱신은 겹치는 영역에 두 그리드의 중점이 모두 포함되는 경우는 겹치는 영역의 크기로 하나의 그리드로 갱신하고, 겹치는 영역에 하나의 그리드 중점만이 포함되는 경우는 두 그리드를 모두 포함하는 영역의 크기로 하나의 그리드로 갱신하고, 또한 겹치는 영역에 두 그리드의 중점 중 어느 하나도 포함되지 않는 경우는 두 그리드가 각각 독립적인 영역으로 그리드를 갱신한다.In the case where the center of gravity of the two grids is included in the overlapping area, the update of the grid is updated to one grid in the size of the overlapping area. If only one grid center is included in the overlapping area, And if the overlapping region does not include any of the midpoints of the two grids, the two grids update the grid to be independent regions.

상기 S500 단계에 따른 상세한 방법을 설명하면 다음과 같다.The detailed method according to step S500 will now be described.

도 4 는 도 3에서 로컬 맵 그리드를 생성하는 과정을 상세히 설명하기 위한 흐름도이고, 도 5 는 도 3에서 로컬 맵 그리드를 생성하는 과정을 상세히 설명하기 위한 구성도이다.FIG. 4 is a flowchart illustrating a process of generating a local map grid in FIG. 3, and FIG. 5 is a diagram illustrating a process of generating a local map grid in detail.

도 4를 참조하여 설명하면, 먼저 점 개수 산출부(210)를 통해 추출된 모든 라인의 점 개수(mps)를 산출한다(S501). 즉, 도 5(a)에서 도시하고 있는 것과 같이 거리 계측 센서에서 계측된 장애물의 모든 라인을 이루는 점의 개수를 산출한다.Referring to FIG. 4, the number of points (mps) of all lines extracted through the point number calculation unit 210 is calculated (S501). That is, as shown in Fig. 5 (a), the number of points constituting all the lines of the obstacle measured by the distance measuring sensor is calculated.

이때, 라인에서 산출되는 점을 하나씩 순차적으로 선택하여 모든 점이 선택될 때까지(S502~S503), 거리 산출부(220)를 통해 거리 측정 센서와 각 점(i)까지의 거리를 산출한다(S504). 상기 거리를 산출하는 방식은 거리 측정 센서에서 발사되는 레이져가 돌아오는 시간에 비례하여 거리가 증가하는 공식(거리=속력*시간)을 사용하여 산출할 수 있다.At this time, the points calculated in the line are sequentially selected one by one and the distances from the distance measuring sensor to each point (i) are calculated through the distance calculating unit 220 until all the points are selected (S502 to S503) ). The method of calculating the distance can be calculated using a formula (distance = speed * time) in which the distance increases in proportion to the time the laser emitted from the distance measuring sensor returns.

그리고 그리드 크기 설정부(230)를 통해 산출된 거리를 기반으로 거리에 따른 그리드 크기를 다르게 설정하여(S505), 모든 점(mps)에 대응되는 그리드를 생성한다(S506). 즉, 도 5(b)에서 도시하고 있는 것과 같이 거리 측정 센서와 장애물과의 거리가 멀수록 생성되는 그리드의 크기를 점점 더 크게 설정한다. Then, the grid size according to the distance is set differently based on the distance calculated through the grid size setting unit 230 (S505), and a grid corresponding to all points (mps) is generated (S506). That is, as shown in FIG. 5 (b), the larger the distance between the distance measuring sensor and the obstacle, the larger the size of the generated grid.

그리고 그리드 생성부(240)는 이렇게 생성된 그리드를 로컬 맵 그리드에 추가하여 도 5(c)에서 도시하고 있는 것과 같이 로컬 맵 그리드를 생성한다(S507). Then, the grid generator 240 adds the generated grid to the local map grid to generate a local map grid as shown in FIG. 5C (S507).

상기 S700 단계에 따른 상세한 방법을 설명하면 다음과 같다.The detailed method according to step S700 will be described below.

도 6 은 도 3에서 글로벌 맵 그리드와 로컬 맵 그리드의 겹치는 그리드 영역을 추출하는 과정을 설명하기 위한 흐름도이다.FIG. 6 is a flowchart illustrating a process of extracting a grid area overlapping a global map grid and a local map grid in FIG.

도 6을 참조하여 설명하면, 로컬 맵 그리드 생성부(200)에서 생성된 로컬 맵 그리드가 하나씩 순차적으로 하여 모든 그리드(lmc)가 선택되고(S701~S703), 또한 글로벌 맵 그리드가 하나씩 순차적으로 하여 모든 그리드(gmc)가 선택하여(S704~S706) 서로 비교함으로써, 글로벌 맵 그리드와 로컬 맵 그리드 영역 중 서로 겹치는 그리드를 추출한다(S707). 6, the local map grids generated by the local map grid generator 200 are sequentially selected one by one, all the grids lmc are selected (S701 to S703), and the global map grids are sequentially arranged one by one All the grids gmc select (S704 to S706) and compare them to extract a grid that overlaps the global map grid and the local map grid area (S707).

그리고 상기 추출된 서로 겹치는 그리드를 대응점 쌍으로 저장한다(S708).Then, the extracted overlapping grids are stored as pairs of corresponding points (S708).

상기 S800 단계에 따른 상세한 방법을 설명하면 다음과 같다.The detailed method according to step S800 will be described below.

도 7 은 도 3에서 로봇의 위치 보정 과정을 설명하기 위한 흐름도이다.FIG. 7 is a flowchart for explaining the position correction process of the robot in FIG.

도 7을 참조하여 설명하면, 중첩 그리드 영역 추출부(400)에서 추출된 대응점 쌍을 갖는 중첩 그리드의 모든 로컬 맵 그리드(

Figure pat00003
) 및 모든 글로벌 맵 그리드(
Figure pat00004
)를 검출한다(S801)(S802).Referring to FIG. 7, all the local map grids of the overlapping grid having the pair of corresponding points extracted by the overlapping grid area extracting unit 400
Figure pat00003
) And all global map grids (
Figure pat00004
(S801) (S802).

그리고 검출된 모든 로컬 맵 그리드(

Figure pat00005
)의 중점(cp)과, 모든 글로벌 맵 그리드(
Figure pat00006
)의 중점(cx)을 검출한다(S803).And all detected local map grids (
Figure pat00005
(Cp) of all global map grids
Figure pat00006
(Step S803).

이어 상기 검출된 로컬 맵 그리드의 중점(cp)을 기준으로 각 로컬 맵 그리드의 대칭점(np)을 각각 산출하고, 또한 글로벌 맵 그리드의 중점(cx)을 기준으로 각 글로벌 맵 그리드의 대칭점(nx)을 각각 산출한다(S804). 다음 수학식 1은 이러한 대칭점(np)(nx)을 산출하기 위한 수식이다.The symmetric point np of each local map grid is calculated based on the detected center point cp of the detected local map grid and the symmetric point nx of each global map grid is calculated based on the center point cx of the global map grid. (S804). The following equation (1) is a formula for calculating such a symmetry point (np) (nx).

Figure pat00007
Figure pat00007

이때, p는 로컬 맵 그리드를 나타내고, x는 글로벌 맵 그리드를 나타낸다. 또한 cp는 로컬 맵 그리드의 중점을 나타내고, cx는 글로벌 맵 그리드의 중점을 나타낸다.Where p represents the local map grid, and x represents the global map grid. Cp represents the center point of the local map grid, and cx represents the center point of the global map grid.

이처럼, 그리드의 대칭점을 산출하는 이유는 이동 로봇이 회전을 했을 때, 원점을 기준으로 회전을 해야 정확한 계산이 이루어지게 됨에 따라, 원점을 0으로 변경하기 위한 그리드의 대칭점 값을 이용하게 된다. As described above, the reason why the symmetry point of the grid is calculated is that when the mobile robot rotates, it must be rotated based on the origin, so that the accurate calculation is performed, so that the value of the symmetry point of the grid for changing the origin to zero is used.

그리고 상기 산출된 로컬 맵 그리드의 대칭점(np) 및 글로벌 맵 그리드의 대칭점(nx)의 특이점 분할을 위한 행렬에서 발생되는 오류를 해소하기 위한 행렬 가중치(W)를 다음 수학식 2와 같이 산출한다.The matrix weight W for eliminating an error generated in the matrix for dividing the calculated singular point of the symmetry point np of the local map grid and the symmetry point nx of the global map grid is calculated according to Equation (2).

Figure pat00008
Figure pat00008

이어 상기 산출된 행렬 가중치를 기반으로 특이값 분해 알고리즘인 SVD(Singular Value Decomposition)를 수행하여 로컬 맵 그리드의 대칭점(np) 및 글로벌 맵 그리드의 대칭점(nx)을

Figure pat00009
행렬로 생성한다(S806).(http://tlaja.blog.me/220726154312 : 참조)Then, SVD (Singular Value Decomposition), which is a singular value decomposition algorithm, is performed based on the calculated matrix weights to calculate the symmetric point np of the local map grid and the symmetric point nx of the global map grid
Figure pat00009
(S806) (see http://tlaja.blog.me/220726154312: see)

이렇게 행렬로 분해된 값을 이용하여 다음 수학식 3, 4, 5를 이용하여 오류를 보정하기 위한 오류 가중치(W)와 함께(S807), 로봇의 회전값(R) 및 이동값(T)을 산출함으로써, 이를 기반으로 로봇 위치가 보정된다(S808)(S809).Using the values thus decomposed into the matrices, the rotation value R and the movement value T of the robot together with the error weight W for correcting the error using the following equations (3), (4) And the position of the robot is corrected based on this calculation (S808) (S809).

Figure pat00010
Figure pat00010

Figure pat00011
Figure pat00011

Figure pat00012
Figure pat00012

이때, U는

Figure pat00013
직교 행렬을 나타내고, S는 대각 행렬을 나타내며, V는
Figure pat00014
직교 행렬을 나타낸다.At this time, U
Figure pat00013
S denotes a diagonal matrix, V denotes an orthogonal matrix,
Figure pat00014
Represents an orthogonal matrix.

상기 S900 단계에 따른 상세한 방법을 설명하면 다음과 같다.The detailed method according to step S900 will be described below.

도 8 은 도 3에서 글로벌 맵의 갱신을 설명하기 위한 흐름도이고, 도 9 는 도 3에서 글로벌 맵의 갱신을 설명하기 위한 구성도이다.FIG. 8 is a flowchart for explaining updating of the global map in FIG. 3, and FIG. 9 is a diagram for explaining updating of the global map in FIG.

도 8을 참조하여 설명하면, 상기 보정된 로봇 위치를 기반으로 로컬 맵 그리드 좌표를 갱신한다(S901).Referring to FIG. 8, the local map grid coordinates are updated based on the corrected robot position (S901).

이어 도 9(a)에서 도시하고 있는 것과 같이, 로컬 맵 그리드가 하나씩 순차적으로 모든 그리드(lmc)를 선택하고(S902~S904), 또한 글로벌 맵 그리드가 하나씩 순차적으로 모든 그리드(gmc)를 선택하여(S904~S907)하여 글로벌 맵 그리드(i)와 로컬 맵 그리드(j) 영역 중 서로 겹치는 그리드를 추출한다(S908).9 (a), the local map grids sequentially select all grids lmc (S902 to S904), and the global map grids sequentially select all the grids gmc one by one (S904 to S907), and a grid overlapping among the global map grid (i) and the local map grid (j) region is extracted (S908).

그리고 도 9(b)에서 도시하고 있는 것과 같이, 상기 추출된 그리드의 겹치는 영역의 정도를 기반으로 겹쳐지는 영역에 위치하는 그리드의 개수(ocpc)를 산출한다(S910)(S912). 예로서, 도 9(b)에서 첫 번째에 위치하는 두 그리드(10)(20)의 경우, 두 그리드(10)(20)의 겹치는 영역에 두 그리드의 중점(A)(B)이 모두가 위치하므로 산출되는 그리드의 개수는 2가 된다. 또한 두 번째에 위치하는 두 그리드(10)(20)의 경우, 두 그리드(10)(20)의 겹치는 영역에 두 그리드의 중점(A)(B) 중 하나의 중점(B) 만이 위치하므로 산출되는 그리드의 개수는 1이 된다. 또한 세 번째에 위치하는 두 그리드(10)(20)의 경우, 두 그리드(10)(20)의 겹치는 영역에 두 그리드의 중점(A)(B) 중 어느 하나도 위치하지 않으므로 산출되는 그리드의 개수는 0이 된다.Then, as shown in FIG. 9 (b), the number of grids (ocpc) located in the overlapping area is calculated based on the degree of the overlapped area of the extracted grid (S910) (S912). For example, in the case of two grids 10 and 20 positioned at the first position in FIG. 9 (b), the midpoints (A) and (B) of the two grids in the overlapping areas of the two grids 10 and 20 are all The number of grids to be calculated is two. In the case of the two grids 10 and 20 positioned at the second position, since only the midpoint B of one of the midpoints A and B of the two grids is located in the overlapping area of the two grids 10 and 20, The number of grids becomes 1. In addition, in the case of the two grids 10 and 20 located at the third position, since neither of the center points A and B of the two grids is located in the overlapping area of the two grids 10 and 20, Becomes zero.

이처럼, 상기 산출되는 그리드의 개수(ocpc)가 2개인 경우는(S910) 겹치는 영역의 크기로 하나의 그리드를 갱신하고(S911), 상기 산출되는 그리드의 개수(ocpc)가 1개인 경우는(S912) 두 그리드를 모두 포함하는 영역의 크기로 하나의 그리드를 갱신한다(S913). 또한, 상기 산출되는 그리드의 개수(ocpc)가 0개인 경우는 두 그리드가 각각 독립적인 영역으로 그리드를 갱신한다(S914). 도 9(b)는 겹치는 영역에 중점(A)(B)이 포함되는 개수에 따라 갱신되는 그리드를 나타내고 있다.If the number of calculated ocpc is two (S910), one grid is updated to the size of the overlapped region (S911). If the number of calculated ocpc is one (S912 ) One grid is updated to the size of the area including both grids (S913). If the number (ocpc) of the calculated grids is 0, the grid is updated to the independent regions of the two grids (S914). FIG. 9 (b) shows a grid that is updated according to the number of middle points (A) and (B) included in the overlapping area.

글로벌 맵 갱신부(600)는 이렇게 갱신되는 그리드를 이용하여 글로벌 맵을 갱신하게 된다.The global map updating unit 600 updates the global map using the grid thus updated.

상기에서 설명한 본 발명의 기술적 사상은 바람직한 실시예에서 구체적으로 기술되었으나, 상기한 실시예는 그 설명을 위한 것이며 그 제한을 위한 것이 아님을 주의하여야 한다. 또한, 본 발명의 기술적 분야의 통상의 지식을 가진자라면 본 발명의 기술적 사상의 범위 내에서 다양한 실시예가 가능함을 이해할 수 있을 것이다. 따라서 본 발명의 진정한 기술적 보호 범위는 첨부된 특허청구범위의 기술적 사상에 의해 정해져야 할 것이다. While the present invention has been particularly shown and described with reference to exemplary embodiments thereof, it is to be understood that the invention is not limited to the disclosed exemplary embodiments. It will be apparent to those skilled in the art that various modifications may be made without departing from the scope of the present invention. Accordingly, the true scope of the present invention should be determined by the technical idea of the appended claims.

Claims (12)

거리 측정 센서로부터 측정되는 데이터를 좌표 데이터로 변환하여 장애물의 라인을 추출하는 라인 추출부와,
상기 라인 추출부에서 추출된 라인 내의 점과 거리 측정 센서와의 거리를 기반으로 해당 점의 그리드를 생성하여 로컬 맵 그리드를 생성하는 로컬 맵 그리드 생성부와,
미리 저장되어 있는 글로벌 맵 그리드와 상기 생성된 로컬 맵 그리드의 그리드 영역 중 서로 겹치는 그리드를 추출하는 중첩 그리드 영역 추출부와,
상기 중첩 그리드 영역 추출부에서 추출된 중첩 그리드를 기반으로 특이값 분해 알고리즘인 SVD(Singular Value Decomposition)를 통한 로봇의 회전 및 이동에 따른 로봇 위치를 보정하는 로봇 위치 보정부와,
상기 로봇 위치 보정부에서 보정된 로봇 위치를 기반으로 로컬 맵 그리드 좌표를 갱신하고, 상기 추출된 겹치는 그리드 영역의 정도를 기반으로 그리드를 갱신하여 전체 글로벌 맵을 갱신하는 글로벌 맵 갱신부를 포함하여 구성되는 것을 특징으로 하는 중복 그리드 기법을 이용한 실내 지도 생성 장치.
A line extracting unit for extracting a line of an obstacle by converting data measured from the distance measuring sensor into coordinate data,
A local map grid generator for generating a grid of points based on a distance between a point in the line extracted by the line extractor and the distance measuring sensor to generate a local map grid,
An overlapping grid area extracting unit for extracting a grid that is overlapped among a grid map area of the generated global map grid and a grid map area of the grid map area,
A robot position correcting unit for correcting the robot position according to the rotation and movement of the robot through SVD (Singular Value Decomposition) which is a singular value decomposition algorithm based on the overlapping grid extracted by the overlapping grid area extracting unit,
And a global map updating unit updating the local map grid coordinates based on the robot position corrected by the robot position correcting unit and updating the global global map based on the extracted degree of the overlapping grid area And generating an indoor map using the redundant grid method.
제 1 항에 있어서,
상기 글로벌 맵 그리드는 기존에 저장되어 있는 경우는 저장되어 있는 글로벌 맵 그리드를 이용하고, 기존에 저장되어 있지 않은 경우는 로컬 맵 그리드 생성부에서 생성된 로컬 맵 그리드를 글로벌 맵 그리드로 저장하여 이용하는 것을 특징으로 하는 중복 그리드 기법을 이용한 실내 지도 생성 장치.
The method according to claim 1,
When the global map grid has been stored, the global map grid is used. If the global map grid is not stored, the local map grid generated by the local map grid generating unit is stored as a global map grid and used An indoor map generation system using redundant grid technique.
제 1 항에 있어서, 상기 로컬 맵 그리드 생성부는
추출된 모든 라인의 점 개수를 산출하는 점 개수 산출부와,
거리 측정 센서와 추출된 라인 내의 점까지의 거리를 산출하는 거리 산출부와,
상기 거리 산출부에서 산출된 거리를 기반으로 거리에 따른 그리드 크기를 다르게 설정하는 그리드 크기 설정부와,
상기 그리드 크기 설정부에서 설정된 그리드 크기로 해당 점에 대응하여 그리드를 생성하여 로컬 맵 그리드에 추가하는 그리드 생성부로 구성되는 것을 특징으로 하는 중복 그리드 기법을 이용한 실내 지도 생성 장치.
The apparatus of claim 1, wherein the local map grid generator
A point number calculating section for calculating the number of points of all extracted lines,
A distance calculating unit for calculating a distance from the distance measuring sensor to a point in the extracted line,
A grid size setting unit for setting a grid size depending on the distance based on the distance calculated by the distance calculating unit;
And a grid generating unit for generating a grid corresponding to the corresponding point with the grid size set by the grid size setting unit and adding the generated grid to the local map grid.
제 3 항에 있어서,
상기 그리드 크기 설정부는 거리가 멀수록 그리드 크기를 더 크게 설정하는 것을 특징으로 하는 중복 그리드 기법을 이용한 실내 지도 생성 장치.
The method of claim 3,
Wherein the grid size setting unit sets a larger grid size as the distance increases.
제 1 항에 있어서, 상기 글로벌 맵 갱신부는
겹치는 영역에 두 그리드의 중점이 모두 포함되는 경우는 겹치는 영역의 크기로 하나의 그리드로 갱신하고, 겹치는 영역에 하나의 그리드 중점만이 포함되는 경우는 두 그리드를 모두 포함하는 영역의 크기로 하나의 그리드로 갱신하고, 또한 겹치는 영역에 두 그리드의 중점 중 어느 하나도 포함되지 않는 경우는 두 그리드가 각각 독립적인 영역으로 그리드를 갱신하는 것을 특징으로 하는 중복 그리드 기법을 이용한 실내 지도 생성 장치.
The apparatus of claim 1, wherein the global map updating unit
In the case where the overlapping area includes all of the center points of two grids, the size of the overlapping area is updated to one grid. If only one grid center point is included in the overlapping area, And updating the grid to an independent region when the overlapping region does not include any one of the midpoints of the two grids.
(A) 거리 측정 센서를 통해 측정된 데이터가 획득되면, 기구학을 이용하여 로봇의 위치를 산출하는 단계와,
(B) 라인 추출부를 통해 거리 측정 센서로부터 측정되는 데이터를 좌표 데이터로 변환하고, 측정된 장애물의 라인을 추출하는 단계와,
(C) 상기 추출된 라인 내의 점과 거리 측정 센서와의 거리를 기반으로 로컬 맵 그리드 생성부에서 해당 점의 그리드를 생성하여 로컬 맵 그리드를 생성하는 단계와,
(D) 중첩 그리드 영역 추출부를 통해 미리 저장되어 있는 글로벌 맵 그리드와 상기 생성된 로컬 맵 그리드를 비교하여 그리드 영역 중 서로 겹치는 그리드를 추출하여 대응점 쌍으로 저장하는 단계와,
(E) 상기 추출된 대응점 쌍을 갖는 중첩 그리드를 기반으로 로봇 위치 보정부에서 특이값 분해 알고리즘을 통한 로봇의 회전값 및 이동값을 산출하고, 이를 기반으로 로봇 위치를 보정하는 단계와,
(F) 글로벌 맵 갱신부를 통해 상기 보정된 로봇 위치를 기반으로 로컬 맵 그리드 좌표를 갱신하고, 상기 추출된 겹치는 그리드 영역의 정도를 기반으로 그리드를 갱신하여 전체 글로벌 맵을 갱신하는 단계를 포함하여 이루어지는 것을 특징으로 하는 중복 그리드 기법을 이용한 실내 지도 생성 방법.
(A) a step of calculating the position of the robot using kinematics when measured data is obtained through the distance measuring sensor,
(B) converting data measured from the distance measuring sensor into coordinate data through a line extracting unit and extracting a line of the measured obstacle,
(C) generating a local map grid by generating a grid of corresponding points in a local map grid generator based on a distance between the point in the extracted line and the distance measuring sensor,
(D) comparing the generated global map grid with the global map grid stored in advance through the overlapping grid area extracting unit, extracting the overlapped grids among the grid areas and storing them as pairs of corresponding points,
(E) calculating a rotation value and a movement value of the robot using the singular value decomposition algorithm in the robot position correcting unit based on the overlapping grid having the extracted pair of corresponding points, and correcting the robot position based on the rotation value and the movement value,
(F) updating the local map grid coordinates based on the corrected robot position through the global map updating unit, and updating the grid based on the extracted degree of overlapping grid area to update the entire global map A method of generating an indoor map using a redundant grid technique.
제 6 항에 있어서, 상기 (C) 단계는
점 개수 산출부를 통해 추출된 모든 라인의 점 개수를 산출하는 단계와,
라인에서 산출되는 점을 하나씩 순차적으로 선택하여 모든 점이 선택될 때까지 거리 산출부를 통해 거리 측정 센서와 각 점까지의 거리를 산출하는 단계와,
그리드 크기 설정부를 통해 산출된 거리를 기반으로 거리에 따른 그리드 크기를 다르게 설정하여, 모든 점에 대응되는 그리드를 생성하는 단계와,
그리드 생성부를 통해 상기 생성된 그리드를 로컬 맵 그리드에 추가하여 로컬 맵 그리드를 생성하는 단계를 포함하여 이루어지는 것을 특징으로 하는 중복 그리드 기법을 이용한 실내 지도 생성 방법.
7. The method of claim 6, wherein step (C)
Calculating a number of points of all lines extracted through the point number calculating unit,
Selecting one of the points calculated in the line one by one and calculating the distance to the distance measuring sensor and each point through the distance calculating unit until all the points are selected;
Generating a grid corresponding to all the points by setting a grid size according to the distance based on the distance calculated through the grid size setting unit;
And generating a local map grid by adding the generated grid to a local map grid through a grid generating unit.
제 6 항에 있어서, 상기 (D) 단계는
로컬 맵 그리드 생성부에서 생성된 로컬 맵 그리드가 하나씩 순차적으로 하여 모든 그리드를 선택하는 단계와,
글로벌 맵 그리드가 하나씩 순차적으로 하여 모든 그리드를 선택하는 단계와,
상기 선택된 로컬 맵 그리드 및 글로벌 맵 그리드의 비교를 통해 글로벌 맵 그리드와 로컬 맵 그리드 영역 중 서로 겹치는 그리드를 추출하는 단계와,
상기 추출된 서로 겹치는 그리드를 대응점 쌍으로 저장하는 단계를 포함하는 것을 특징으로 하는 중복 그리드 기법을 이용한 실내 지도 생성 방법.
7. The method of claim 6, wherein step (D)
Selecting all the grids by sequentially generating the local map grids generated by the local map grid generating unit one by one,
Selecting all the grids by sequentially performing global map grids one by one,
Extracting a grid overlapping among the global map grid and the local map grid region by comparing the selected local map grid and the global map grid,
And storing the extracted overlapping grids as a pair of corresponding points.
제 6 항에 있어서, 상기 (E) 단계는
중첩 그리드 영역 추출부에서 추출된 대응점 쌍을 갖는 중첩 그리드의 모든 로컬 맵 그리드 및 모든 글로벌 맵 그리드를 검출하는 단계와,
상기 검출된 모든 로컬 맵 그리드의 중점 및 모든 글로벌 맵 그리드의 중점을 검출하는 단계와,
상기 검출된 로컬 맵 그리드의 중점을 기준으로 각 로컬 맵 그리드의 대칭점을 각각 산출하는 단계와,
상기 검출된 글로벌 맵 그리드의 중점을 기준으로 각 글로벌 맵 그리드의 대칭점을 각각 산출하는 단계와,
상기 산출된 로컬 맵 그리드의 대칭점 및 글로벌 맵 그리드의 대칭점의 특이점 분할을 위한 행렬에서 발생되는 오류를 해소하기 위한 행렬 가중치(W)를 다음 식
Figure pat00015
을 이용하여 산출하는 단계와,
상기 산출된 행렬 가중치를 기반으로 특이값 분해 알고리즘을 수행하여 로컬 맵 그리드의 대칭점 및 글로벌 맵 그리드의 대칭점을 행렬로 생성하는 단계와,
상기 생성된 행렬로 분해된 값을 이용하여 오류를 보정하기 위한 오류 가중치와 함께, 로봇의 회전값 및 이동값을 산출하여 로봇 위치를 보정하는 단계를 포함하여 이루어지는 것을 특징으로 하는 중복 그리드 기법을 이용한 실내 지도 생성 방법.
7. The method of claim 6, wherein step (E)
Detecting all local map grids and all global map grids of overlapping grids having corresponding pairs extracted from the overlapping grid region extracting unit,
Detecting a midpoint of all the detected local map grids and a midpoint of all global map grids,
Calculating symmetric points of each local map grid based on the detected center point of the local map grid,
Calculating symmetric points of each global map grid based on the detected center point of the global map grid,
The matrix weight W for eliminating errors generated in the matrix for dividing the calculated point of symmetry of the local map grid and the singular point of the symmetric point of the global map grid is expressed by the following equation
Figure pat00015
; And
Performing a singular value decomposition algorithm based on the calculated matrix weights to generate a matrix of symmetry points of the local map grid and a global map grid;
And correcting the robot position by calculating a rotation value and a movement value of the robot together with an error weight for correcting the error using the value decomposed by the generated matrix. How to create an indoor map.
제 6 항에 있어서, 상기 (F) 단계는
보정된 로봇 위치를 기반으로 로컬 맵 그리드 좌표를 갱신하는 단계와,
로컬 맵 그리드가 하나씩 순차적으로 모든 그리드를 선택하는 단계와,
글로벌 맵 그리드가 하나씩 순차적으로 모든 그리드를 선택하는 단계와,
상기 선택된 로컬 맵 그리드 및 글로벌 맵 그리드의 영역 중 서로 겹치는 그리드를 추출하는 단계와,
상기 추출된 그리드의 겹치는 영역의 정도를 기반으로 겹쳐지는 영역에 위치하는 그리드의 개수를 산출하는 단계와,
상기 산출되는 그리드의 개수를 기반으로 영역을 설정하여 그리드를 갱신하는 단계와,
상기 갱신되는 그리드를 이용하여 글로벌 맵을 갱신하는 단계를 포함하여 이루어지는 것을 특징으로 하는 중복 그리드 기법을 이용한 실내 지도 생성 방법.
7. The method of claim 6, wherein step (F)
Updating the local map grid coordinates based on the corrected robot position,
Selecting all the grids sequentially, one by one,
The global map grid sequentially selecting all the grids one by one,
Extracting a grid overlapping one of the regions of the selected local map grid and the global map grid;
Calculating a number of grids located in overlapping areas based on the degree of overlapping areas of the extracted grids;
Updating the grid by setting an area based on the number of the calculated grids;
And updating the global map by using the updated grid.
제 10 항에 있어서,
상기 그리드의 개수 산출은 그리드들이 겹치는 영역에 각 그리드의 중점이 위치하는 그리드 개수를 산출하는 것을 특징으로 하는 중복 그리드 기법을 이용한 실내 지도 생성 방법.
11. The method of claim 10,
Wherein the number of grids is calculated by calculating the number of grids in which the center of each grid is located in a region where the grids overlap.
제 10 항에 있어서, 상기 그리드를 갱신하는 단계는
상기 산출되는 그리드의 개수(ocpc)가 2개 이상인 경우는 겹치는 영역의 크기로 하나의 그리드를 갱신하는 단계와,
상기 산출되는 그리드의 개수(ocpc)가 1개인 경우는 두 그리드를 모두 포함하는 영역의 크기로 하나의 그리드를 갱신하는 단계와,
상기 산출되는 그리드의 개수(ocpc)가 0개인 경우는 두 그리드가 각각 독립적인 영역으로 그리드를 갱신하는 단계를 포함하여 이루어지는 것을 특징으로 하는 중복 그리드 기법을 이용한 실내 지도 생성 방법.
11. The method of claim 10, wherein updating the grid comprises:
Updating one grid to a size of an overlapped area when the number of calculated grids (ocpc) is two or more,
Updating one grid to a size of an area including both grids when the number of calculated grids (ocpc) is one,
And updating the grid to an area in which the two grids are independent when the number of calculated ocpc is zero (0).
KR1020160183805A 2016-12-30 2016-12-30 Apparatus and method for generating indoor map using duplication grid analysis KR101962855B1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
KR1020160183805A KR101962855B1 (en) 2016-12-30 2016-12-30 Apparatus and method for generating indoor map using duplication grid analysis

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
KR1020160183805A KR101962855B1 (en) 2016-12-30 2016-12-30 Apparatus and method for generating indoor map using duplication grid analysis

Publications (2)

Publication Number Publication Date
KR20180078736A true KR20180078736A (en) 2018-07-10
KR101962855B1 KR101962855B1 (en) 2019-03-27

Family

ID=62915708

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020160183805A KR101962855B1 (en) 2016-12-30 2016-12-30 Apparatus and method for generating indoor map using duplication grid analysis

Country Status (1)

Country Link
KR (1) KR101962855B1 (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109978767A (en) * 2019-03-27 2019-07-05 集美大学 The ground laser SLAM drawing method based on multirobot collaboration
CN111476286A (en) * 2020-04-02 2020-07-31 哈尔滨工程大学 Map construction method for mobile robot
WO2020197126A1 (en) * 2019-03-25 2020-10-01 주식회사 트위니 Method for estimating positioning of moving object by using big cell grid map, recording medium in which program for implementing same is stored, and computer program stored in medium in order to implement same
CN114037807A (en) * 2021-11-24 2022-02-11 深圳市云鼠科技开发有限公司 Method and device for constructing chain type grid map with low memory occupation and computer equipment

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20120047137A (en) * 2010-11-03 2012-05-11 엘지전자 주식회사 Robot cleaner and controlling method of the same
KR20130073097A (en) * 2011-12-23 2013-07-03 삼성전자주식회사 Apparatus for estimating the robot pose and method thereof
JP2014219722A (en) * 2013-05-01 2014-11-20 村田機械株式会社 Autonomous mobile body
KR101503904B1 (en) 2008-07-07 2015-03-19 삼성전자 주식회사 Apparatus and method for building map for mobile robot
KR20150115282A (en) 2014-04-03 2015-10-14 부산대학교 산학협력단 System and method for formating 3d map using 2d laser range finder

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101503904B1 (en) 2008-07-07 2015-03-19 삼성전자 주식회사 Apparatus and method for building map for mobile robot
KR20120047137A (en) * 2010-11-03 2012-05-11 엘지전자 주식회사 Robot cleaner and controlling method of the same
KR20130073097A (en) * 2011-12-23 2013-07-03 삼성전자주식회사 Apparatus for estimating the robot pose and method thereof
JP2014219722A (en) * 2013-05-01 2014-11-20 村田機械株式会社 Autonomous mobile body
KR20150115282A (en) 2014-04-03 2015-10-14 부산대학교 산학협력단 System and method for formating 3d map using 2d laser range finder

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2020197126A1 (en) * 2019-03-25 2020-10-01 주식회사 트위니 Method for estimating positioning of moving object by using big cell grid map, recording medium in which program for implementing same is stored, and computer program stored in medium in order to implement same
CN109978767A (en) * 2019-03-27 2019-07-05 集美大学 The ground laser SLAM drawing method based on multirobot collaboration
CN109978767B (en) * 2019-03-27 2023-09-15 集美大学 Laser SLAM map method based on multi-robot cooperation
CN111476286A (en) * 2020-04-02 2020-07-31 哈尔滨工程大学 Map construction method for mobile robot
CN114037807A (en) * 2021-11-24 2022-02-11 深圳市云鼠科技开发有限公司 Method and device for constructing chain type grid map with low memory occupation and computer equipment
CN114037807B (en) * 2021-11-24 2023-03-28 深圳市云鼠科技开发有限公司 Method and device for constructing chain type grid map with low memory occupation and computer equipment

Also Published As

Publication number Publication date
KR101962855B1 (en) 2019-03-27

Similar Documents

Publication Publication Date Title
KR101962855B1 (en) Apparatus and method for generating indoor map using duplication grid analysis
Filion et al. Robot calibration using a portable photogrammetry system
Pierlot et al. A new three object triangulation algorithm for mobile robot positioning
CN108896047B (en) Distributed sensor network collaborative fusion and sensor position correction method
JP6591131B1 (en) Structure measuring apparatus and structure measuring method
KR20160147127A (en) Method and apparatus for robust localization in outdoor environments
JP2012242967A (en) Map processing method, program and robot system
CN105245627A (en) IP positioning method based on network coordinate system
JP5728564B2 (en) Robot system and map updating method
CN105738915A (en) Three-dimensional radar measuring method and three-dimensional radar measuring device
Aini et al. A study of Monte Carlo localization on robot operating system
Font-Llagunes et al. Consistent triangulation for mobile robot localization using discontinuous angular measurements
KR101738751B1 (en) Method and apparatus for localization of mobile robot using indoor magnetic field
JP6289317B2 (en) Modeled data calculation method and modeled data calculation device
KR100883792B1 (en) System for Presuming Position of Moving Robot And Method Thereof
CN107263463B (en) Mechanism parameter correction method for robot arm system
CN105741260A (en) Action positioning device and positioning method thereof
US20160375583A1 (en) Apparatus and method for providing accuracy of robot location information by using sensor
KR20130074310A (en) Path generating method for autonomous mobile robot using uncertainty
CN113203424B (en) Multi-sensor data fusion method and device and related equipment
Blanco Derivation and implementation of a full 6d ekf-based solution to bearing-range slam
Kis et al. A simultaneous localization and mapping algorithm for sensors with low sampling rate and its application to autonomous mobile robots
Stanislav et al. Sensors data fusion via bayesian filter
JP2015144013A (en) robot system and map update method
Kawecki et al. Ar tags based absolute positioning system

Legal Events

Date Code Title Description
A201 Request for examination
E902 Notification of reason for refusal
E902 Notification of reason for refusal
E701 Decision to grant or registration of patent right
GRNT Written decision to grant