KR101141984B1 - Dr/gps 데이터 융합 방법 - Google Patents

Dr/gps 데이터 융합 방법 Download PDF

Info

Publication number
KR101141984B1
KR101141984B1 KR20100033449A KR20100033449A KR101141984B1 KR 101141984 B1 KR101141984 B1 KR 101141984B1 KR 20100033449 A KR20100033449 A KR 20100033449A KR 20100033449 A KR20100033449 A KR 20100033449A KR 101141984 B1 KR101141984 B1 KR 101141984B1
Authority
KR
South Korea
Prior art keywords
gps
data
gps data
receiver
kalman filter
Prior art date
Application number
KR20100033449A
Other languages
English (en)
Other versions
KR20110114039A (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 KR20100033449A priority Critical patent/KR101141984B1/ko
Publication of KR20110114039A publication Critical patent/KR20110114039A/ko
Application granted granted Critical
Publication of KR101141984B1 publication Critical patent/KR101141984B1/ko

Links

Images

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)
  • Navigation (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Automation & Control Theory (AREA)

Abstract

본 발명은 DR/GPS 데이터 융합 방법에 관한 것으로서, 칼만 필터 형태에 기반하여 DR 장치의 DR 데이터와 GPS 수신기의 GPS 데이터의 가중치를 조절하는 과정을 거쳐 DR/GPS 데이터를 융합하되, 상기 DR 데이터와 GPS 데이터의 가중치를 조절하는 과정은, GPS의 초기 측정치를 이용하여 항체의 첫번째 위치를 추정하는 제 1 과정과; 두번째 위치부터 향후 모든 위치를 추정하는 제 2 과정을 포함하여 이루어지고, 상기 제 1과정은, GPS 데이터를 수집하는 단계와; DR 데이터를 측정하는 단계와; GPS 데이터를 이용하여 항체의 현재 위치를 GPS에 기반한 좌표로 설정하는 단계와; GPS 데이터와 DR 데이터를 융합하는 단계와; 융합된 DR/GPS 데이터를 출력하는 단계를 포함하여 이루어진 것을 특징으로 한다. 본 발명에 따르면, 칼만 필터 기반 추측항법기법을 적용하여 GPS의 위치 오차를 줄여 GPS의 정확도를 높여줌으로써 선박의 자율운행 항해 및 선박 충돌 회피 등에 효과적으로 적용할 수 있다.

Description

DR/GPS 데이터 융합 방법{DR/GPS Data Fusion Method}
본 발명은 DR/GPS 데이터 융합 방법에 관한 것으로서, 특히 GPS의 위치 오차를 칼만 필터 기반 추측항법기법(Dead Reckoning)을 적용하여 줄일 수 있는 DR/GPS 데이터 융합 방법에 관한 것이다.
항법 시스템(navigation system)에서 가장 중요한 기술중 하나는 대상체의 정확한 위치를 얻는 일이다. 대상체의 위치를 구하기 위해서 일반적으로 위성체를 이용한 GPS(Global Positioning System) 및 자이로스코프와 가속도계와 같은 센서를 가지는 추측항법시스템(Dead Reckoning System; 이하 DR이라 한다)을 이용한다.
GPS는 항법위성을 이용하여 전세계 어디에서나 대상체(수신기)의 위치, 속도, 시간 정보를 알아낼 수 있는 전파항법 시스템이다. GPS의 항법해는 수신기 잡음, 다중경로 오차 등으로 인하여 단시간 안정성은 좋지 않지만 항상 일정 범위내의 오차를 가지기 때문에 장시간 안정성은 매우 뛰어나다. 그렇지만, GPS 수신기는 위성신호가 차단될 경우 항법해를 제공할 수 없다는 단점이 있다.
GPS 네비게이션 시스템에 대해서 좀 더 구체적으로 살펴보기로 한다.
초기에는 GPS가 군사용으로 개발되었지만, 그 응용이 확대되어 지금은 네비게이션을 포함하여 일반적인 응용에 폭넓게 사용되고 있다. GPS 시스템은 최소 24개의 인공위성이 항상 동작하고 있으며, 그들은 각각의 위치와 현재 시간을 나타내는 데이터를 지상으로 실시간 전송한다. GPS 위성은 그들의 신호가 동시에 전송하고 GPS 수신 장치가 2개 이상의 위성으로부터 데이터를 수신할 때, 데이터 도착 시간 차이를 이용하여 각각 위성과 수신자의 상대 거리를 계산할 수 있도록 데이터 전송을 동기화시킨다. GPS 수신기는 신호로부터 획득된 가상거리를 이용하여 위치정보를 계산한다. 4개 이상의 위성으로부터의 신호가 수신될 수 있을 때, GPS 수신기는 GPS 수신기 안테나 위치를 계산할 수 있게 된다.  
GPS 정보의 정확도는 위성의 궤도 정보와 정확한 타이밍 구조에 의해 결정된다. GPS 적용에서, 중요한 사항은 위성과 수신기의 거리를 기반으로 가능한 한 정확하게 수신자의 위치를 획득하는 것이다. GPS는 일반적으로 야외에서 이용되기 때문에, 정밀도에 영향을 미치는 다양한 요소가 있다. 이러한 요소는 시계 오프셋, 대기나 전리층 영향, 다중 경로 영향 그리고 수신기에서 발생하는 잡음 등이 있다. 또한 위성에 대한 수신자의 기하학적 위치도 정확도에 영향을 미칠 수 있다. 2차원적 위치결정 경우를 위해, 정밀도의 수평 저하(HDOP) 요소가 GPS에 설계되어 있으며, 정밀도에 대해 위성의 기하학적 구조가 미치는 영향을 나타내는데 사용된다. 수신자의 추정 위치는 인지된 위성이 기하학적으로 잘 분산되어 있고 HDOP 요소가 작을 경우 더 정확하다. 뿐만 아니라, 측정 시 이용 가능한 위성 수와 위치 변화도 정밀도에 영향을 미친다. 
표준 DGPS는 일반적으로 1 미터 이하의 정확도를 요구하는 경우 사용된다. DGPS는 차동 모드에서 작동하기 위한 여러 방법이 있고, DGPS기지국으로부터 보낸 정보를 활용한다. 가장 일반적인 방법은 데이터 기지국 수신기와 이동 수신기 구조를 가지며, 각각 수신자에 실시간으로 수신된 신호 사이의 차이를 분석하므로 이동 수신기의 위치를 파악하는 것이다. DGPS는 매우 정밀한 위치 측정 서비스를 제공할 수 있지만, 고가이고 기지국이 필요한 단점이 있다. 도 1 은 GPS 수신기를 이용하여 데이터를 습득한 후 습득한 데이터에서 데이터의 평균치를 뺀 값을 보여주는 도면이고, 도 2 는 인접한 샘플링 간의 GPS 출력 차이를 보여주는 도면이다. 도 1,2로부터 짧은 시간 동안 수신된 데이터를 볼 수 있고, 이런 종류의 GPS 수신기 데이터는 측정 시 인식된 위성이 변하지 않는 한 거의 유사하다. 데이터의 변화가 있을 때마다 GPS 수신기의 값들에서는 크기의 유동(drift)이 존재한다. 위도 값의 유동은 0.1854m 이고 경도 값의 유동은 0.1503m 이다.
한편, DR은 항체의 위치설정과 네비게이션에 활용되는 일반적인 기술이다. 이동 물체의 위치와 경로 데이터를 인코더, 지자기센서, 전자콤파스 등의 센서를 이용하여 획득한다. 이 시스템은 짧은 시간 내에 매우 정확한 항해 정보를 제공하나 오류가 시간이 지남에 따라 무한대로 누적되기 때문에 단독으로 이동물체의 항법에 이용 될 수는 없다. 즉, DR은 연속적인 항법해를 제공하며, 단시간 안정성은 우수하지만 시간이 지날수록 오차가 누적하여 증가하기 때문에 장시간 안정성은 좋지 않다.
현재 선박은 물류운송, 여객 및 연구 목적과 같은 여러 분야에서 다양한 목적에 활용되고 있다. 정확하고 신뢰할 만한 항법 시스템에 대한 필요는 항체가 목적지에 성공적으로 도달하는데 있어서 매우 중요하다.
한편, 항체의 자동 운항에서 GPS와 GPS/DR을 융합한 항법을 응용한 많은 연구가 진행되고 있다. 예를 들면, 독립형 GPS를 사용하는 차량을 위한 추적 알고리즘을 연구가 진행되고 있으며, GPS/DR 기반 집적 항해 시스템에서 R-T-S 고정 간격 최적 평활화 기법의 응용 연구가 진행되고 있다. 또한, GPS/DR 데이터 융합을 위해 연합 칼만 필터가 제안되었고, 통합된 GPS/DR 네비게이션의 분야 실험으로부터 구한 데이터를 다루기 위해 적응 강인 확장된 칼만 필터링 기술이 제안되었다.
다른 한편, 일반적으로 사용되는 GPS 수신기의 오류는 SA 정책이 제거되었을지라도 상당히 크고, 미분 GPS(DGPS)는 오차가 1미터 이하가 되며 보다 정확한 항해 정보를 제공할 수 있다. 그렇지만, DGPS는 상업적으로 이용하기에는 상대적으로 고가이며 오차 데이터를 제공하기 위한 기지국이 별도로 필요한 문제점이 있다.
이에 본 발명은 상기와 같은 문제점을 해결하기 위한 것으로서, 저렴한 GPS 수신기를 DR 장치와 결합하여 사용하면서 1미터 이하의 오차를 구현할 수 있도록 칼만 필터 기반의 DR/GPS 데이터 융합 방법을 제공하는데 그 목적이 있다.
상기와 같은 목적을 달성하기 위하여 본 발명에 따른 DR/GPS 데이터 융합 방법은, DR 장치의 DR 데이터와 GPS 수신기의 GPS 데이터를 융합하는 방법으로서, 칼만 필터 형태에 기반하여 DR 장치의 DR 데이터와 GPS 수신기의 GPS 데이터의 가중치를 조절하는 과정을 거쳐 DR/GPS 데이터를 융합하되, 상기 DR 데이터와 GPS 데이터의 가중치를 조절하는 과정은, GPS의 초기 측정치를 이용하여 항체의 첫번째 위치를 추정하는 제 1 과정과; 두번째 위치부터 향후 모든 위치를 추정하는 제 2 과정을 포함하여 이루어지고, 상기 제 1 과정은, GPS 데이터를 수집하는 단계와; DR 데이터를 측정하는 단계와; GPS 데이터를 이용하여 항체의 현재 위치를 GPS에 기반한 좌표로 설정하는 단계와; GPS 데이터와 DR 데이터를 융합하는 단계와; 융합된 DR/GPS 데이터를 출력하는 단계를 포함하여 이루어지는 것을 특징으로 한다.
삭제
삭제
삭제
본 발명에 따르면, 칼만 필터 기반 추측항법기법을 적용하여 GPS의 위치 오차를 줄여 GPS의 정확도를 높여줌으로써 선박의 자율운행 항해 및 선박 충돌 회피 등에 효과적으로 적용할 수 있다.
도 1 은 GPS 수신기를 이용하여 데이터를 습득한 후 데이터의 평균치를 제거한 GPS 데이터를 보여주는 도면.
도 2 는 GPS 데이터의 인접한 샘플링 간의 GPS 출력 차이를 보여주는 도면.
도 3 은 지속적인 이산 칼만 필터 주기를 보여주는 도면.
도 4 는 칼만 필터의 수행 과정을 보여주는 도면.
도 5 는 본 발명에 따른 DR/GPS 데이터 융합 방법을 위한 DR/GPS 데이터 융합 시스템 개념도.
도 6 은 본 발명에 따른 DR/GPS 데이터 융합 방법을 보여주는 제 1흐름도.
도 7 은 본 발명에 따른 DR/GPS 데이터 융합 방법을 보여주는 제 2흐름도.
도 8 은 본 발명에 따른 DR/GPS 데이터 융합 방법을 보여주는 제 3흐름도.
도 9 는 본 발명에 따른 DR/GPS 데이터 융합 방법의 시뮬레이션 결과를 보여주는 도면.
이하, 첨부된 도면을 참조하여 본 발명을 상세히 설명하기로 한다.
먼저, 본 발명에 적용하는 칼만 필터에 관하여 설명하기로 한다.
1960년, R.E. Kalman 은 이산 데이터의 선형 필터링 문제에 대해 재귀해법을 설명하는 그의 유명한 논문을 발표하였다. 그 당시 많은 부분에서 디지털 컴퓨터의 출현으로 인해 빛을 보게 되었고, 오늘까지 광범위한 분야에서 응용되어 왔다.
칼만 필터는 상태방정식에서 다음 상태를 최적으로 recursive하게 예측하는 수단을 제공하도록 설정되어 있다. 이것은 여러 가지 측면에서 매우 강력하다. 그것은 과거, 현재, 그리고 미래에 대한 추측을 도와주고 정확한 성격을 알 수 없는 시스템을 모델링 할 수 있게 한다.
칼만 필터는 선형 확률 차분방정식에 의해 결정되는 이산 제어 시스템의 상태
Figure 112010023226886-pat00064
을 예측하려는 일반적인 문제를 해결한다.
Figure 112010023226886-pat00065
(1-1)
측정치
Figure 112010023226886-pat00066
에 대한 방정식:
Figure 112010023226886-pat00067
(1-2)
임의의 변수
Figure 112010023226886-pat00068
Figure 112010023226886-pat00069
각각 프로세스 및 측정 잡음을 나타낸다. 그들은 서로 독립적이고, 백색인 일반적 확률 분포로 가정한다.
Figure 112010023226886-pat00070
(1-3)
Figure 112010023226886-pat00071
(1-4)
차분 방정식 (1-1)에서 현재 스텝 k에서의 상태에서의 n×n 행렬 A는 이전 시간 스텝 k-1에서 상태 관계되어 있다. 운동 함수 또는 프로세스 잡음은 무시한다. 각 시간 스텝에서 실제 A는 변화할 수 있다. 그러나 여기에서 그것이 일정하다고 가정한다. n×n 행렬 B는 상태 x에서 최적 제어 입력
Figure 112010023226886-pat00072
에 관계되어 있다. 측정 방정식 (1-2)에서 n×n 행렬 H는 측정치
Figure 112010023226886-pat00073
에서 상태와 관련되어 있다. 실제 H는 각 시간이나 스텝에 따라 변화할 수 있다. 그렇지만 여기에서는 그것이 일정하다고 가정한다.
Figure 112010023226886-pat00074
k 번째에서 알려진 이전 상태 평가치,
Figure 112010023226886-pat00075
를 측정치
Figure 112010023226886-pat00076
에서 주어진 k 번째에서 다음 상태 평가치로 정의한다. 이전과 다음 평가치 오차를 다음과 같이 정의할 수 있다.
Figure 112010023226886-pat00077
(1-5)
이전 평가치 에러 공분산은
Figure 112010023226886-pat00078
(1-6)
다음 평가치 에러 공분산은
Figure 112010023226886-pat00079
(1-7)
칼만 필터는 피드백 제어 방식을 사용하여 과정을 추정한다. 필터는 몇몇 시간에서 상태를 추정하고 잡음 측정 방식에서 피드백을 얻는다. 이와 같이, 칼만필터에 대한 방정식은 시간 업데이트 방정식과 측정 업데이트 방정식 둘로 나누어진다. 시간 업데이트 방정식은 다음 시간 과정에 대해 최적 추정치를 얻기 위해 현재상태와 공분산 오차를 추정한다. 개선된 다음 추정치를 얻기 위해 최적 추정에 새로운 측정치를 넣는다. 시간 업데이트 방정식은 또한 측정 업데이트 방정식이 보정 방정식으로 간주되는 동안 예측 방정식으로써 생각할 수 있다. 실제로 최종치 추정 알고리즘은 도 3 에 나타난 바와 같이 수치 해석 문제에 대한 예측-보정 알고리즘과 유사하다.
시간과 측정치 업데이트에 대한 자세한 방정식은 다음과 같다.
Figure 112010023226886-pat00080
(1-8)
Figure 112010023226886-pat00081
(1-9)
Figure 112010023226886-pat00082
(1-10)
Figure 112010023226886-pat00083
(1-11)
Figure 112010023226886-pat00084
(1-12)
첫번째는 측정을 업데이트 하는 동안 칼만이득 Kk 를 계산하는 것이다. 다음 단계는 실제 zk 를 구하는 방법이고 식 (1-11)에서과 같은 측정치를 통합하여 다음 상태를 측정한다. 마지막 단계는 (1-12)를 통해 오차의 공분산을 업데이트 하는 방법이다. 각 시간 및 측정을 업데이트 후 과정을 반복한다. 이것은 이전 과정 또는 새로운 선형적 예측을 하는데 사용하고 있다. 이 재귀적 기법은 칼만 필터의 매우 매력적인 특징중 하나이다. 각 추적에 대한 모든 데이터가 직접 작동하도록 설계된 Wiener filter의 개발보다 더 실질적인 구현이다. 칼만 필터는 재귀적으로 모든 과거의 측정에 대한 현재를 추정하는 것을 대신한다. 도 4 는 칼만 필터의 수행 과정을 나타낸다.
이제, 본 발명에 따른 DR/GPS 데이터 융합 방법을 구체적으로 설명하기로 한다.
도 5 에 도시한 바와 같이, 본 발명에 따른 DR/GPS 데이터 융합 방법을 위한 DR/GPS 데이터 융합 시스템(100)은 항체의 위치이동과 자세변화를 감지하고, 항체의 속도를 감지하는 DR 장치(110), 항법위성을 이용하여 항체의 위치, 속도 및 자세측정치를 산출하는 GPS 수신기(120), GPS 수신기(120)의 GPS 데이터를 시간 지연 시키기 위한 시간 지연 처리단(130) 및 DR 장치(110)의 DR 데이터와 GPS 수신기(120)의 GPS 데이터를 수신하여 융합하는 DR/GPS 데이터 융합 처리기(140)를 포함하여 이루어지는데, DR/GPS 데이터 융합 시스템(100)을 이용하여 DR/GPS 데이터를 융합하는 방법은 칼만 필터 형태에 기반하여 DR 장치(110)의 DR 데이터와 GPS 수신기(120)의 GPS 데이터의 가중치를 조절하는 과정을 거쳐 DR/GPS 데이터를 융합하게 된다. 즉, DR 장치(110)의 DR 데이터와 GPS 수신기(120)의 GPS 데이터의 가중치를 적절히 조절하여 융합함으로써 네비게이션 데이터의 정확도를 높여주게 되는 것이다.
보다 구체적으로, DR 장치(110)의 DR 데이터와 GPS 수신기(120)의 GPS 데이터의 가중치를 조절하는 과정을 살펴보기로 한다.
먼저, GPS 수신기(120)를 위한 특성은 X와 Y(X는 위도를 나타내고, Y는 경도를 나타낸다.)가 매우 천천히 특성변화가 일어나고 모든 특성변화는 X와 Y의 정확도를 결정하게 된다. X와 Y의 DR 장치(110)의 공분산이 Q라고 가정하자. 본 발명에 따른 DR/GPS 데이터 융합 방법의 유도를 위해, 먼저 시작하는 점에 가상 GPS 수신기가 있다고 가정한다. 그리고 다음과 같은 단계를 순차적으로 실행한다.
도 6 에 도시한 바와 같이, 본 발명에 따른 DR 데이터와 GPS 데이터의 가중치를 조절하는 과정은, 크게 GPS의 초기 측정치를 이용하여 항체의 첫번째 위치를 추정하는 제 1 과정(S110)과, 두번째 위치부터 향후 모든 위치를 추정하는 제 2 과정(S120)을 포함하여 이루어진다.
그리고, 도 7 에 도시한 바와 같이, 상기 제 1 과정(S110)은 GPS 수신기(120)에서 GPS 데이터를 수집하는 단계(S111), DR 장치(110)에서 DR 데이터를 측정하는 단계(S112), DR/GPS 데이터 융합처리기(140)에서 GPS 데이터를 이용하여 항체의 현재 위치를 GPS에 기반한 좌표로 설정하는 단계(S113), DR/GPS 데이터 융합처리기(140)에서 GPS 데이터와 DR 데이터를 융합하는 단계(S114) 및 DR/GPS 데이터 융합처리기(140)에서 융합된 DR/GPS 데이터를 출력하는 단계(S115)를 포함하여 이루어진다.
이하, 상기 제 1,2과정(S110),(S120)을 좀 더 구체적으로 설명하기로 한다.
제 1 단계 : 항체가 시작점에서 정지하고 있는 동안,
Figure 112010023226886-pat00085
Figure 112010023226886-pat00086
를 얻기 위해 GPS 데이터를 수집한다. 상기 제 1 단계는 상기 S111 단계에 해당한다.
제 2 단계 : 시간 T에서 항체가 운항을 시작한다(편의상 시작점을 '1'이라 한다). 실제 DR 장치에 기반한 좌표를 시간 T에서
Figure 112010023226886-pat00087
Figure 112010023226886-pat00088
로 설정한다. 상응하는 데이터의 공분산은
Figure 112010023226886-pat00089
Figure 112010023226886-pat00090
이다. 상기 제 2 단계는 상기 S112 단계에 해당한다.
제 3 단계 : 시간 T에서 실제 GPS 데이터
Figure 112010023226886-pat00091
Figure 112010023226886-pat00092
를 얻는다.
제 4 단계 : GPS 수신기의 출력이 매우 천천히 특성변화가 일어나므로, 시간 T에서 동시에 발생하는 가상 GPS 출력
Figure 112010023226886-pat00093
Figure 112010023226886-pat00094
를 예측한다.
제 5 단계 : 시간 T에서 실제 GPS 데이터와 가상 GPS 데이터의 차이를 이용하여, GPS에 기반한 항체의 좌표
Figure 112010023226886-pat00095
Figure 112010023226886-pat00096
를 예측한다. 제 3 단계 내지 제 5 단계는 상기 S113 단계에 해당된다.
제 6 단계 : 한 개의 샘플링 동안, DR 장치는 정확한 짧은 시간의 네이게이션 정보를 제공할 수 있는데, 이것을 이용하여 GPS에 기반한 좌표의 공분산을 계산한다.
만약
Figure 112010023226886-pat00097
이면
Figure 112010023226886-pat00098
의 공분산을
Figure 112010023226886-pat00099
로 가정하고,
Figure 112010023226886-pat00100
이면
Figure 112010023226886-pat00101
의 공분산을
Figure 112010023226886-pat00102
로 가정한다. 그외의 경우에는
Figure 112010023226886-pat00103
의 공분산이 매우 크다고 가정한다. 이 과정을 통해
Figure 112010023226886-pat00104
Figure 112010023226886-pat00105
의 공분산
Figure 112010023226886-pat00106
Figure 112010023226886-pat00107
를 계산할 수 있다.
제 7 단계 :
Figure 112010023226886-pat00108
를 이용하여 DR 장치의 신뢰도를 계산하고,
Figure 112010023226886-pat00109
를 이용하여 GPS 수신기의 신뢰도를 계산한다.
제 8 단계 ; 다응 식을 이용하여 융합된 결과를 계산한다.
Figure 112010023226886-pat00110
,
Figure 112010023226886-pat00111
Figure 112010023226886-pat00112
의 공분산은
Figure 112010023226886-pat00113
이고,
Figure 112010023226886-pat00114
의 공분산은
Figure 112010023226886-pat00115
이다. 상기 제 6 단계 ~ 제 8 단계는 상기 S114 단계에 해당한다.
제 9 단계 : 가상 GPS 수신기의 현재 시간을
Figure 112010023226886-pat00116
Figure 112010023226886-pat00117
을 이용하여 예측한다. 이 데이터의 공분산은
Figure 112010023226886-pat00118
Figure 112010023226886-pat00119
이다. 상기 제 9 단계는 상기 S115 단계에 해당한다.
제 10 단계 : 시간 kT(k=2,3...)에서 DR 장치의 좌표
Figure 112010023226886-pat00120
Figure 112010023226886-pat00121
를 취득한다. 이 데이터에 대한 공분산은
Figure 112010023226886-pat00122
Figure 112010023226886-pat00123
이다.
제 11 단계 : 실제 GPS 데이터로부터
Figure 112010023226886-pat00124
Figure 112010023226886-pat00125
를 취득한다.
제 12 단계 : 가상 GPS에 대한 현재 시간의 데이터
Figure 112010023226886-pat00126
Figure 112010023226886-pat00127
를 예측한다.
제 13 단계 : 현재 시간에 대한 GPS 기반 좌표
Figure 112010023226886-pat00128
Figure 112010023226886-pat00129
를 예측한다.
제 14 단계: 제 6 단계에서 언급한 GPS 기반 좌표의 공분산에 대해 연산한다.
제 15 단계 : DR 장치의 신뢰도
Figure 112010023226886-pat00130
, GPS 수신기의 신뢰도
Figure 112010023226886-pat00131
를 산출한다.
제 16 단계 : 융합된 결과를 계산하면 다음과 같다.
Figure 112010023226886-pat00132
Figure 112010023226886-pat00133
Figure 112010023226886-pat00134
의 공분산은
Figure 112010023226886-pat00135
이고,
Figure 112010023226886-pat00136
의 공분산은
Figure 112010023226886-pat00137
이다.
제 17 단계 :
Figure 112010023226886-pat00138
,
Figure 112010023226886-pat00139
를 이용하여 현재 시간에 대한 가상 GPS 수신기의 출력을 예측한다.
이 데이터에 대한 각각의 공분산은
Figure 112010023226886-pat00140
Figure 112010023226886-pat00141
이다. 상기 제 10 단계 ~ 제 17 단계는 상기 제 2 과정(S120)에 해당한다.
이 융합 과정은 반복 과정을 통하여 계산된다.
시뮬레이션
본 시뮬레이션에서는 본 발명에 따른 DR/GPS 데이터 융합 방법과 칼만 필터 방법을 실제 GPS 데이터에 적용하였다. 도 9 에 나타난 바와 같이, 일반적인 GPS 수신기에 대해 적용한 본 발명에 따른 DR/GPS 데이터 융합 방법과 칼만 필터 방법에 대한 출력 성능이 비슷하다고 볼 수 있다. 여기에서 시뮬레이션 동안 GPS 수신기가 원활하게 작동하고 있었다는 것을 주목하여야 한다.
종종 GPS 수신기가 잘 동작하지 않는다. 작동되지 않는 경우의 예로 기후 변화에 따라 충분한 위성 또는 위성 위치로부터 데이터를 수신할 수 없는 경우를 들 수 있다. 이 경우에 GPS의 에러가 매우 크게 되고 칼만 필터는 좋은 성능을 제공할 수 없게 된다. 본 발명에 따른 DR/GPS 데이터 융합 방법은 GPS 수신기의 신뢰를 수정한 뒤 측정하면 더 좋은 성능을 보여준다. GPS 수신기의 신뢰가 낮을 경우는 DR 장치를 항해 정보에 주로 사용하게 된다.
한편, 본 발명에 따른 DR/GPS 데이터 융합 방법을 한정된 실시예에 따라 설명하였지만, 본 발명의 범위는 특정 실시예에 한정되는 것은 아니며, 본 발명과 관련하여 통상의 지식을 가진자에게 자명한 범위내에서 여러 가지의 대안, 수정 및 변경하여 실시할 수 있다.
100 : DR/GPS 데이터 융합 시스템 110 : DR 장치
120 : GPS 수신기 130 : 시간 지연 처리단
140 : DR/GPS 데이터 융합처리기

Claims (4)

  1. 삭제
  2. DR 장치의 DR 데이터와 GPS 수신기의 GPS 데이터를 융합하는 방법으로서,
    칼만 필터 형태에 기반하여 DR 장치의 DR 데이터와 GPS 수신기의 GPS 데이터의 가중치를 조절하는 과정을 거쳐 DR/GPS 데이터를 융합하되,
    상기 DR 데이터와 GPS 데이터의 가중치를 조절하는 과정은,
    GPS의 초기 측정치를 이용하여 항체의 첫번째 위치를 추정하는 제 1 과정과;
    두번째 위치부터 향후 모든 위치를 추정하는 제 2 과정을 포함하여 이루어지고,
    상기 제 1 과정은,
    GPS 데이터를 수집하는 단계와;
    DR 데이터를 측정하는 단계와;
    GPS 데이터를 이용하여 항체의 현재 위치를 GPS에 기반한 좌표로 설정하는 단계와;
    GPS 데이터와 DR 데이터를 융합하는 단계와;
    융합된 DR/GPS 데이터를 출력하는 단계를 포함하여 이루어지는 것을 특징으로 하는 DR/GPS 데이터 융합 방법.
  3. 삭제
  4. 삭제
KR20100033449A 2010-04-12 2010-04-12 Dr/gps 데이터 융합 방법 KR101141984B1 (ko)

Priority Applications (1)

Application Number Priority Date Filing Date Title
KR20100033449A KR101141984B1 (ko) 2010-04-12 2010-04-12 Dr/gps 데이터 융합 방법

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
KR20100033449A KR101141984B1 (ko) 2010-04-12 2010-04-12 Dr/gps 데이터 융합 방법

Publications (2)

Publication Number Publication Date
KR20110114039A KR20110114039A (ko) 2011-10-19
KR101141984B1 true KR101141984B1 (ko) 2012-05-07

Family

ID=45029189

Family Applications (1)

Application Number Title Priority Date Filing Date
KR20100033449A KR101141984B1 (ko) 2010-04-12 2010-04-12 Dr/gps 데이터 융합 방법

Country Status (1)

Country Link
KR (1) KR101141984B1 (ko)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104076379A (zh) * 2014-07-01 2014-10-01 山东航向电子科技有限公司 传输率自适应智能省电4g定位跟踪装置及方法

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR102012247B1 (ko) * 2012-10-31 2019-08-21 한국전자통신연구원 추측 항법을 이용한 단말기의 위치 추정 장치 및 방법
KR102533246B1 (ko) * 2016-03-24 2023-05-17 엘지전자 주식회사 항법 장치 및 이를 포함하는 차량 운전 보조장치
KR102660497B1 (ko) * 2016-12-14 2024-04-24 현대모비스 주식회사 차량의 위치 정보 측위 시스템
KR102565482B1 (ko) * 2018-03-06 2023-08-11 현대모비스 주식회사 차량의 측위 장치 및 그 방법
CN113805486B (zh) * 2021-10-13 2024-06-28 哈尔滨工程大学 一种usv路径跟踪控制方法

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20070021872A (ko) * 2005-08-19 2007-02-23 한국전자통신연구원 추측 항법과 지피에스를 이용한 복합 항법 장치 및 그 방법
KR20090108444A (ko) * 2008-04-11 2009-10-15 엘지전자 주식회사 네비게이션 장치 및 이를 이용한 이동체의 위치 탐색방법

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20070021872A (ko) * 2005-08-19 2007-02-23 한국전자통신연구원 추측 항법과 지피에스를 이용한 복합 항법 장치 및 그 방법
KR20090108444A (ko) * 2008-04-11 2009-10-15 엘지전자 주식회사 네비게이션 장치 및 이를 이용한 이동체의 위치 탐색방법

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104076379A (zh) * 2014-07-01 2014-10-01 山东航向电子科技有限公司 传输率自适应智能省电4g定位跟踪装置及方法

Also Published As

Publication number Publication date
KR20110114039A (ko) 2011-10-19

Similar Documents

Publication Publication Date Title
US20230041831A1 (en) Methods of attitude and misalignment estimation for constraint free portable navigation
KR102463176B1 (ko) 위치 추정 장치 및 방법
US8860609B2 (en) Loosely-coupled integration of global navigation satellite system and inertial navigation system
KR101535873B1 (ko) 위성측위시스템과 추측 항법을 융합한 차량 위치 추정 시스템 및 방법
CN102933937B (zh) 移动站及使用惯性传感器数据来改善移动站定位的方法
US8773303B2 (en) Position tracking device and method
CN101382431B (zh) 定位系统及其方法
JP5301762B2 (ja) キャリア位相相対測位装置
EP1865286A2 (en) Object locating in restricted environments using personal navigation
US20100109945A1 (en) Loosely-coupled integration of global navigation satellite system and inertial navigation system: speed scale-factor and heading bias calibration
KR101141984B1 (ko) Dr/gps 데이터 융합 방법
EP2816374B1 (en) Vehicle positioning in high-reflection environments
US11428822B2 (en) Methods and systems for location determination
KR101473653B1 (ko) 보행자 모션 인식 기반 보행자 위치 추정 장치, 및 그 방법
JP2012207919A (ja) 異常値判定装置、測位装置、及びプログラム
KR20180108629A (ko) 시각적인 관성 주행 거리계와 위성 포지셔닝 시스템 기준 프레임들의 정렬
KR100443550B1 (ko) 오차보정시스템을 구비하는 관성측정유닛-지피에스통합시스템과 미지정수 검색범위 축소방법 및 사이클 슬립검출방법, 및 그를 이용한 항체 위치, 속도,자세측정방법
Mu et al. A GNSS/INS-integrated system for an arbitrarily mounted land vehicle navigation device
JP2014102137A (ja) 自己位置推定装置
CN112923919A (zh) 基于图优化的行人定位方法及系统
KR20130036145A (ko) 이동 정보 결정 장치, 수신기 및 그에 의한 방법
KR20170015768A (ko) Gnss 음영 지역에서의 위치 보정 시스템 및 방법
CN113063441A (zh) 里程计累计推算误差的数据源纠正方法及装置
JP5994237B2 (ja) 測位装置及びプログラム
CN111288990A (zh) 一种架空检修机器人组合姿态测量方法

Legal Events

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

Payment date: 20150421

Year of fee payment: 4

LAPS Lapse due to unpaid annual fee