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

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

Info

Publication number
KR102020801B1
KR102020801B1 KR1020170041551A KR20170041551A KR102020801B1 KR 102020801 B1 KR102020801 B1 KR 102020801B1 KR 1020170041551 A KR1020170041551 A KR 1020170041551A KR 20170041551 A KR20170041551 A KR 20170041551A KR 102020801 B1 KR102020801 B1 KR 102020801B1
Authority
KR
South Korea
Prior art keywords
mobile terminal
estimating
variables
barometer
height
Prior art date
Application number
KR1020170041551A
Other languages
English (en)
Other versions
KR20180111101A (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를 이용한 위치 추정 방법{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 112017031694779-pat00001
이므로, 위의 식에 다음 식을 대입하면
Figure 112017031694779-pat00002
다음의 식이 되고
Figure 112017031694779-pat00003
위의 식을 다시 정리하면 다음의 수식 (1) 과 같다. (단, ψu = αu )
Figure 112017031694779-pat00004
-------(1)
여기에 r = tan αu 을 대입하면, 다음과 같은 수식 (2) 가 된다.
Figure 112017031694779-pat00005
----(2)
위의 식에서 p = xu + yu r 및 q = xu r - yu 로 치환하면, 다음의 수식 (3) 이 된다.
Figure 112017031694779-pat00006
----(3)
위의 식에 관한 n개의 측정치를 행렬로 정리하면 다음의 수식 (4) 와 같다.
Figure 112017031694779-pat00007
----(4)
위의 식으로부터 r, p, q 의 값을 구할 수 있고, r, p, q 의 값을 알면 다음의 수식 (5) 에 의해 xu , yu , ψu (단, ψu = αu )를 구할 수 있다.
Figure 112017031694779-pat00008
,
Figure 112017031694779-pat00009
,
Figure 112017031694779-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 112017031694779-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 112017031694779-pat00012
----(6)
Figure 112017031694779-pat00013
만일 이동 단말의 방향을 롤각 φ, 피치각 θ, 요각 ψ로 표시할 수 있다면, 위의 식에서 행렬 T는 다음의 수식 (7) 과 같이 구해진다.
Figure 112017031694779-pat00014
----(7)
이동 단말에서 Ai 를 향하는 방향을 바디 프레임에서 측정한 각도는 다음의 행렬(벡터)로 표시될 수 있다.
Figure 112017031694779-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 112017031694779-pat00016
---(8)
이때, 기압계를 이용하여 이동 단말의 높이(zu)는 추정할 수 있다.
수식 (8)으로부터 다음의 수식 (9)가 유도되고,
Figure 112017031694779-pat00017
---(9)
아직 그 값을 알지 못하는 이동 단말 위치에 관한 2개의 변수(xu, yu)를 좌변으로 정리하면 다음의 수식 (10)이 유도된다.
Figure 112017031694779-pat00018
---(10)
수식 (10)을 행렬 형태로 정리하면 다음의 수식 (11)이 된다.
Figure 112017031694779-pat00019
---(11)
수식 (11)로부터, 이동 단말 위치에 관한 2개의 변수(xu, yu)를 구하는 다음의 수식 (12) 내지 (14)가 구해진다.
Figure 112017031694779-pat00020
---(12)
Figure 112017031694779-pat00021
---(13)
Figure 112017031694779-pat00022
---(14)
이때 역행렬이 존재하기 위해서는 TOA 측정값(거리 측정값)은 3개 이상이 필요하다.
이동 단말의 방향에 관한 3개의 변수(롤각 φ, 피치각 θ, 요각 ψ)는 다음의 수식 (15), 수식(16)은 수식을 만족하는데,
Figure 112017031694779-pat00023
---(15)
Figure 112017031694779-pat00024
---(16)
중력센서를 이용하여 이동 단말의 방향에 관한 2개의 변수(롤각 φ, 피치각 θ)를 구할 수 있으므로, 다음의 수식 (17)의 값을 구할 수 있다.
Figure 112017031694779-pat00025
---(17)
FLAOA 방향 측정치 및 TOA 거리 측정치가 N개인 경우, 다음의 수식 (18)이 성립하므로,
Figure 112017031694779-pat00026
---(18)
회전행렬 T(ψu )는 다음의 수식 (19) 내지 (21)에 의해 구할 수 있다.
Figure 112017031694779-pat00027
---(19)
Figure 112017031694779-pat00028
---(20)
Figure 112017031694779-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 112017031694779-pat00030
---(22)
수식 (22)의 마지막 행을 정리하면 다음의 수식 (23)이 된다.
Figure 112017031694779-pat00031
---(23)
이때 FLAOA 측정치(이동 단말에서 Ai 로부터 오는 신호의 방향측정치)와 이동 단말의 방향에 관한 2개의 변수(롤각 φu, 피치각 θu)를 미리 알고 있으므로, Ai 까지의 거리는 ρi는 다음의 수식 (24)에 의해 알 수 있다.
Figure 112017031694779-pat00032
---(24)
수식 (22)를 Ai 에서 오는 신호 측정치를 정리한 행렬이라고 할 때, Ai 에서 오는 신호 측정치를 정리한 행렬에서 Aj 에서 오는 신호 측정치를 정리한 행렬을 빼면, 다음의 수식 (25)를 유도할 수 있다.
Figure 112017031694779-pat00033
---(25)
이때, 다음의 수식 (26) 및 수식 (27)의 관계가 성립한다.
Figure 112017031694779-pat00034
---(26)
Figure 112017031694779-pat00035
---(27)
이때, 다음의 수식 (28) 및 수식 (29)와 같이 가정하면,
Figure 112017031694779-pat00036
---(28)
Figure 112017031694779-pat00037
---(29)
다음의 수식 (30)에 의해 cosψ 와 sinψ 를 계산할 수 있다.
Figure 112017031694779-pat00038
---(30)
따라서 요각 ψ와 다음의 수식 (83)의 값을 구할 수 있다.
Figure 112017031694779-pat00039
---(31)
마지막으로, 이동 단말 위치에 관한 2개의 변수(xu, yu)는 다음의 수식 (32)를 이용하여 구할 수 있다.
Figure 112017031694779-pat00040
---(32)
본 발명에 의한 위치 추정 장치 및 방법은, 이동 단말의 위치와 방향을 추정할 때, 기압계를 이용하여 이동 단말의 높이에 관한 1개의 변수를 추정한 후, AP로부터 수신되는 신호의 수신 방향 측정치를 이용하여 이동 단말의 방향에 관한 3개의 변수와 이동 단말의 위치에 관한 2개의 변수를 추정하는 것에 특징이 있다.
실시예 1과 실시예 2는, AP로부터 수신되는 신호의 수신 방향 측정치를 이용하여 이동 단말의 방향에 관한 3개의 변수와 이동 단말의 위치에 관한 2개의 변수를 추정하는 예에 불과하며, 그 외 다양한 방법으로, 이동 단말의 방향에 관한 3개의 변수와 이동 단말의 위치에 관한 2개의 변수를 추정할 수 있다.

Claims (6)

  1. 삭제
  2. 삭제
  3. 삭제
  4. 삭제
  5. 기압계와 FLAOA를 이용한 위치 추정 방법으로서,
    다수의 AP와 이동 단말을 포함하는 위치 추정 장치를 이용하고,
    상기 이동 단말은 3개 이상의 안테나를 포함하여 상기 AP로부터 수신되는 신호의 수신 방향을 측정할 수 있고,
    상기 이동 단말은 기압계를 이용하여 높이를 추정할 수 있고,
    기압계를 이용하여 이동 단말의 높이에 관한 1개의 변수를 추정하는 제1 단계;
    AP로부터 수신되는 신호의 수신 방향 측정치를 이용하여 이동 단말의 방향에 관한 3개의 변수와 이동 단말의 위치에 관한 2개의 변수를 추정하는 제2 단계;
    를 포함하고,
    상기 제2 단계는,
    TOA 측정치를 이용하여 이동 단말의 위치에 관한 나머지 2개의 변수를 추정하는 제2-1단계;
    중력센서를 이용하여 이동 단말의 방향에 관한 2개의 변수를 추정하는 제2-2 단계;
    AP로부터 수신되는 신호의 수신 방향 측정치를 이용하여 이동 단말의 방향에 관한 나머지 1개의 변수를 추정하는 제2-3 단계;
    를 포함하는 것을 특징으로 하는 기압계와 FLAOA를 이용한 위치 추정 방법.
  6. 기압계와 FLAOA를 이용한 위치 추정 방법으로서,
    다수의 AP와 이동 단말을 포함하는 위치 추정 장치를 이용하고,
    상기 이동 단말은 3개 이상의 안테나를 포함하여 상기 AP로부터 수신되는 신호의 수신 방향을 측정할 수 있고,
    상기 이동 단말은 기압계를 이용하여 높이를 추정할 수 있고,
    기압계를 이용하여 이동 단말의 높이에 관한 1개의 변수를 추정하는 제1 단계;
    AP로부터 수신되는 신호의 수신 방향 측정치를 이용하여 이동 단말의 방향에 관한 3개의 변수와 이동 단말의 위치에 관한 2개의 변수를 추정하는 제2 단계;
    를 포함하고,
    상기 제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 KR20180111101A (ko) 2018-10-11
KR102020801B1 true 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 (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007033395A (ja) * 2005-07-29 2007-02-08 Clarion Co Ltd 位置補正方法及びナビゲーション装置
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 (주)프라디지컴 단말의 실내 위치를 측정하는 방법 및 사용자 단말

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CA2296812A1 (en) * 1999-02-17 2000-08-17 Lucent Technologies Inc. Method for combining multiple measurements to determine the position of a mobile transceiver
KR100977246B1 (ko) 2007-02-23 2010-08-20 한국전자통신연구원 순방향 링크 ａｏａ를 이용한 위치 추정 장치 및 방법

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007033395A (ja) * 2005-07-29 2007-02-08 Clarion Co Ltd 位置補正方法及びナビゲーション装置
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
KR20180111101A (ko) 2018-10-11

Similar Documents

Publication Publication Date Title
CN105589064B (zh) Wlan位置指纹数据库快速建立和动态更新系统及方法
US9207677B2 (en) Vehicle positioning method and its system
CN109716157B (zh) 轴偏移估计装置
JP5004889B2 (ja) 位置検出システム及び位置検出方法
WO2018058288A1 (zh) 用于检测飞行高度的方法、装置及无人机
US11673567B2 (en) Integrated fiducial marker for simultaneously calibrating sensors of different types
US20180321352A1 (en) Pose Estimation Using Radio Frequency Identification (RFID) Tags
US11366233B2 (en) System and method for GPS based automatic initiation of sensor calibration
KR101803705B1 (ko) 카메라와 거리 센서의 3차원 캘리브레이션 시스템 및 방법, 그리고 캘리브레이션 장치 및 캘리브레이션 지그
JP2013002933A (ja) ３次元測位システム
US20160091341A1 (en) Method and apparatus for object localization
JP2020507858A5 (ko)
US11587256B2 (en) Apparatus for autonomous driving and method and system for calibrating sensor thereof
KR100977246B1 (ko) 순방향 링크 ａｏａ를 이용한 위치 추정 장치 및 방법
US11635313B2 (en) System and method for simultaneously multiple sensor calibration and transformation matrix computation
WO2021166845A1 (ja) 情報処理装置、情報処理方法、及びプログラム
KR102020801B1 (ko) 기압계와 flaoa를 이용한 위치 추정 방법
KR102584864B1 (ko) 무인 비행체를 이용한 신호원의 위치정보 확인 방법 및 장치
KR101763911B1 (ko) 자기장 외란이 심한 환경에서 수중체의 선수각 추정 장치 및 그 방법
KR102020806B1 (ko) 중력센서와 flaoa를 이용한 위치 추정 장치 및 방법
KR102006003B1 (ko) Flaoa를 이용한 위치 추정 장치 및 방법
CN110706198A (zh) 基于无人机对大型建筑机器人的振动检测系统
WO2019077856A1 (ja) 位置推定装置、空調システム、位置推定方法及びプログラム
CN114554030B (zh) 设备检测系统以及设备检测方法
KR20180083174A (ko) 전자전 지원 시스템(Warfare Support System)의 신호도래방위각 측정 장치 및 그 방법

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