KR20180111101A - 기압계와 flaoa를 이용한 위치 추정 장치 및 방법 - Google Patents

기압계와 flaoa를 이용한 위치 추정 장치 및 방법 Download PDF

Info

Publication number
KR20180111101A
KR20180111101A KR1020170041551A KR20170041551A KR20180111101A KR 20180111101 A KR20180111101 A KR 20180111101A KR 1020170041551 A KR1020170041551 A KR 1020170041551A KR 20170041551 A KR20170041551 A KR 20170041551A KR 20180111101 A KR20180111101 A KR 20180111101A
Authority
KR
South Korea
Prior art keywords
mobile terminal
estimating
barometer
variables
height
Prior art date
Application number
KR1020170041551A
Other languages
English (en)
Other versions
KR102020801B1 (ko
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 KR1020170041551A priority Critical patent/KR102020801B1/ko
Publication of KR20180111101A publication Critical patent/KR20180111101A/ko
Application granted granted Critical
Publication of KR102020801B1 publication Critical patent/KR102020801B1/ko

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/0009—Transmission of position information to remote stations
    • G01S5/0045—Transmission from base station to mobile station
    • G01S5/0063—Transmission from base station to mobile station of measured values, i.e. measurement on base station and position calculation on mobile
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S3/00—Direction-finders for determining the direction from which infrasonic, sonic, ultrasonic, or electromagnetic waves, or particle emission, not having a directional significance, are being received
    • G01S3/02—Direction-finders for determining the direction from which infrasonic, sonic, ultrasonic, or electromagnetic waves, or particle emission, not having a directional significance, are being received using radio waves
    • G01S3/14—Systems for determining direction or deviation from predetermined direction
    • G01S3/46—Systems for determining direction or deviation from predetermined direction using antennas spaced apart and measuring phase or time difference between signals therefrom, i.e. path-difference systems
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/0205—Details
    • G01S5/0236—Assistance data, e.g. base station almanac
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04W—WIRELESS COMMUNICATION NETWORKS
    • H04W64/00—Locating users or terminals or network equipment for network management purposes, e.g. mobility management
    • H04W64/006—Locating users or terminals or network equipment for network management purposes, e.g. mobility management with additional information processing, e.g. for direction or speed determination

Abstract

본 발명에 의한 위치 추정 장치는, 다수의 AP와 이동 단말을 포함하는 기압계와 FLAOA를 이용한 위치 추정 장치로서, 기압계를 이용하여 이동 단말의 높이에 관한 1개의 변수를 추정한 후, AP로부터 수신되는 신호의 수신 방향 측정치를 이용하여 이동 단말의 방향에 관한 3개의 변수와 이동 단말의 위치에 관한 2개의 변수를 추정하는 것을 특징으로 한다.

Description

기압계와 FLAOA를 이용한 위치 추정 장치 및 방법{APPARATUS AND METHOD FOR ESTIMATING POSITION USING BAROMETOR AND FLAOA}
본 발명은 FLAOA를 이용한 위치 장치 및 방법에 관한 것으로, 더욱 상세하게는, 이동 단말의 위치와 방향에 관한 6개의 변수를 추정하는, FLAOA를 이용한 위치 장치 및 방법에 관한 것이다.
실외에서의 위치 추정을 위해서는 현재 GPS장치가 많이 이용되고 있으나, 실내에서는 GPS장치를 사용하기에 적당하지 않으므로, 실내에서 사용할 수 있는 다양한 위치 추정 장치 및 방법이 제안되고 있다.
특허문헌 1에 기재된 위치 추장장치 및 방법은 그 예이다.
특허문헌 1에는, 순방향 링크(forward link) AOA(angle of arrival)을 이용한 위치 추정 장치 및 방법이 기재되어 있다.
만일 FLAOA(순방향 링크 AOA)를 이용하여 이동 단말의 위치 뿐 아니라 방향까지 구할 수 있다면, 로봇의 제어 등에 매우 유용하게 사용할 수 있다.
2차원 평면에서는, FLAOA(순방향 링크 AOA)를 이용하여, 다음과 같은 과정을 이용하여 이동단말의 위치와 방향을 알 수 있다.
도 1은 3개의 AP와 이동 단말의 위치관계를 표시한 도면이다.
도 1과 같이, AP1, AP2, AP3, 이동 단말의 위치를 각각 (x1 , y1), (x2 , y2), (x3 , y3), (xu , yu )라 하고, 이동 단말로부터 AP1, AP2, AP3를 향하는 방향의 각도를 각각 ψ1, ψ2, ψ3 라 하고, 이동 단말이 향하는 방향의 각도를 ψ u 라 하고, 이동 단말이 AP1, AP2, AP3로부터 오는 신호를 수신한 방향의 각도를 측정한 값을 φ1, φ2, φ3 이라 하면,
측정값 φ1, φ2, φ3 으로부터 다음의 과정을 거쳐서 xu , yu , ψu 를 구할 수 있다.
그 과정을 자세히 설명하면,
Figure pat00001
이므로, 위의 식에 다음 식을 대입하면
Figure pat00002
다음의 식이 되고
Figure pat00003
위의 식을 다시 정리하면 다음의 수식 (1) 과 같다. (단, ψu = αu )
Figure pat00004
-------(1)
여기에 r = tan αu 을 대입하면, 다음과 같은 수식 (2) 가 된다.
Figure pat00005
----(2)
위의 식에서 p = xu + yu r 및 q = xu r - yu 로 치환하면, 다음의 수식 (3) 이 된다.
Figure pat00006
----(3)
위의 식에 관한 n개의 측정치를 행렬로 정리하면 다음의 수식 (4) 와 같다.
Figure pat00007
----(4)
위의 식으로부터 r, p, q 의 값을 구할 수 있고, r, p, q 의 값을 알면 다음의 수식 (5) 에 의해 xu , yu , ψu (단, ψu = αu )를 구할 수 있다.
Figure pat00008
,
Figure pat00009
,
Figure pat00010
----(5)
위와 같이, 2차원에서는, FLAOA 측정값 φ1, φ2, φ3 으로부터 이동 단말의 좌표 xu , yu 와 이동 단말의 방향 ψu 를 구할 수 있으나, 3차원에서는 다르다.
3차원에서는 이동 단말의 위치와 방향에 관한 변수가 6개(이동 단말의 위치에 관한 변수 3개, 이동 단말의 방향에 관한 변수 3개)가 존재한다. 그리고 하나의 이동 단말에서 하나의 AP로 향하는 방향을 측정하면, 도 2와 같이, 2개의 측정값 θ1, θ2 이 측정된다. 도 2는 3개의 안테나를 갖는 이동 단말과 AP의 위치관계를 표시한 도면이다.
(이때, 안테나 1에서 안테나 2와 안테나 3으로 향하는 각도가 수직을 이루면, 방위각 α, 앙각 β는 수식 cosθ1 = cosβ cosα , cosθ2 = cosβ sinα 의 수식에 의해 구해질 수 있다.)
따라서 이론적으로는 3개 이상의 AP를 향하는 방향에 대한 측정값을 구하면 6개 이상의 수식이 나오므로, 6개의 변수값을 구하는 것이 가능하다.
그러나 실제로 3개 이상의 AP를 향하는 방향에 대한 측정값으로부터 6개의 변수값을 구하려 하면, 수식이 너무 복잡하여, 6개의 변수값을 구할 수가 없다. 즉, 종래의 기술로는 FLAOA측정값을 이용하여 이동 단말의 위치와 방향에 관한 6개의 변수값을 구할 수 없다.
따라서, 3차원에서 다수의 AP를 향하는 방향에 대한 측정값으로부터 이동 단말의 위치 및 방향에 관한 6개의 변수값을 구하는 수단이 필요하다.
특허문헌 1: 한국 공개특허공보 KR 10-2008-0078576 A (공개일자: 2008. 08. 27.)
본 발명의 목적은, 다수의 AP로부터의 FLAOA 측정값을 이용해 이동 단말의 위치와 방향을 구함에 있어서, 저가의 센서를 이용하여 용이하게 이동 단말의 위치와 방향을 구할 수 있도록 하는 것이다.
본 발명에 의한 위치 추정 장치는, 다수의 AP와 이동 단말을 포함하는 기압계와 FLAOA를 이용한 위치 추정 장치로서, 상기 이동 단말은 3개 이상의 안테나를 포함하여 상기 AP로부터 수신되는 신호의 수신 방향을 측정할 수 있고, 상기 이동 단말은 기압계를 이용하여 이동 단말의 높이를 추정할 수 있으며, 상기 이동 단말의 위치와 방향을 추정할 때, 상기 기압계 측정치를 이용하여 이동 단말의 높이를 추정한 후, AP로부터 수신되는 신호의 수신 방향 측정치를 이용하여 이동 단말의 위치에 관한 나머지 2개의 변수와 이동 단말의 방향에 관한 3개의 변수를 추정하는 것을 특징으로 한다.
상기 위치 추정 장치에서, 상기 이동 단말은 AP까지의 거리를 측정할 수 있고, 중력센서를 이용하여 이동 단말의 방향에 대한 2개의 변수를 추정할 수 있고, 상기 이동 단말의 위치에 관한 2개의 변수와 방향에 관한 3개의 변수를 추정할 때, 상기 기압계 측정치를 이용하여 이동 단말의 높이를 추정한 후, AP까지의 거리 측정치를 이용하여 이동 단말의 위치에 관한 나머지 2개의 변수를 추정하고, 중력센서를 이용하여 이동 단말의 방향에 관한 2개의 변수를 추정하고, AP로부터 수신되는 신호의 수신 방향 측정치를 이용하여 이동 단말의 방향에 관한 나머지 1개의 변수를 추정할 수 있다.
상기 위치 추정 장치에서, 상기 이동 단말은 중력센서를 이용하여 이동 단말의 방향에 대한 2개의 변수를 추정할 수 있고, 상기 이동 단말의 위치에 관한 2개의 변수와 방향에 관한 3개의 변수를 추정할 때, 상기 기압계 측정치를 이용하여 이동 단말의 높이를 추정한 후, 중력센서를 이용하여 이동 단말의 방향에 관한 2개의 변수를 추정하고, 이동 단말에서 AP까지의 거리를 추정한 결과를 이용하여 이동 단말의 방향에 관한 나머지 1개의 변수를 추정하고, 이동 단말의 위치에 관한 나머지 2개의 변수를 추정할 수 있다.
본 발명에 의한 위치 추정 방법은, 다수의 AP와 이동 단말을 포함하는 위치 추정 장치를 이용하는 위치 추정 방법으로서, 상기 이동 단말은 3개 이상의 안테나를 포함하여 상기 AP로부터 수신되는 신호의 수신 방향을 측정할 수 있고, 상기 이동 단말은 기압계를 이용하여 높이를 추정할 수 있고, 기압계를 이용하여 이동 단말의 높이에 관한 1개의 변수를 추정하는 제1 단계; AP로부터 수신되는 신호의 수신 방향 측정치를 이용하여 이동 단말의 방향에 관한 3개의 변수와 이동 단말의 위치에 관한 2개의 변수를 추정하는 제2 단계;를 포함하는 것을 특징으로 한다.
상기 위치 추정 방법에서, 상기 제2 단계는, TOA 측정치를 이용하여 이동 단말의 위치에 관한 나머지 2개의 변수를 추정하는 제2-1단계; 중력센서를 이용하여 이동 단말의 방향에 관한 2개의 변수를 추정하는 제2-2 단계; AP로부터 수신되는 신호의 수신 방향 측정치를 이용하여 이동 단말의 방향에 관한 나머지 1개의 변수를 추정하는 제2-3 단계;를 포함할 수 있다.
상기 위치 추정 방법에서, 상기 제2 단계는, 중력센서를 이용하여 이동 단말의 방향에 관한 2개의 변수를 추정하는 제2-1 단계: 이동 단말의 높이 및 이동 단말의 방향에 관한 2개의 변수, 이동 단말이 측정한 AP로부터의 신호 수신 방향 측정치를 이용하여 이동 단말에서 AP까지의 거리를 추정하는 제2-2 단계: 상기 추정결과를 이용하여 이동 단말의 방향에 관한 나머지 1개의 변수를 추정하는 제2-3 단계; 이동 단말의 위치에 관한 나머지 2개의 변수를 추정하는 제2-4단계; 를 포함할 수 있다.
본 발명은, 다수의 AP로부의 FLAOA 측정값을 이용해 이동 단말의 위치와 방향을 구함에 있어서, 저가의 센서를 이용하여 용이하게 이동 단말의 위치와 방향을 구할 수 있도록 한다.
도 1은 3개의 AP와 이동 단말의 위치관계를 표시한 도면
도 2는 3개의 안테나를 갖는 이동 단말과 AP의 위치관계를 표시한 도면
도 3은 본 발명에 의한 위치 추정 장치의 개념도의 예
도 4는 롤각, 피치각, 요각의 방향을 표시한 도면
도 5는 네비게이션 프레임과 바디 프레임의 관계를 표시한 도면
본 발명은 다양한 변경을 가할 수 있고 여러 가지 실시예를 가질 수 있는 바, 특정 실시예들을 도면에 예시하고 상세한 설명에 상세하게 설명하고자 한다. 그러나 이는 본 발명을 특정한 실시 형태에 대해 한정하려는 것이 아니며, 본 발명의 사상 및 기술 범위에 포함되는 모든 변환, 균등물 내지 대체물을 포함하는 것으로 이해되어야 한다. 본 발명을 설명함에 있어서 관련된 공지 기술에 대한 구체적인 설명이 본 발명의 요지를 흐릴 수 있다고 판단되는 경우 그 상세한 설명을 생략한다.
본 출원에서 사용한 용어는 단지 특정한 실시예를 설명하기 위해 사용된 것으로, 본 발명을 한정하려는 의도가 아니다. 단수의 표현은 문맥상 명백하게 다르게 뜻하지 않는 한, 복수의 표현을 포함한다.
아래에서는 본 발명을 첨부된 도면을 통해 더욱 상세히 설명한다.
본 발명은 측정값(이동 단말에서 AP 를 향하는 방향, 중력이 작용하는 방향 등)으로부터 이동 단말의 위치와 자세를 추정하기 위한 것이다.
도 3은 본 발명에 의한 위치 추정 장치의 개념도의 예이다.
도 3의 위치 추정 장치는 다수의 AP(100)와 이동 단말(200)을 포함한다.
이동 단말(200)은 제어부(210), 안테나(220), TOA 측정부(230), AOA 측정부(240), 중력센서(250), 기압계(260)을 포함한다.
제어부(210)는 이동 단말(210)의 모든 동작을 제어하는 장치이다.
안테나(220)는 다수의 AP(100)로부터 오는 신호를 수신하기 위한 것이다.
TOA 측정부(230)는 안테나(220)로 수신된 신호를 이용하여 TOA값을 측정하는 장치이다.
AOA 측정부(240)는 안테나(220)로 수신된 신호를 이용하여 AOA값을 측정하는 장치이다.
중력센서(250)는 중력의 방향을 측정하는 센서로서, 이동 단말(200)에 설치된 중력센서의 측정값을 이용하여 이동 단말의 기울기를 측정할 수 있다. 이동 단말이 기울어진 각은 롤(roll)각 및 피치(pitch)각으로 표시할 수 있다.
기압계(260)은 대기압을 측정하는 센서이다. 높이가 높아질수록 대기압이 높아지므로, 대기압을 알면 높이를 추정할 수 있다.
예를 들어, 표준대기에서 지표면에서 기압이 1013 mb 라면, 100 m 높이에서는 기압이 1000 mb 정도가 된다. 따라서 0.13 mb 만큼 기압이 높아지면 1 m 정도 높이가 낮아졌고, 0.013 mb 만큼 기압이 높아지면 10 cm 정도 높이가 낮아진 것으로 추정할 수 있다.
그러나 특정 위치의 기압은 시간에 따라 조금씩 변하므로, 이동 단말에서의 기압측정값으로부터 이동 단말의 정확한 높이를 알 수는 없다. 따라서 이동 단말의 근처에 있고 높이를 아는 다른 측정 장치에서 기압을 측정하고 비교하여야 이동 단말의 높이를 정확히 추정할 수 있다. 만일 AP에 기압계를 설치한다면, AP 의 높이를 미리 알고 있고, AP 의 다른 하드웨어를 이용할 수 있으므로 좀 더 효율적이다. 예를 들면, AP 의 기압계에서 측정한 기압 측정값을 이동 단말이나 서버 등으로 전송할 때 AP 의 통신 기능을 이용할 수 있으므로, 별도로 통신부를 설치할 필요가 없는 장점이 있다.
이동 단말에서 AP 까지의 거리를 측정하기 위해 TOA 를 이용하는 방법, 이동 단말에서 AP 를 향하는 방향을 측정하기 위해 AOA 를 이용하는 방법 등은 이미 공지되어 있으므로, 자세한 설명은 생략한다.
도 4는 롤각, 피치각, 요각의 방향을 표시한 도면이고, 도 5는 네비게이션 프레임과 바디 프레임의 관계를 표시한 도면이다.
이동 단말이 있을 때, 이동 단말이 향하는 방향은 도 4과 같이 표시하는 것이 일반적이다. 즉 롤(roll)각, 피치(pitch)각, 요(yaw)각을 이용하여 이동 단말이 향하는 방향을 표시할 수 있다. 도 4에서는 이동 단말의 모양을 비행기로 표시하였으나, 롤(roll)각, 피치(pitch)각, 요(yaw)각을 표시할 때 물체의 모양을 비행기로 표시하는 것이 일반적이기 때문에 비행기로 표시한 것이고, 이동 단말의 모양이 비행기 모양으로 한정되는 것은 아니다.
이동 단말의 위치와 방향을 표시할 때, 그 값은 네비게이션 프레임(navigation frame, ned frame)으로 표시할 수도 있고, 바디 프레임(body frame)으로도 표시할 수 있다.
바디 프레임(body frame)은 움직이는 물체(본 발명에서는 이동 단말이 움직이는 물체)를 기준으로 한 프레임이고, 네비게이션 프레임(navigation frame, ned frame)은 움직이는 물체에 따라 이동하지 않고 고정된 프레임이다.
네비게이션 프레임(navigation frame, ned frame)에 의한 좌표값과 바디 프레임(body frame)에 의한 좌표값은, 도 5에서 표시된 바와 같이, 다음의 관계식을 가진다.
Figure pat00011
위의 관계식에서 ned 는 네비게이션 프레임을 의미하고, body 는 바디 플레임을 의미하고, Ai 는 i번째 AP를 의미하고 u 는 이동 단말을 의미한다. 즉 바디 프레임에서 본 i번째 AP의 위치벡터(행렬)에 프레임 방향 변환 행렬 T 를 곱하면 네비이게션 플레임에서 본 i번째 AP의 위치벡터(행렬)가 계산되어진다.
이때 A i 의 좌표값을 (xi, yi, zi)라 하고, 이동 단말의 좌표값을 (xu, yu, zu)라 하고, 이동 단말에서 Ai 까지의 거리를 ρi, 바디 프레임에서 Ai 를 향하는 방향의 방위각과 앙각을 각각 αi, βi 라고 하면, 다음의 수식 (6)이 성립한다.
Figure pat00012
----(6)
Figure pat00013
만일 이동 단말의 방향을 롤각 φ, 피치각 θ, 요각 ψ로 표시할 수 있다면, 위의 식에서 행렬 T는 다음의 수식 (7) 과 같이 구해진다.
Figure pat00014
----(7)
이동 단말에서 Ai 를 향하는 방향을 바디 프레임에서 측정한 각도는 다음의 행렬(벡터)로 표시될 수 있다.
Figure pat00015
이동 단말에서 AP 를 향하는 방향을 측정한 값을 이용하여 이동 단말의 위치와 자세를 추정할 때, 기압계를 이용하여 이동 단말의 높이(zu)를 추정할 수 있다면, 비교적 간단한 계산으로 나머지 5개의 변수값(이동 단말의 위치에 관한 2개의 변수값 xu, yu 및 이동 단말의 방향에 대한 3개의 변수)를 알 수 있다.
따라서 본 발명에 의한 위치 추정 방법은, 다음의 2 단계를 포함한다.
(1) 제1 단계: 기압계를 이용하여 이동 단말의 높이에 관한 1개의 변수를 추정하는 단계
(2) 제2 단계: AP로부터 수신되는 신호의 수신 방향 측정치를 이용하여 이동 단말의 방향에 관한 3개의 변수와 이동 단말의 위치에 관한 2개의 변수를 추정하는 단계
제 2단계에서 AP로부터 수신되는 신호의 수신 방향 측정치를 이용한다는 의미는 AP로부터 수신되는 신호의 수신 방향 측정치만을 이용한다는 것은 아니고 AP로부터 수신되는 신호의 수신 방향 측정치도 이용한다는 의미이다.
다음의 실시예 1과 실시예 2는 그러한 예이다.
(실시예 1)
실시예 1에서는, 다음의 단계를 거쳐 이동 단말의 위치와 방향에 관한 6개의 변수를 구한다
(1) 제1 단계: 기압계를 이용하여 이동 단말의 높이(zu) 를 추정하는 단계
(2) 제2-1 단계: TOA 측정치를 이용하여 이동 단말의 위치에 관한 2개의 변수(xu, yu)를 추정하는 단계
(3) 제2-2 단계: 중력센서를 이용하여 이동 단말의 방향에 관한 2개의 변수(롤각 φ, 피치각 θ)를 추정하는 단계
(4) 제2-3 단계: AP로부터 수신되는 신호의 수신 방향 측정치를 이용하여 이동 단말의 방향에 관한 나머지 1개의 변수(요각 ψ)를 추정하는 단계
그 과정을 자세히 설명하면 다음과 같다.
A i 의 좌표값은 (xi, yi, zi)이고, 이동 단말의 좌표값은 (xu, yu, zu)이고, 이동 단말에서 Ai 까지의 거리는 ρi이므로, 다음의 수식 (8)이 성립한다.
Figure pat00016
---(8)
이때, 기압계를 이용하여 이동 단말의 높이(zu)는 추정할 수 있다.
수식 (8)으로부터 다음의 수식 (9)가 유도되고,
Figure pat00017
---(9)
아직 그 값을 알지 못하는 이동 단말 위치에 관한 2개의 변수(xu, yu)를 좌변으로 정리하면 다음의 수식 (10)이 유도된다.
Figure pat00018
---(10)
수식 (10)을 행렬 형태로 정리하면 다음의 수식 (11)이 된다.
Figure pat00019
---(11)
수식 (11)로부터, 이동 단말 위치에 관한 2개의 변수(xu, yu)를 구하는 다음의 수식 (12) 내지 (14)가 구해진다.
Figure pat00020
---(12)
Figure pat00021
---(13)
Figure pat00022
---(14)
이때 역행렬이 존재하기 위해서는 TOA 측정값(거리 측정값)은 3개 이상이 필요하다.
이동 단말의 방향에 관한 3개의 변수(롤각 φ, 피치각 θ, 요각 ψ)는 다음의 수식 (15), 수식(16)은 수식을 만족하는데,
Figure pat00023
---(15)
Figure pat00024
---(16)
중력센서를 이용하여 이동 단말의 방향에 관한 2개의 변수(롤각 φ, 피치각 θ)를 구할 수 있으므로, 다음의 수식 (17)의 값을 구할 수 있다.
Figure pat00025
---(17)
FLAOA 방향 측정치 및 TOA 거리 측정치가 N개인 경우, 다음의 수식 (18)이 성립하므로,
Figure pat00026
---(18)
회전행렬 T(ψu )는 다음의 수식 (19) 내지 (21)에 의해 구할 수 있다.
Figure pat00027
---(19)
Figure pat00028
---(20)
Figure pat00029
---(21)
위와 같은 과정을 통해, 이동 단말의 위치와 자세에 관한 6개의 변수를 추정할 수 있다.
(실시예 2)
실시예 2에서는, 다음의 단계를 거쳐 이동 단말의 위치와 방향에 관한 6개의 변수를 구한다
(1) 제1 단계: 기압계를 이용하여 이동 단말의 높이(zu)를 추정하는 단계
(2) 제2-1 단계: 중력센서를 이용하여 이동 단말의 방향에 관한 2개의 변수(롤각 φ, 피치각 θ)를 추정하는 단계:
(3) 제2-2 단계: 이동 단말의 높이(zu) 및 이동 단말의 방향에 관한 2개의 변수(롤각 φ, 피치각 θ), 이동 단말이 측정한 AP로부터의 신호 수신 방향 측정치를 이용하여 이동 단말에서 AP까지의 거리를 추정하는 단계:
(4) 제2-3 단계: 이동 단말의 방향에 관한 나머지 1개의 변수(요각 ψ)를 추정하는 단계
(5) 제2-4 단계: 이동 단말의 위치에 관한 나머지 2개의 변수(xu, yu))를 추정하는 단계
그 과정을 자세히 설명하면 다음과 같다.
Ai 의 좌표값은 (xi, yi, zi)이고, 이동 단말의 좌표값은 (xu, yu, zu)이고, 이동 단말에서 Ai 까지의 거리는 ρi일때, 기압계를 이용하여 이동 단말의 높이(zu)는 추정할 수 있다. 또한, 중력센서를 이용하여 이동 단말의 방향에 관한 2개의 변수(롤각 φ, 피치각 θ)를 추정할 수 있다.
네비게이션 프레임에서의 좌표값과 바디 프레임에서의 좌표값은 다음의 수식 (22)를 만족하는데,
Figure pat00030
---(22)
수식 (22)의 마지막 행을 정리하면 다음의 수식 (23)이 된다.
Figure pat00031
---(23)
이때 FLAOA 측정치(이동 단말에서 Ai 로부터 오는 신호의 방향측정치)와 이동 단말의 방향에 관한 2개의 변수(롤각 φu, 피치각 θu)를 미리 알고 있으므로, Ai 까지의 거리는 ρi는 다음의 수식 (24)에 의해 알 수 있다.
Figure pat00032
---(24)
수식 (22)를 Ai 에서 오는 신호 측정치를 정리한 행렬이라고 할 때, Ai 에서 오는 신호 측정치를 정리한 행렬에서 Aj 에서 오는 신호 측정치를 정리한 행렬을 빼면, 다음의 수식 (25)를 유도할 수 있다.
Figure pat00033
---(25)
이때, 다음의 수식 (26) 및 수식 (27)의 관계가 성립한다.
Figure pat00034
---(26)
Figure pat00035
---(27)
이때, 다음의 수식 (28) 및 수식 (29)와 같이 가정하면,
Figure pat00036
---(28)
Figure pat00037
---(29)
다음의 수식 (30)에 의해 cosψ 와 sinψ 를 계산할 수 있다.
Figure pat00038
---(30)
따라서 요각 ψ와 다음의 수식 (83)의 값을 구할 수 있다.
Figure pat00039
---(31)
마지막으로, 이동 단말 위치에 관한 2개의 변수(xu, yu)는 다음의 수식 (32)를 이용하여 구할 수 있다.
Figure pat00040
---(32)
본 발명에 의한 위치 추정 장치 및 방법은, 이동 단말의 위치와 방향을 추정할 때, 기압계를 이용하여 이동 단말의 높이에 관한 1개의 변수를 추정한 후, AP로부터 수신되는 신호의 수신 방향 측정치를 이용하여 이동 단말의 방향에 관한 3개의 변수와 이동 단말의 위치에 관한 2개의 변수를 추정하는 것에 특징이 있다.
실시예 1과 실시예 2는, AP로부터 수신되는 신호의 수신 방향 측정치를 이용하여 이동 단말의 방향에 관한 3개의 변수와 이동 단말의 위치에 관한 2개의 변수를 추정하는 예에 불과하며, 그 외 다양한 방법으로, 이동 단말의 방향에 관한 3개의 변수와 이동 단말의 위치에 관한 2개의 변수를 추정할 수 있다.

Claims (6)

  1. 다수의 AP와 이동 단말을 포함하는 기압계와 FLAOA를 이용한 위치 추정 장치로서,
    상기 이동 단말은 3개 이상의 안테나를 포함하여 상기 AP로부터 수신되는 신호의 수신 방향을 측정할 수 있고,
    상기 이동 단말은 기압계를 이용하여 이동 단말의 높이를 추정할 수 있으며,
    상기 이동 단말의 위치와 방향을 추정할 때, 상기 기압계 측정치를 이용하여 이동 단말의 높이를 추정한 후, AP로부터 수신되는 신호의 수신 방향 측정치를 이용하여 이동 단말의 위치에 관한 나머지 2개의 변수와 이동 단말의 방향에 관한 3개의 변수를 추정하는 것을 특징으로 하는 기압계와 FLAOA를 이용한 위치 추정 장치.
  2. 청구항 1에서,
    상기 이동 단말은 AP까지의 거리를 측정할 수 있고, 중력센서를 이용하여 이동 단말의 방향에 대한 2개의 변수를 추정할 수 있고,
    상기 이동 단말의 위치에 관한 2개의 변수와 방향에 관한 3개의 변수를 추정할 때, 상기 기압계 측정치를 이용하여 이동 단말의 높이를 추정한 후, AP까지의 거리 측정치를 이용하여 이동 단말의 위치에 관한 나머지 2개의 변수를 추정하고, 중력센서를 이용하여 이동 단말의 방향에 관한 2개의 변수를 추정하고, AP로부터 수신되는 신호의 수신 방향 측정치를 이용하여 이동 단말의 방향에 관한 나머지 1개의 변수를 추정하는 것을 특징으로 하는 기압계와 FLAOA를 이용한 위치 추정 장치.
  3. 청구항 1에서,
    상기 이동 단말은 중력센서를 이용하여 이동 단말의 방향에 대한 2개의 변수를 추정할 수 있고,
    상기 이동 단말의 위치에 관한 2개의 변수와 방향에 관한 3개의 변수를 추정할 때, 상기 기압계 측정치를 이용하여 이동 단말의 높이를 추정한 후, 중력센서를 이용하여 이동 단말의 방향에 관한 2개의 변수를 추정하고, 이동 단말에서 AP까지의 거리를 추정한 결과를 이용하여 이동 단말의 방향에 관한 나머지 1개의 변수를 추정하고, 이동 단말의 위치에 관한 나머지 2개의 변수를 추정하는 것을 특징으로 하는 기압계와 FLAOA를 이용한 위치 추정 장치.
  4. 다수의 AP와 이동 단말을 포함하는 위치 추정 장치를 이용하는 위치 추정 방법으로서,
    상기 이동 단말은 3개 이상의 안테나를 포함하여 상기 AP로부터 수신되는 신호의 수신 방향을 측정할 수 있고,
    상기 이동 단말은 기압계를 이용하여 높이를 추정할 수 있고,
    기압계를 이용하여 이동 단말의 높이에 관한 1개의 변수를 추정하는 제1 단계;
    AP로부터 수신되는 신호의 수신 방향 측정치를 이용하여 이동 단말의 방향에 관한 3개의 변수와 이동 단말의 위치에 관한 2개의 변수를 추정하는 제2 단계;
    를 포함하는 것을 특징으로 하는 기압계와 FLAOA를 이용한 위치 추정 방법.
  5. 청구항 4에 있어서,
    상기 제2 단계는,
    TOA 측정치를 이용하여 이동 단말의 위치에 관한 나머지 2개의 변수를 추정하는 제2-1단계;
    중력센서를 이용하여 이동 단말의 방향에 관한 2개의 변수를 추정하는 제2-2 단계;
    AP로부터 수신되는 신호의 수신 방향 측정치를 이용하여 이동 단말의 방향에 관한 나머지 1개의 변수를 추정하는 제2-3 단계;
    를 포함하는 것을 특징으로 하는 기압계와 FLAOA를 이용한 위치 추정 방법.
  6. 청구항 4에 있어서,
    상기 제2 단계는,
    중력센서를 이용하여 이동 단말의 방향에 관한 2개의 변수를 추정하는 제2-1 단계:
    이동 단말의 높이 및 이동 단말의 방향에 관한 2개의 변수, 이동 단말이 측정한 AP로부터의 신호 수신 방향 측정치를 이용하여 이동 단말에서 AP까지의 거리를 추정하는 제2-2 단계:
    상기 추정결과를 이용하여 이동 단말의 방향에 관한 나머지 1개의 변수를 추정하는 제2-3 단계;
    이동 단말의 위치에 관한 나머지 2개의 변수를 추정하는 제2-4단계;
    를 포함하는 것을 특징으로 하는 기압계와 FLAOA를 이용한 위치 추정 방법.
KR1020170041551A 2017-03-31 2017-03-31 기압계와 flaoa를 이용한 위치 추정 방법 KR102020801B1 (ko)

Priority Applications (1)

Application Number Priority Date Filing Date Title
KR1020170041551A KR102020801B1 (ko) 2017-03-31 2017-03-31 기압계와 flaoa를 이용한 위치 추정 방법

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
KR1020170041551A KR102020801B1 (ko) 2017-03-31 2017-03-31 기압계와 flaoa를 이용한 위치 추정 방법

Publications (2)

Publication Number Publication Date
KR20180111101A true KR20180111101A (ko) 2018-10-11
KR102020801B1 KR102020801B1 (ko) 2019-09-11

Family

ID=63865443

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020170041551A KR102020801B1 (ko) 2017-03-31 2017-03-31 기압계와 flaoa를 이용한 위치 추정 방법

Country Status (1)

Country Link
KR (1) KR102020801B1 (ko)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20000062548A (ko) * 1999-02-17 2000-10-25 루센트 테크놀러지스 인크 이동 트랜스시버 위치를 결정하기 위해 다수의 치수를결합하는 방법
JP2007033395A (ja) * 2005-07-29 2007-02-08 Clarion Co Ltd 位置補正方法及びナビゲーション装置
KR20080078576A (ko) 2007-02-23 2008-08-27 한국전자통신연구원 순방향 링크 ａｏａ를 이용한 위치 추정 장치 및 방법
JP2010025738A (ja) * 2008-07-18 2010-02-04 Yamatake Corp 位置検出システム及び位置検出方法
KR100953435B1 (ko) * 2008-02-14 2010-04-20 영남대학교 산학협력단 두 개의 기지국 신호를 사용하여 ＡｏＡ방식과ＴｏＡ방식을 결합한 위치 측위 방법
KR101250215B1 (ko) * 2012-05-31 2013-04-03 삼성탈레스 주식회사 칼만 필터와 보행 상태 추정 알고리즘을 이용한 보행자 관성항법 시스템 및 보행자 관성항법 시스템의 높이 추정 방법
KR101674993B1 (ko) * 2014-12-29 2016-11-10 (주)프라디지컴 단말의 실내 위치를 측정하는 방법 및 사용자 단말

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20000062548A (ko) * 1999-02-17 2000-10-25 루센트 테크놀러지스 인크 이동 트랜스시버 위치를 결정하기 위해 다수의 치수를결합하는 방법
JP2007033395A (ja) * 2005-07-29 2007-02-08 Clarion Co Ltd 位置補正方法及びナビゲーション装置
KR20080078576A (ko) 2007-02-23 2008-08-27 한국전자통신연구원 순방향 링크 ａｏａ를 이용한 위치 추정 장치 및 방법
KR100953435B1 (ko) * 2008-02-14 2010-04-20 영남대학교 산학협력단 두 개의 기지국 신호를 사용하여 ＡｏＡ방식과ＴｏＡ방식을 결합한 위치 측위 방법
JP2010025738A (ja) * 2008-07-18 2010-02-04 Yamatake Corp 位置検出システム及び位置検出方法
KR101250215B1 (ko) * 2012-05-31 2013-04-03 삼성탈레스 주식회사 칼만 필터와 보행 상태 추정 알고리즘을 이용한 보행자 관성항법 시스템 및 보행자 관성항법 시스템의 높이 추정 방법
KR101674993B1 (ko) * 2014-12-29 2016-11-10 (주)프라디지컴 단말의 실내 위치를 측정하는 방법 및 사용자 단말

Also Published As

Publication number Publication date
KR102020801B1 (ko) 2019-09-11

Similar Documents

Publication Publication Date Title
CN105589064B (zh) Wlan位置指纹数据库快速建立和动态更新系统及方法
KR102350199B1 (ko) 단말에서 위치 추정 방법 및 장치
CN106651990B (zh) 一种室内地图构建方法及基于室内地图的室内定位方法
CN112040394B (zh) 一种基于ai深度学习算法的蓝牙定位方法及系统
KR101365291B1 (ko) 오브젝트의 위치 추정 방법 및 장치
CN110026993B (zh) 一种基于uwb及热释电红外传感器的人体跟随机器人
CN110806561B (zh) 一种多基站的自标定方法
WO2018058288A1 (zh) 用于检测飞行高度的方法、装置及无人机
JP5004889B2 (ja) 位置検出システム及び位置検出方法
JP2013002933A (ja) ３次元測位システム
KR100977246B1 (ko) 순방향 링크 ａｏａ를 이용한 위치 추정 장치 및 방법
US20180321352A1 (en) Pose Estimation Using Radio Frequency Identification (RFID) Tags
KR20150125533A (ko) 무선 위치 추정 장치 및 그 방법
Grishin et al. Methods for correcting positions of tethered UAVs in adverse weather conditions
CN109407079B (zh) 一种基于姿态传感器校准的区域定位方法
WO2021166845A1 (ja) 情報処理装置、情報処理方法、及びプログラム
KR20180111101A (ko) 기압계와 flaoa를 이용한 위치 추정 장치 및 방법
EP2856199A1 (en) Determining location and orientation of directional tranceivers
KR102006003B1 (ko) Flaoa를 이용한 위치 추정 장치 및 방법
KR20180111083A (ko) 중력센서와 flaoa를 이용한 위치 추정 장치 및 방법
KR20180083174A (ko) 전자전 지원 시스템(Warfare Support System)의 신호도래방위각 측정 장치 및 그 방법
Yaqoob et al. Source localization using virtual antenna arrays
RU2307730C1 (ru) Способ визуального контроля ориентации тележки мобильного робота при его перемещении по горизонтальной поверхности в заданном помещении
JP2019211448A (ja) 相互位置取得システム
CN117651250B (zh) 一种基于UWB和AoA技术的定位测向方法

Legal Events

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