KR20230071937A - Apparatus and method for estimating coordinate of object - Google Patents
Apparatus and method for estimating coordinate of object Download PDFInfo
- Publication number
- KR20230071937A KR20230071937A KR1020210158058A KR20210158058A KR20230071937A KR 20230071937 A KR20230071937 A KR 20230071937A KR 1020210158058 A KR1020210158058 A KR 1020210158058A KR 20210158058 A KR20210158058 A KR 20210158058A KR 20230071937 A KR20230071937 A KR 20230071937A
- Authority
- KR
- South Korea
- Prior art keywords
- calculating
- object code
- code
- coordinates
- simultaneous equations
- Prior art date
- Legal status (The legal status 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 status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims description 12
- 230000009466 transformation Effects 0.000 claims abstract description 37
- 239000011159 matrix material Substances 0.000 claims abstract description 19
- 238000010586 diagram Methods 0.000 description 5
- 230000004807 localization Effects 0.000 description 3
- 239000000463 material Substances 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- 229910052751 metal Inorganic materials 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0234—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
- G06F17/12—Simultaneous equations, e.g. systems of linear equations
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06K—GRAPHICAL DATA READING; PRESENTATION OF DATA; RECORD CARRIERS; HANDLING RECORD CARRIERS
- G06K19/00—Record carriers for use with machines and with at least a part designed to carry digital markings
- G06K19/06—Record carriers for use with machines and with at least a part designed to carry digital markings characterised by the kind of the digital marking, e.g. shape, nature, code
- G06K19/06009—Record carriers for use with machines and with at least a part designed to carry digital markings characterised by the kind of the digital marking, e.g. shape, nature, code with optically detectable marking
- G06K19/06037—Record carriers for use with machines and with at least a part designed to carry digital markings characterised by the kind of the digital marking, e.g. shape, nature, code with optically detectable marking multi-dimensional coding
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/70—Determining position or orientation of objects or cameras
- G06T7/73—Determining position or orientation of objects or cameras using feature-based methods
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Mathematical Physics (AREA)
- Mathematical Analysis (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Optimization (AREA)
- Computational Mathematics (AREA)
- Data Mining & Analysis (AREA)
- Operations Research (AREA)
- Algebra (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Automation & Control Theory (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Electromagnetism (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
본 발명의 일 실시 예에 따른 객체 위치 추정 장치는 상이한 시점에 상응하는 복수의 영상을 입력 받는 입력부, 상기 영상 내 기준 코드 및 객체 코드에 상응하는 회전 변환 행렬 및 위치 변환 벡터를 산출하는 카메라 위치 추정부, 상기 회전 변환 행렬 및 상기 위치 변환 벡터에 따라 상기 객체 코드의 3차원 좌표를 산출하는 객체 위치 추정부 및 상기 객체 코드의 3차원 좌표를 포함하는 객체 위치 정보를 출력하는 출력부를 포함한다.An object position estimating apparatus according to an embodiment of the present invention includes an input unit that receives a plurality of images corresponding to different viewpoints, and a camera position calculator that calculates a rotation transformation matrix and a position transformation vector corresponding to reference codes and object codes in the images. and an object location estimator calculating 3D coordinates of the object code according to the government, the rotation transformation matrix, and the position transformation vector, and an output unit outputting object location information including the 3D coordinates of the object code.
Description
본 발명은 객체 위치 추정에 관한 것으로, 보다 상세하게는 객체 상QR코드를 이용한 객체 위치 추정에 관한 것이다. The present invention relates to object location estimation, and more particularly, to object location estimation using a QR code on an object.
무인항공기가 특정 임무를 수행하기 위해서는 자신의 위치를 명확하게 파악하는 위치추정(Localization) 필수적이다. 최근에는 무인항공기의 위치추정(Localization)을 위해서는 GPS, Milimetre Wave Rader, Stereo Vision Camera 등의 센서를 이용한다. 하지만, 상술한 센서는 성능이 좋을수록 고가이고 단일 사용이 힘들다는 단점이 있다. In order for an unmanned aerial vehicle to perform a specific mission, localization, which clearly identifies its location, is essential. Recently, sensors such as GPS, Milimetre Wave Rader, and Stereo Vision Camera are used for localization of unmanned aerial vehicles. However, the above-described sensor has a disadvantage that the higher the performance, the more expensive it is and the single use is difficult.
본 발명의 배경기술은 대한민국 등록특허 제10- 2026114 호에 개시되어 있다.The background art of the present invention is disclosed in Korean Patent Registration No. 10-2026114.
본 발명은 객체 상 QR 코드를 이용하여 객체의 위치를 추정하는 객체 위치 추정 장치 및 방법을 제공하는 것이다.An object of the present invention is to provide an object location estimating device and method for estimating the location of an object using a QR code on the object.
본 발명의 일 측면에 따르면, 객체 위치 추정 장치를 제공한다.According to one aspect of the present invention, an apparatus for estimating an object location is provided.
본 발명의 일 실시 예에 따른 객체 위치 추정 장치는 상이한 시점에 상응하는 복수의 영상을 입력 받는 입력부, 상기 영상 내 기준 코드 및 객체 코드에 상응하는 회전 변환 행렬 및 위치 변환 벡터를 산출하는 카메라 위치 추정부, 상기 회전 변환 행렬 및 상기 위치 변환 벡터에 따라 상기 객체 코드의 3차원 좌표를 산출하는 객체 위치 추정부 및 상기 객체 코드의 3차원 좌표를 포함하는 객체 위치 정보를 출력하는 출력부를 포함할 수 있다.An object position estimating apparatus according to an embodiment of the present invention includes an input unit that receives a plurality of images corresponding to different viewpoints, and a camera position calculator that calculates a rotation transformation matrix and a position transformation vector corresponding to reference codes and object codes in the images. An object location estimator calculating 3D coordinates of the object code according to the government, the rotation transformation matrix, and the position transformation vector, and an output unit outputting object location information including the 3D coordinates of the object code. .
본 발명의 다른 일 측면에 따르면, 객체 위치 추정 방법을 제공한다.According to another aspect of the present invention, a method for estimating an object location is provided.
본 발명의 일 실시 예에 따른 객체 위치를 추정하는 방법은 상이한 시점에 상응하는 복수의 영상을 입력 받는 단계; 상기 영상 내 기준 코드 및 객체 코드에 상응하는 회전 변환 행렬 및 위치 변환 벡터를 산출하는 단계; 상기 회전 변환 행렬 및 상기 위치 변환 벡터에 따라 상기 객체 코드의 3차원 좌표를 산출하는 단계; 및 상기 객체 코드의 3차원 좌표를 포함하는 객체 위치 정보를 출력하는 단계를 포함할 수 있다.A method for estimating an object position according to an embodiment of the present invention includes receiving a plurality of images corresponding to different viewpoints; Calculating a rotation transformation matrix and a position transformation vector corresponding to the reference code and object code in the image; calculating three-dimensional coordinates of the object code according to the rotation transformation matrix and the position transformation vector; and outputting object location information including 3D coordinates of the object code.
본 발명의 일 실시 예에 따르면, 비행장치에 장착된 카메라를 통해 촬영된 영상을 분석하여 객체의 3차원 위치를 정확하게 추정할 수 있다.According to one embodiment of the present invention, it is possible to accurately estimate the 3D position of an object by analyzing an image captured through a camera mounted on a flight device.
도 1은 본 발명의 일 실시 예에 따른 객체 위치 추정 장치를 예시한 블록도.
도 2는 본 발명의 일 실시 예에 따른 객체 위치 추정 장치가 입력 받는 두 시점의 영상이 촬영되는 상황을 예시한 도면.
도 3은 본 발명의 일 실시 예에 따른 객체 위치 추정 장치가 객체의 위치를 추정하는 방법을 예시한 순서도.
도 4는 본 발명의 일 실시 예에 따른 객체 위치 추정 장치가 입력 받은 2개의 시점에 상응하는 영상의 기준 코드와 물체 코드의 좌표를 예시한 도면.1 is a block diagram illustrating an object location estimating apparatus according to an embodiment of the present invention.
2 is a diagram illustrating a situation in which images of two viewpoints received by an apparatus for estimating an object location according to an embodiment of the present invention are captured;
3 is a flowchart illustrating a method of estimating the location of an object by an object location estimating apparatus according to an embodiment of the present invention;
4 is a diagram illustrating coordinates of a reference code and an object code of an image corresponding to two viewpoints received by an object location estimating apparatus according to an embodiment of the present invention;
본 발명은 다양한 변경을 가할 수 있고 여러 가지 실시 예를 가질 수 있는 바, 특정 실시 예들을 도면에 예시하고 이를 상세한 설명을 통해 상세히 설명하고자 한다. 그러나, 이는 본 발명을 특정한 실시 형태에 대해 한정하려는 것이 아니며, 본 발명의 사상 및 기술 범위에 포함되는 모든 변경, 균등물 내지 대체물을 포함하는 것으로 이해되어야 한다. 본 발명을 설명함에 있어서, 관련된 공지 기술에 대한 구체적인 설명이 본 발명의 요지를 불필요하게 흐릴 수 있다고 판단되는 경우 그 상세한 설명을 생략한다. 또한, 본 명세서 및 청구항에서 사용되는 단수 표현은, 달리 언급하지 않는 한 일반적으로 "하나 이상"을 의미하는 것으로 해석되어야 한다.Since the present invention can make various changes and have various embodiments, specific embodiments are illustrated in the drawings and will be described in detail through detailed description. However, this is not intended to limit the present invention to specific embodiments, and should be understood to include all modifications, equivalents, and substitutes included in the spirit and scope of the present invention. In describing the present invention, if it is determined that a detailed description of related known technologies may unnecessarily obscure the subject matter of the present invention, the detailed description will be omitted. Also, as used in this specification and claims, the terms "a" and "an" are generally to be construed to mean "one or more" unless stated otherwise.
이하, 본 발명의 바람직한 실시 예를 첨부도면을 참조하여 상세히 설명하기로 하며, 첨부 도면을 참조하여 설명함에 있어, 동일하거나 대응하는 구성 요소는 동일한 도면번호를 부여하고 이에 대한 중복되는 설명은 생략하기로 한다.Hereinafter, preferred embodiments of the present invention will be described in detail with reference to the accompanying drawings. do it with
도 1은 본 발명의 일 실시 예에 따른 객체 위치 추정 장치를 예시한 블록도이고, 도 2는 본 발명의 일 실시 예에 따른 객체 위치 추정 장치가 입력 받는 두 시점의 영상이 촬영되는 상황을 예시한 도면이다.1 is a block diagram illustrating an object location estimating device according to an embodiment of the present invention, and FIG. 2 illustrates a situation in which images of two viewpoints received by the object location estimating device according to an embodiment of the present invention are captured. it is a drawing
도 1을 참조하면, 본 발명의 일 실시 예에 따른 객체 위치 추정 장치(100)는 입력부(110), 카메라 위치 추정부(120), 객체 위치 추정부(130) 및 출력부(140)를 포함한다.Referring to FIG. 1 , an object
입력부(110)는 카메라로부터 객체를 촬영한 영상을 입력 받는다. 이 때, 카메라는 무인비행장치에 설치되어 객체를 촬영하는 카메라일 수 있다. 또한, 입력부(110)는 무인 비행장치가 이동함에 따라 다른 시점에서 객체를 촬영한 영상을 카메라로부터 각각 입력 받을 수 있다. 또한, 카메라는 기준 위치에 부착된 4개 이상의 QR 코드(이하, 기준 코드라 지칭) 및 객체에 부착된 QR 코드(이하, 객체 코드라 지칭)를 촬영한 영상을 생성할 수 있다. 이 때, 기준 코드는 현재 기준 코드의 3차원 위치를 나타내는 QR 코드일 수 있다. 입력부(110)는 영상을 카메라 위치 추정부(120)로 전송한다.The
카메라 위치 추정부(120)는 카메라의 고유 재원, 기준 코드의 3차원 좌표 및 영상 내 기준 코드의 평면 좌표에 solvePnP 알고리즘을 적용하여 회전 변환 행렬 R과 위치 변환 벡터 T를 산출한다. 카메라 위치 추정부(120)는 R과 T를 Rodrigues 회전 공식에 적용하여 카메라의 3차원 좌표를 산출할 수 있다. 카메라 위치 추정부(120)는 회전 변환 행렬 R과 위치 변환 벡터 및 카메라의 3차원 좌표를 포함하는 카메라 위치 정보를 생성한다. 예를 들어, 카메라 위치 추정부(120)는 하기의 수학식 1에 따라 카메라의 3차원 좌표를 생성할 수 있다.The
[수학식 1][Equation 1]
이 때, 는 카메라의 3차원 좌표를 나타낸다.At this time, represents the 3D coordinates of the camera.
카메라 위치 추정부(120)는 카메라 위치 정보를 객체 위치 추정부(130)로 전송한다.The
객체 위치 추정부(130)는 객체 코드의 영상 내 2차원 좌표, 카메라 위치 정보의 R, T 및 카메라의 재원을 활용해 객체 코드의 3차원 좌표를 추정한다. 예를 들어, 객체 위치 추정부(130)는 하기의 수학식 2와 같이 객체 코드의 영상 내 2차원 좌표, 카메라 위치 정보의 R, T 및 카메라의 재원을 활용해 객체 코드의 3차원 좌표의 관계에 따라 하기의 수학식 3과 같은 연립 방정식을 도출할 수 있다.The
[수학식 2][Equation 2]
이 때, (, )는 객체 코드의 영상 내 2차원 좌표이고, (X, Y, Z)는 객체 코드의 3차원 좌표이고, 은 카메라 재원, R 및 T를 고려한 변환 행렬이다.At this time, ( , ) is the two-dimensional coordinates in the image of the object code, (X, Y, Z) are the three-dimensional coordinates of the object code, is a transformation matrix considering camera resources, R and T.
[수학식 3][Equation 3]
객체 위치 추정부(130)는 수학식 3과 같이 한 시점에 촬영한 영상을 이용하여 2개의 연립 방정식을 도출할 수 있다. 객체 위치 추정부(130)는 도 2와 같이 카메라가 비행 장치를 통해 이동하여 둘 이상의 시점에서 촬영한 영상을 통해 4개 이상의 연립 방정식을 도출하고, 해당 연립 방정식을 통해 변수인 객체 코드의 3차원 좌표를 산출할 수 있다.The
이 때, 객체 위치 추정부(130)는 4개의 방정식((X, Y, Z)를 변수로 하는 방정식)과 거리의 합이 최소인 점의 좌표를 객체 코드의 3차원 좌표로 산출할 수 있다. 또는 객체 위치 추정부(130)는 3개 방정식의 해를 산출하고, 산출된 해 중 나머지 방정식과의 최소 오차를 갖는 해를 객체 코드의 3차원 좌표로 산출할 수 있다. 객체 위치 추정부(130)는 객체 코드의 3차원 좌표를 출력부(140)로 전송한다.At this time, the
출력부(140)는 객체 코드의 3차원 좌표를 포함하는 객체 위치 정보를 생성하여 외부로 출력한다.The
도 3은 본 발명의 일 실시 예에 따른 객체 위치 추정 장치가 객체의 위치를 추정하는 방법을 예시한 순서도이고, 도 4는 본 발명의 일 실시 예에 따른 객체 위치 추정 장치가 입력 받은 2개의 시점에 상응하는 영상의 기준 코드와 물체 코드의 좌표를 예시한 도면이다. 이하 설명하는 각 단계는 도 1을 참조하여 상술한 객체 위치 추정 장치를 구성하는 각 기능부가 수행하는 과정이나 발명의 간결하고 명확한 설명을 위해 각 단계의 주체를 위치 추정 장치로 통칭하도록 한다.3 is a flowchart illustrating a method for estimating the location of an object by an object location estimating device according to an embodiment of the present invention, and FIG. It is a diagram illustrating the coordinates of the reference code and the object code of the image corresponding to . In each step to be described below, the subject of each step is collectively referred to as a localization device for a concise and clear description of the process performed by each functional unit constituting the above-described object location estimating device with reference to FIG. 1 or the invention.
도 3을 참조하면, 단계 310에서 객체 위치 추정 장치는 카메라로부터 영상을 입력 받는다. 이 때, 카메라는 무인비행장치에 설치되어 객체를 촬영하는 카메라일 수 있다. 또한, 객체 위치 추정 장치는 무인 비행장치가 이동함에 따라 다른 시점에서 객체를 촬영한 영상을 카메라로부터 각각 입력 받을 수 있다.Referring to FIG. 3 , in
단계 320에서 객체 위치 추정 장치는 영상에서 기준 코드 및 객체 코드를 검출한다. 예를 들어, 객체 위치 추정 장치는 미리 설정된 알고리즘에 따라 영상 내에 존재하는 기준 코드 및 객체 코드의 영역을 모두 검출한다.In
단계 330에서 객체 위치 추정 장치는 검출한 기준 코드의 수가 4 이상이고, 객체 코드의 수가 1 이상인지 판단한다. In
단계 330에서 기준 코드의 수가 4 미만이거나 객체 코드의 수가 1 미만인 경우, 객체 위치 추정 장치는 현재 영상으로는 객체 위치 추정이 불가능한 상황으로 판단하고 객체 위치 추정 과정을 종료할 수 있다. 이 때, 객체 위치 추정 장치는 객체 위치 추정이 불가능하다는 메시지를 출력할 수 있다.In
단계 330에서 기준 코드의 수가 4 이상이고, 객체 코드의 수가 1 이상인 경우, 단계 340에서 객체 위치 추정 장치는 기준 코드 및 객체 코드의 영상 내 2차원 좌표를 획득하고, 기준 코드에서 표현하는 3차원 좌표를 획득할 수 있다. In
단계 350에서 객체 위치 추정 장치는 현재 카메라 위치에 따른 회전 변환 행렬 및 위치 변환 벡터를 산출한다. 예를 들어, 객체 위치 추정 장치는 카메라의 고유 재원, 기준 코드의 3차원 좌표 및 영상 내 기준 코드의 평면 좌표에 solvePnP 알고리즘을 적용하여 회전 변환 행렬 R과 위치 변환 벡터 T를 상술한 수학식 1에 따라 산출할 수 있다.In
단계 360에서 객체 위치 추정 장치는 회전 변환 행렬 및 위치 변환 벡터에 따라 연립 방정식을 산출한다. 예를 들어, 객체 위치 추정 장치는 객체 코드의 영상 내 2차원 좌표, 카메라 위치 정보의 R, T 및 카메라의 재원을 활용해 객체 코드의 3차원 좌표의 관계에 따라 상술한 수학식 3과 연립 방정식을 도출할 수 있다. 또한, 객체 위치 추정 장치는 단계 310 내지 단계 360의 과정을 2회 이상 반복 수행하여 상이한 시점의 복수 영상에 따라 4개 이상(한 시점의 영상에서 각각 2개의 연립 방정식 도출)의 연립 방정식을 도출할 수 있다. 즉, 객체 위치 추정 장치는 도 4와 같이 시점 1 및 시점 2에서 촬영한 영상에 따른 각각의 기준 코드 및 물체 코드에 따라 연립 방정식을 각각 2개씩 도출하여 총 4개의 연립 방정식을 도출할 수 있다.In
단계 370에서 객체 위치 추정 장치는 객체 코드의 3차원 좌표를 산출한다. 본 발명의 일 실시 예에 따른 객체 위치 추정 장치는 4개의 방정식과 거리의 합이 최소인 점의 좌표를 객체 코드의 3차원 좌표로 산출할 수 있다. 객체 위치 추정 장치는 3차원 좌표를 포함하는 객체 위치 정보를 생성할 수 있다. 본 발명의 다른 실시 예에 따른 객체 위치 추정 장치는 3개 방정식의 해를 산출하고, 산출된 해 중 나머지 방정식과의 최소 오차를 갖는 해를 객체 코드의 3차원 좌표로 산출할 수 있다.In
따라서, 본 발명의 일 실시 예에 따른 객체 위치 추정 장치 및 방법은 이동 가능한 무인 비행 장치에 설치된 카메라를 통해 촬영된 영상을 통해 객체의 위치를 정확히 추정할 수 있다. 이에 따라 물류 시스템 등에서 객체 코드가 부착된 각종 객체의 위치를 드론 등의 무인 비행 장치를 통해 용이하게 파악할 수 있다.Therefore, the object position estimation apparatus and method according to an embodiment of the present invention can accurately estimate the position of an object through an image captured by a camera installed in a movable unmanned flying device. Accordingly, the location of various objects to which the object code is attached can be easily grasped through an unmanned flying device such as a drone in a distribution system or the like.
본 발명의 실시 예에 따른 객체 위치 추정 방법은 다양한 컴퓨터 수단을 통하여 수행될 수 있는 프로그램 명령 형태로 구현되어 컴퓨터 판독 가능 매체에 기록될 수 있다. 컴퓨터 판독 가능 매체는 프로그램 명령, 데이터 파일, 데이터 구조 등을 단독으로 또는 조합하여 포함할 수 있다. 컴퓨터 판독 가능 매체에 기록되는 프로그램 명령은 본 발명을 위하여 특별히 설계되고 구성된 것들이거나 컴퓨터 소프트웨어 분야 당업자에게 공지되어 사용 가능한 것일 수도 있다. 컴퓨터 판독 가능 기록 매체의 예에는 하드 디스크, 플로피 디스크 및 자기 테이프와 같은 자기 매체(magnetic media), CD-ROM, DVD와 같은 광 기록 매체(optical media), 플롭티컬 디스크(floptical disk)와 같은 자기-광 매체(magneto-optical media) 및 롬(ROM), 램(RAM), 플래시 메모리 등과 같은 프로그램 명령을 저장하고 수행하도록 특별히 구성된 하드웨어 장치가 포함된다. 또한 상술한 매체는 프로그램 명령, 데이터 구조 등을 지정하는 신호를 전송하는 반송파를 포함하는 광 또는 금속선, 도파관 등의 전송 매체일 수도 있다. 프로그램 명령의 예에는 컴파일러에 의해 만들어지는 것과 같은 기계어 코드뿐만 아니라 인터프리터 등을 사용해서 컴퓨터에 의해서 실행될 수 있는 고급 언어 코드를 포함한다. 상술한 하드웨어 장치는 본 발명의 동작을 수행하기 위해 하나 이상의 소프트웨어 모듈로서 작동하도록 구성될 수 있으며, 그 역도 마찬가지이다.The method for estimating the location of an object according to an embodiment of the present invention may be implemented in the form of program instructions that can be executed by various computer means and recorded in a computer readable medium. Computer readable media may include program instructions, data files, data structures, etc. alone or in combination. Program instructions recorded on a computer readable medium may be specially designed and configured for the present invention or may be known and usable to those skilled in the art of computer software. Examples of computer-readable recording media include magnetic media such as hard disks, floppy disks and magnetic tapes, optical media such as CD-ROMs and DVDs, and magnetic media such as floptical disks. - Includes hardware devices specially configured to store and execute program instructions, such as magneto-optical media and ROM, RAM, flash memory, etc. In addition, the above-described medium may be a transmission medium such as light including a carrier wave for transmitting a signal designating a program command, data structure, or the like, or a metal wire or a waveguide. Examples of program instructions include high-level language codes that can be executed by a computer using an interpreter, as well as machine language codes such as those produced by a compiler. The hardware device described above may be configured to operate as one or more software modules to perform the operations of the present invention, and vice versa.
이제까지 본 발명에 대하여 그 실시 예들을 중심으로 살펴보았다. 본 발명이 속하는 기술 분야에서 통상의 지식을 가진 자는 본 발명이 본 발명의 본질적인 특성에서 벗어나지 않는 범위에서 변형된 형태로 구현될 수 있음을 이해할 수 있을 것이다. 그러므로 개시된 실시 예들은 한정적인 관점이 아니라 설명적인 관점에서 고려되어야 한다. 본 발명의 범위는 전술한 설명이 아니라 특허청구범위에 나타나 있으며, 그와 동등한 범위 내에 있는 모든 차이점은 본 발명에 포함된 것으로 해석되어야 할 것이다.So far, the present invention has been looked at mainly by its embodiments. Those skilled in the art to which the present invention pertains will be able to understand that the present invention can be implemented in a modified form without departing from the essential characteristics of the present invention. Therefore, the disclosed embodiments should be considered from a descriptive point of view rather than a limiting point of view. The scope of the present invention is shown in the claims rather than the foregoing description, and all differences within the equivalent scope will be construed as being included in the present invention.
Claims (8)
상기 영상 내 기준 코드 및 객체 코드에 상응하는 회전 변환 행렬 및 위치 변환 벡터를 산출하는 카메라 위치 추정부;
상기 회전 변환 행렬 및 상기 위치 변환 벡터에 따라 상기 객체 코드의 3차원 좌표를 산출하는 객체 위치 추정부; 및
상기 객체 코드의 3차원 좌표를 포함하는 객체 위치 정보를 출력하는 출력부를 포함하는 객체 위치 추정 장치.
an input unit for receiving a plurality of images corresponding to different viewpoints;
a camera position estimator calculating a rotation transformation matrix and a position transformation vector corresponding to the reference code and object code in the image;
an object position estimator calculating 3-dimensional coordinates of the object code according to the rotation transformation matrix and the position transformation vector; and
and an output unit outputting object location information including 3-dimensional coordinates of the object code.
상기 객체 위치 추정부는 상기 회전 변환 행렬 및 상기 위치 변환 벡터에 상응하는 연립 방정식을 산출하고,
상기 연립 방정식을 통해 상기 객체 코드의 3차원 좌표를 산출하는 것을 특징으로 하는 객체 위치 추정 장치.
According to claim 1,
The object position estimation unit calculates simultaneous equations corresponding to the rotation transformation matrix and the position transformation vector,
The object location estimating device, characterized in that for calculating the three-dimensional coordinates of the object code through the simultaneous equations.
상기 객체 위치 추정부는,
4개의 상기 연립 방정식과 거리의 합이 최소인 점의 좌표를 상기 객체 코드의 3차원 좌표로 산출하는 것을 특징으로 하는 객체 위치 추정 장치.
According to claim 2,
The object location estimation unit,
The object location estimation device, characterized in that for calculating the coordinates of the point where the sum of the four simultaneous equations and the distance is minimum as the three-dimensional coordinates of the object code.
상기 객체 위치 추정부는,
3개 상기 연립 방정식의 해를 산출하고, 산출된 상기 해 중 나머지 연립 방정식과의 최소 오차를 갖는 해를 상기 객체 코드의 3차원 좌표로 산출하는 것을 특징으로 하는 객체 위치 추정 장치.
According to claim 2,
The object location estimation unit,
An object location estimating device, characterized in that for calculating solutions of the three simultaneous equations, and calculating a solution having a minimum error with the other simultaneous equations among the calculated solutions as three-dimensional coordinates of the object code.
상이한 시점에 상응하는 복수의 영상을 입력 받는 단계;
상기 영상 내 기준 코드 및 객체 코드에 상응하는 회전 변환 행렬 및 위치 변환 벡터를 산출하는 단계;
상기 회전 변환 행렬 및 상기 위치 변환 벡터에 따라 상기 객체 코드의 3차원 좌표를 산출하는 단계; 및
상기 객체 코드의 3차원 좌표를 포함하는 객체 위치 정보를 출력하는 단계를 포함하는 객체 위치 추정 방법.
A method for estimating the location of an object by an object location estimating device,
receiving a plurality of images corresponding to different viewpoints;
Calculating a rotation transformation matrix and a position transformation vector corresponding to the reference code and object code in the image;
calculating three-dimensional coordinates of the object code according to the rotation transformation matrix and the position transformation vector; and
and outputting object location information including the 3D coordinates of the object code.
상기 회전 변환 행렬 및 상기 위치 변환 벡터에 따라 상기 객체 코드의 3차원 좌표를 산출하는 단계는,
상기 객체 위치 추정부는 상기 회전 변환 행렬 및 상기 위치 변환 벡터에 상응하는 연립 방정식을 산출하는 단계; 및
상기 연립 방정식을 통해 상기 객체 코드의 3차원 좌표를 산출하는 단계를 포함하는 것을 특징으로 하는 객체 위치 추정 방법.
According to claim 5,
Calculating the three-dimensional coordinates of the object code according to the rotation transformation matrix and the position transformation vector,
calculating, by the object position estimation unit, simultaneous equations corresponding to the rotation transformation matrix and the position transformation vector; and
and calculating three-dimensional coordinates of the object code through the simultaneous equations.
상기 연립 방정식을 통해 상기 객체 코드의 3차원 좌표를 산출하는 단계는,
4개의 상기 연립 방정식과 거리의 합이 최소인 점의 좌표를 상기 객체 코드의 3차원 좌표로 산출하는 단계인 것을 특징으로 하는 객체 위치 추정 방법.
According to claim 6,
Calculating the three-dimensional coordinates of the object code through the simultaneous equations,
and calculating the coordinates of a point where the sum of the four simultaneous equations and distances is minimum as the three-dimensional coordinates of the object code.
상기 연립 방정식을 통해 상기 객체 코드의 3차원 좌표를 산출하는 단계는,
3개 상기 연립 방정식의 해를 산출하고, 산출된 상기 해 중 나머지 연립 방정식과의 최소 오차를 갖는 해를 상기 객체 코드의 3차원 좌표로 산출하는 단계인 것을 특징으로 하는 객체 위치 추정 방법.
According to claim 6,
Calculating the three-dimensional coordinates of the object code through the simultaneous equations,
Calculating solutions of the three simultaneous equations, and calculating a solution having a minimum error with the other simultaneous equations among the calculated solutions as three-dimensional coordinates of the object code.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020210158058A KR102659185B1 (en) | 2021-11-16 | 2021-11-16 | Apparatus and method for estimating coordinate of object |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020210158058A KR102659185B1 (en) | 2021-11-16 | 2021-11-16 | Apparatus and method for estimating coordinate of object |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20230071937A true KR20230071937A (en) | 2023-05-24 |
KR102659185B1 KR102659185B1 (en) | 2024-04-18 |
Family
ID=86540713
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020210158058A Active KR102659185B1 (en) | 2021-11-16 | 2021-11-16 | Apparatus and method for estimating coordinate of object |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR102659185B1 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102717652B1 (en) * | 2024-08-05 | 2024-10-16 | 주식회사 아디아랩 | Monitoring system and method for detecting and monitoring personnel in hazardous areas of industrial sites |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2013217893A (en) * | 2012-03-13 | 2013-10-24 | Canon Inc | Model generation device, position posture estimation device, information processor, model generation method, position posture estimation method, information processing method |
JP2019185689A (en) * | 2018-04-17 | 2019-10-24 | 株式会社ロックガレッジ | System for specifying detection object position |
JP2021047475A (en) * | 2019-09-17 | 2021-03-25 | 日本電気通信システム株式会社 | Object position management device, objects, object position management system, object position management method and program |
-
2021
- 2021-11-16 KR KR1020210158058A patent/KR102659185B1/en active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2013217893A (en) * | 2012-03-13 | 2013-10-24 | Canon Inc | Model generation device, position posture estimation device, information processor, model generation method, position posture estimation method, information processing method |
JP2019185689A (en) * | 2018-04-17 | 2019-10-24 | 株式会社ロックガレッジ | System for specifying detection object position |
JP2021047475A (en) * | 2019-09-17 | 2021-03-25 | 日本電気通信システム株式会社 | Object position management device, objects, object position management system, object position management method and program |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102717652B1 (en) * | 2024-08-05 | 2024-10-16 | 주식회사 아디아랩 | Monitoring system and method for detecting and monitoring personnel in hazardous areas of industrial sites |
Also Published As
Publication number | Publication date |
---|---|
KR102659185B1 (en) | 2024-04-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5926228B2 (en) | Depth detection method and system for autonomous vehicles | |
CN108450034B (en) | Vehicle positioning system and method based on images | |
KR101725060B1 (en) | Apparatus for recognizing location mobile robot using key point based on gradient and method thereof | |
KR101776621B1 (en) | Apparatus for recognizing location mobile robot using edge based refinement and method thereof | |
JP6804991B2 (en) | Information processing equipment, information processing methods, and information processing programs | |
US9361696B2 (en) | Method of determining a ground plane on the basis of a depth image | |
US20220277480A1 (en) | Position estimation device, vehicle, position estimation method and position estimation program | |
CN112997187A (en) | Two-dimensional object bounding box information estimation based on aerial view point cloud | |
KR101776620B1 (en) | Apparatus for recognizing location mobile robot using search based correlative matching and method thereof | |
JP6407010B2 (en) | Method for analyzing related images, image processing system, vehicle comprising the system, and computer program product | |
KR20180050823A (en) | Generating method and apparatus of 3d lane model | |
CN104732196B (en) | Vehicle checking method and system | |
US9311757B2 (en) | Movement distance estimating device and movement distance estimating method | |
JP6712775B2 (en) | Road surface estimation device, vehicle control device, road surface estimation method, and program | |
JP2014222429A (en) | Image processor, distance measuring device, mobile object apparatus control system, mobile object, and program for image processing | |
KR101076406B1 (en) | Apparatus and Method for Extracting Location and velocity of Obstacle | |
WO2019244668A1 (en) | Moving body and control method for moving body | |
EP3249629A2 (en) | Information processing device, information processing method and vehicle | |
JP7179687B2 (en) | Obstacle detector | |
CN112240767A (en) | Vehicle location identification | |
KR20220027359A (en) | Method for adjusting grid interval of height map for autonomous driving | |
KR102659185B1 (en) | Apparatus and method for estimating coordinate of object | |
JP6543935B2 (en) | PARALLEL VALUE DERIVING DEVICE, DEVICE CONTROL SYSTEM, MOBILE OBJECT, ROBOT, PARALLEL VALUE DERIVING METHOD, AND PROGRAM | |
CN113470342B (en) | Method and device for estimating self-movement | |
KR20220084910A (en) | Method of estimating the location of a moving object using vector map |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PA0109 | Patent application |
Patent event code: PA01091R01D Comment text: Patent Application Patent event date: 20211116 |
|
PA0201 | Request for examination | ||
PG1501 | Laying open of application | ||
E902 | Notification of reason for refusal | ||
PE0902 | Notice of grounds for rejection |
Comment text: Notification of reason for refusal Patent event date: 20230829 Patent event code: PE09021S01D |
|
E701 | Decision to grant or registration of patent right | ||
PE0701 | Decision of registration |
Patent event code: PE07011S01D Comment text: Decision to Grant Registration Patent event date: 20240412 |
|
GRNT | Written decision to grant | ||
PR0701 | Registration of establishment |
Comment text: Registration of Establishment Patent event date: 20240416 Patent event code: PR07011E01D |
|
PR1002 | Payment of registration fee |
Payment date: 20240416 End annual number: 3 Start annual number: 1 |
|
PG1601 | Publication of registration |