gps/관성센순통합에의한측위및및및및응용응용 - kaunisl.kau.ac.kr/elec3.pdf ·...

59
ETRI 원내 원내 원내 원내 전문 전문 전문 전문 교육 교육 교육 교육 GPS/관성센순 관성센순 관성센순 관성센순 통합에 통합에 통합에 통합에 의한 의한 의한 의한 측위 측위 측위 측위 및 및 응용 응용 응용 응용 LEC3 DGPS FUNDAMENTALS 2005/7/14 이형근 ( [email protected] )

Upload: others

Post on 24-Sep-2020

1 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

ETRI 원내원내원내원내 전문전문전문전문 교육교육교육교육

GPS/관성센순관성센순관성센순관성센순 통합에통합에통합에통합에 의한의한의한의한 측위측위측위측위 및및및및 응용응용응용응용

LEC3 DGPS FUNDAMENTALS

2005/7/14

이 형 근 ( [email protected] )

Page 2: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

Error Sources

Page 3: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

3

오오오오차차차차 요요요요인인인인

Ephemeris

Satellite Clock

Ionospheric

Tropospheric

Receiver Clock

Receiver Noise

MultiPath

50Km

200Km

Page 4: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

4

오오오오차차차차 크크크크기기기기

표준 GPS Differential GPS

위성 시계 1.5 0

궤순 오차 2.5 0

전리층 5.0 0.4

대류층 0.5 0.2

수신기 잡음 0.3 0.3

다중경로 오차 0.6 0.6

SA 30 0 (현재 영향 없음)

Page 5: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

5

Good DOP Bad DOP

관측행렬관측행렬관측행렬관측행렬 H에에에에 나타난나타난나타난나타난 위성위성위성위성 시선각시선각시선각시선각 분포의분포의분포의분포의 영향영향영향영향

오차공분산오차공분산오차공분산오차공분산 행렬행렬행렬행렬 σσσσρρρρ (HTH)-1 대각성분의대각성분의대각성분의대각성분의 조합조합조합조합

t

en

then

h

hen

TDOP

HDOP

cGDOP

VDOP

PDOP

σ

σσ

σσσσ

σ

σσσ

=

+=

+++=

=

++=

22

22222

222

Page 6: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

6

시시시시계계계계 오오오오차차차차

(위성위성위성위성 시계시계시계시계 오차오차오차오차) = (정밀한정밀한정밀한정밀한 시계와시계와시계와시계와 broadcast 시계시계시계시계사이의사이의사이의사이의 오차오차오차오차)

위성위성위성위성 시계시계시계시계 오차는오차는오차는오차는 1.5 m 거리거리거리거리 오차에오차에오차에오차에 해당하는해당하는해당하는해당하는 약약약약 5 *10^(-9)초초초초

수신기수신기수신기수신기 시계시계시계시계 오차는오차는오차는오차는 위치오차와위치오차와위치오차와위치오차와 함께함께함께함께 추정의추정의추정의추정의 대상임대상임대상임대상임

단독단독단독단독 수신기를수신기를수신기를수신기를 이용하여이용하여이용하여이용하여 수신기수신기수신기수신기 시계를시계를시계를시계를 보정하면보정하면보정하면보정하면 수신기수신기수신기수신기시계오차는시계오차는시계오차는시계오차는 10 m 정순의정순의정순의정순의 거리오차에거리오차에거리오차에거리오차에 해당하는해당하는해당하는해당하는 3.33 *10^(-8)초초초초

first-order 시계오차는시계오차는시계오차는시계오차는 차분차분차분차분 기술에기술에기술에기술에 의해의해의해의해 제거가능제거가능제거가능제거가능

Page 7: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

7

전전전전리리리리층층층층 지지지지지지지지

전리층에전리층에전리층에전리층에 존재하는존재하는존재하는존재하는 자유전자에자유전자에자유전자에자유전자에 의하여의하여의하여의하여 이를이를이를이를 통과하는통과하는통과하는통과하는 전전전전자기파는자기파는자기파는자기파는 분산분산분산분산 및및및및 왜곡왜곡왜곡왜곡

SA 제거제거제거제거 이후이후이후이후 가장가장가장가장 큰큰큰큰 오차오차오차오차 요인요인요인요인

의사거리는의사거리는의사거리는의사거리는 더더더더 길게길게길게길게 측정됨측정됨측정됨측정됨

위상은위상은위상은위상은 더더더더 짧게짧게짧게짧게 측정됨측정됨측정됨측정됨

위상의위상의위상의위상의 경우경우경우경우 주파수주파수주파수주파수 제곱에제곱에제곱에제곱에 반비례반비례반비례반비례

이중이중이중이중 주파수주파수주파수주파수 수신기에수신기에수신기에수신기에 의하여의하여의하여의하여 제거제거제거제거 가능가능가능가능

Page 8: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

8

대대대대류류류류층층층층 지지지지지지지지

앙각앙각앙각앙각(elevation angle)에에에에 영향을영향을영향을영향을 받음받음받음받음

천정에순는천정에순는천정에순는천정에순는 2.5m에에에에 달하며달하며달하며달하며, 5순순순순 앙각에순는앙각에순는앙각에순는앙각에순는 20-28m 이상에이상에이상에이상에 달할달할달할달할 수수수수 있음있음있음있음

주로주로주로주로 경험적경험적경험적경험적 모델모델모델모델(온순온순온순온순, 압력압력압력압력, 상대상대상대상대 습순의습순의습순의습순의 함수함수함수함수)을을을을 사용사용사용사용하며하며하며하며, 이를이를이를이를 통하여통하여통하여통하여 대부분의대부분의대부분의대부분의 효과를효과를효과를효과를 추정할추정할추정할추정할 수수수수 있다있다있다있다

이중이중이중이중 주파수에주파수에주파수에주파수에 의한의한의한의한 제거는제거는제거는제거는 불가능불가능불가능불가능

Page 9: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

9

다다다다중중중중경경경경로로로로 오오오오차차차차

안테나안테나안테나안테나 주위의주위의주위의주위의 물체와물체와물체와물체와 들어오는들어오는들어오는들어오는 신호의신호의신호의신호의 상호상호상호상호 작용의작용의작용의작용의 결과결과결과결과로로로로 복합적인복합적인복합적인복합적인 반사와반사와반사와반사와 회절의회절의회절의회절의 원인원인원인원인

의사거리의사거리의사거리의사거리 측정치의측정치의측정치의측정치의 경우경우경우경우 수십수십수십수십 m 정순의정순의정순의정순의 오차오차오차오차 발생발생발생발생 가능가능가능가능

안테나의안테나의안테나의안테나의 종류종류종류종류 및및및및 위치위치위치위치 선정에선정에선정에선정에 의하여의하여의하여의하여 영향영향영향영향

낮은낮은낮은낮은 앙각앙각앙각앙각 위성위성위성위성 신호에신호에신호에신호에 포함될포함될포함될포함될 가능성가능성가능성가능성 높음높음높음높음 (choke ring 안테나안테나안테나안테나 사용사용사용사용)

수신기수신기수신기수신기 상관기상관기상관기상관기 및및및및 신호처리신호처리신호처리신호처리 알고리즘에알고리즘에알고리즘에알고리즘에 의한의한의한의한 완화완화완화완화 가능가능가능가능

완전히완전히완전히완전히 제거하기제거하기제거하기제거하기 어려움어려움어려움어려움

Page 10: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

Satellite Position & Correction Terms

Page 11: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

11

Clock parameters in Navigation Message

Page 12: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

12

Orbit parameters in Navigation Message

Page 13: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

13

Page 14: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

14

Page 15: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

15

M

a

ab

Satellite Position 1: Mean, Eccentric, and True Anomalies

,,',',',,vEM zyxzyxiru →→→Φ→→→

Page 16: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

16

Satellite Position 2: 위위위위성성성성위위위위표표표표계계계계에에에에순순순순 ECEF위위위위표표표표계계계계로로로로의의의의 변변변변환환환환

,,',',',,vEM zyxzyxiru →→→Φ→→→위성좌표계위성좌표계위성좌표계위성좌표계 ECEFECEFECEFECEF좌표계좌표계좌표계좌표계

Page 17: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

17

전전전전리리리리층층층층 및및및및 대대대대류류류류층층층층 지지지지지지지지

Troposphere

Ionosphere

Geometric distance

Actual signal path

Boundary between

Iono- and Troposphere

Page 18: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

18

전전전전리리리리층층층층 보보보보정정정정 (Klobuchar model, 단단단단단단단단주주주주파파파파수수수수 수수수수신신신신기기기기)

(latitude)

(longitude)

(ion. param.s)

where

Page 19: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

19

대대대대류류류류층층층층 보보보보정정정정 (Chao, Magnavox, Collins Model)

−=∆ −−

69006900

)sin(

208.2 sr hh

Mee

8.7492

)sin(026.0

4225.2 rh

Ce

E

+=∆ρ

wetwetdrydrytropFF ρρρ ∆+∆=∆

Pdry

510276.2 −×=∆ρ3

46.1

6

2

23.1

2 10705.11070.4T

e

T

ewet

αρ ×+×=∆1

0445.0)tan(

00143.0)sin(

++=

EEF

dry

1

017.0)tan(

00035.0)sin(

++=

EEF

wet

P : pressure (newton/m2)

: temperature (degrees Kelvin)

: partial pressure of water vapor (millibars)

: satellite elevation (deg)

: receiver altitude (m)

: satellite altitude (m)

Te

E

rh

sh

Chao Model

Magnovox Model

Collins Model

Page 20: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

Standalone

Positioning

Page 21: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

21

각각각각 채채채채채채채채채채채채 의의의의사사사사거거거거리리리리 측측측측정정정정치치치치jjjj

u

j

u

j

uWTIBBR +++−+=ρ~

j

u

j

uBR ε++=

j

uu

jTj

uBXXe ε++−= )(

satellite anduser between vector LOS:1)||(||

positionuser :

errort measuremen epseudorang total:

noise thermal:

delay ictropospher:

delay cionospheri :

biasclock satellite :

biasclock user :

range true:

epseudorang measured:~

=j

u

j

u

u

j

j

j

j

j

u

j

u

j

u

ee

X

W

T

I

B

B

R

ε

ρ

[ ]u

jTj

u

j

uXXeR −= )(

uB

jX

uX

j

ue

)()( u

jT

u

j

u

j

j

u

XXXX

XXe

−−

−=

nonlinear !nonlinear !nonlinear !nonlinear !----> > > > linearizelinearizelinearizelinearize

1. Measure PR

Page 22: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

22

각각각각 채채채채채채채채채채채채 의의의의사사사사거거거거리리리리 추추추추정정정정치치치치

uu

jTj

u

j

uBXXe ˆˆ)ˆ(ˆ +−=ρ

u

j

u

j

u

u

u

u

u

j

u

Xee

B

B

X

X

ˆon based vector LOS estimated:1)||ˆ(||ˆ

error n)(estimatio biasclock :

biasclock user estimated:ˆ

error n)(estimatioposition :

positionuser estimated:ˆ

epseudorang estimated:ˆ

=

δ

δ

ρ

uuuXXX δ+=ˆ

uuuBBB δ+=ˆ

Given

2. Compute estimated PR as

Page 23: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

23

선선선선형형형형화화화화된된된된 채채채채채채채채채채채채 의의의의사사사사거거거거리리리리 간간간간간간간간 측측측측정정정정치치치치

j

u

j

u

jz ρρ ˆ~

−=

[ ][ ]

[ ] j

u

uTj

u

j

uu

Tj

u

uu

jTj

u

j

uu

jTj

u

B

Xe

BXe

BXXe

BXXe

εδδ

εδδ

ε

+

−=+−=−−−

++−=

1)(

)(

ˆˆ)(

)(

j

u

ujj

B

Xhz ε

δδ −

=

3. Subtract estimated PR from Measured PR

Sincejz

It satisfies

[ ]1)( −=Tj

u

jeh

Page 24: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

24

선선선선형형형형화화화화된된된된 벡벡벡벡터터터터 간간간간간간간간 측측측측정정정정치치치치

4. Stack (at least 4) scalar measurements into a vector

The vector measurement satisfies

j

mz

z

z

Z

=

M

2

1 j

mh

h

h

H

=

M

2

1

εδδ −

=

u

u

B

XHZ

j

m

ε

ε

εM

2

1

Page 25: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

25

위위위위치치치치오오오오차차차차 및및및및 시시시시계계계계오오오오차차차차의의의의 계계계계산산산산

ZHHHTT →−1)(

ZHHHB

X TT

u

u 1)(ˆ

ˆ−=

δδ

5. Multiply pseudoinverse to the vector measurement

6. Then, estimates of position and clock bias error are obtained

εδδ

TT

u

uHHH

B

X1)( −−

=

estimation errorestimation errorestimation errorestimation error

Page 26: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

26

위위위위치치치치 및및및및 시시시시계계계계오오오오차차차차의의의의 보보보보상상상상

uoldunewuXXX ˆˆˆ

,,δ−=

uoldunewuBBB ˆˆˆ

,,δ−=

7. Update old estimates to new estimates

Page 27: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

27

εδδ

TT

u

uHHH

B

X1)( −→

newuX

olduX

uX

8. Iterate 2~7 until converges

* If 8 is finished, the following condition is satisfied

)()( 1WTIBHHH

TT +++−= −

14ˆ

ˆ

×→

OB

X

u

u

δδ

SVclockerror

ionoerror

tropoerror

noiseEstimation error Dilution Of Precision(DOP)

For, more detailed information, see “ error sources”

Page 28: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

Differential Positioning

Page 29: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

29

오오오오차차차차 추추추추정정정정 및및및및 방방방방송송송송 (Estimation and Broadcasting)

User Receiver

Ionospheric Delay

Tropospheric Delay

Ephemeris Error

SV Clock Error

corrected position and clock bias corrected position and clock bias corrected position and clock bias corrected position and clock bias

(lat,(lat,(lat,(lat,lonlonlonlon,h,B),h,B),h,B),h,B)

Reference Receiver

at known location

1. 1. 1. 1. estimate estimate estimate estimate error sources error sources error sources error sources

2. 2. 2. 2. broadcast broadcast broadcast broadcast correction terms correction terms correction terms correction terms

termcorrection : ˆ

meas. original : ˆ

j

j

u

j

u

j

uBR

εερ

+

−+=

3. 3. 3. 3. correct correct correct correct measurementmeasurementmeasurementmeasurement

Page 30: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

30

단단단단단단단단 차차차차분분분분

User Receiver

Ionospheric Delay

Tropospheric Delay

Ephemeris Error

SV Clock Error

baseline and clock errorbaseline and clock errorbaseline and clock errorbaseline and clock error

(x,y,z,b)(x,y,z,b)(x,y,z,b)(x,y,z,b)

Reference Receiver

at known location

[ ] j

rr

jTj

r

j

rBXXe ερ ++−= )(~

[ ] j

uu

jTj

u

j

uBXXe ερ ++−= )(~

[ ] )()(~~urru

Tj

r

j

u

j

rBBXXe −+−≅− ρρ

Page 31: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

31

이이이이중중중중 차차차차분분분분

User Receiver

Ionospheric Delay

Tropospheric Delay

Ephemeris Error

Reference Receiver

at known location User clock Error

SV Clock Error

Reference Satellite Near Zenith

baseline onlybaseline onlybaseline onlybaseline only

(x,y,z)(x,y,z)(x,y,z)(x,y,z)[ ][ ] 0000 )(~

)(~

ερερ

++−=

++−=

rr

T

rr

j

rr

jTj

r

j

r

BXXe

BXXe [ ][ ] 0000 )(~

)(~

ερερ

++−=

++−=

uu

T

uu

j

uu

jTj

u

j

u

BXXe

BXXe

[ ]ru

T

r

j

rur

j

u

j

rXXee −−≅−−− )()~~()~~( 000 ρρρρ

Page 32: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

32

망망망망

User

Receiver

Reference Receiver 1

at known locationReference Receiver 3

at known location

Reference Receiver 2

at known location

Page 33: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

33

Single-Differenced (SD) GPS Measurement Model

: Line Of Sight (LOS) vector from the receiver to the j-th satellite

: Earth-Centered Earth-Fixed (ECEF) position of the j-th satellite

: ECEF receiver position

: receiver clock bias

: unresolved SD integer ambiguity

: SD code noise

: SD carrier noise

kje ,

kjx ,

kux ,

kub ,

jΝΝΝΝ

kjv ,

kjn ,

kjkukukj

T

kjkj vbxxe ,,,,,, )(~ ++−=ρ

jkjkukukj

T

kjkj nbxxe Νλφ +++−= ,,,,,, )(~

PR:

CR:

where

Page 34: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

34

Φ

Φ

Φ

+

+

+

+

r

r

r

r

r

r

n

n

n

v

v

v

kj

kj

kj

kj

kj

kj

00000

00000

00000

00000

00000

00000

,

0

0

0

0

0

0

~

,1

1,

,

,1

1,

,

ρ

ρ

ρ

: code noise strength (uniform)

: carrier noise strength (uniform)

ρr

φr

where

Page 35: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

35

Double-Differenced (DD) GPS Measurement Model

: Line Of Sight (LOS) vector from the receiver to the j-th satellite

: ECEF reference (fixed) receiver position

: ECEF user (moving) receiver position

: unresolved DD integer ambiguity

: DD code noise

: DD carrier noise

kje ,

kux ,

jΝΝΝΝ’

kjv’ ,

kjn’ ,

kj

T

kjkj v’e ,,,~ +=ρ

jkjkj n’ ΝΝΝΝ’λφ ++,,

~

PR:

CR:

where

krx , )( −kux ,

T

kje ,=krx , )( −

kux ,

krx ,

Page 36: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

36

측정치측정치측정치측정치조합의조합의조합의조합의형태형태형태형태

where

이이이이이이이이주주주주주주주주주주주주위위위위위위위위측측측측정정정정치치치치조조조조합합합합

)2(~2)1(

~1)2,1(

~LcLccc j

u

j

u

j

uΦ+Φ=Φ

)1()1()1(~

11LnNTLIBBRL j

LL

jjj

u

j

u

j

u+++−−+=Φ λ

)2()2()2(~

22LnNTLIBBRL j

LL

jjj

u

j

u

j

u+++−−+=Φ λ

),2()2( LILI jj α=

2

2

2

1

L

L

f

f=α

Page 37: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

37

측정치측정치측정치측정치조합의조합의조합의조합의목적목적목적목적

– 전리층전리층전리층전리층오차오차오차오차제거제거제거제거: iono-free combination

– 미지정주미지정주미지정주미지정주결정결정결정결정편의를편의를편의를편의를위한위한위한위한주장주장주장주장길이의길이의길이의길이의확장확장확장확장: widelanecombination

– 전리층전리층전리층전리층오차에오차에오차에오차에의한의한의한의한필터의필터의필터의필터의발산발산발산발산방지방지방지방지: divergence-free combination

)2,1()1

1,1

(~

)2,1()2,1(ccnNTBBR j

cccc

jj

u

j

u

j

u+++−+=

−−

−Φ λ

ααα

)2,1()2,1(),(~

)2,1()2,1(

21

2

21

1 ccnNTccIBBR j

cccc

jjj

u

j

u

LL

L

LL

Lj

u+++−−+=

−−

−Φ λ

λλλ

λλλ

1)2,1(4

Lccλλ ≅

0)2,1( =ccI j

)2,1()22,12(~

)2,1()2,1(ccnNTIBBR j

cccc

jjj

u

j

u

j

u++++−+=−−Φ λαα

)2,1(~ ccWTIBBR jjjj

u

j

u

j

u+++−+=ρ

non-integer

non-integer

Page 38: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

Differential Filtering

Page 39: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

39

Range Domain

by dynamics model

by carrier-smoothed-code

Kalman-type gain

Hatch gain

Position Domain

by dynamics model

by carrier-smoothed-code

Kalman-type gain

Hatch gain

Page 40: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

40

kjkukukj

T

kjkj vbxxe ,,,,,, )(~ ++−=ρ

jkjkukukj

T

kjkj nbxxe Νλφ +++−= ,,,,,, )(~

kaajkaajkjkj E ,,2,1,0,,,2,1,0,,, ~,~|:ˆ

LL === φρρρ

kaajkaajkjkj E ,,2,1,0,1,,2,1,0,,, ~,~|:

LL =−== φρρρ

* Compressed PR (a posteriori PR estimate) for the j-th satellite

* Projected PR (a priori PR estimate) for the j-th satellite

where

raw PR measurement:

raw CP measurement:

Page 41: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

41

kjkukukj

T

kjkj vbxxe ,,,,,, )(~ ++−=ρ

jkjkukukj

T

kjkj nbxxe Νλφ +++−= ,,,,,, )(~

jkjkjkj

jkjkjkj

n

n

ΝΝΝΝ

ΝΝΝΝ

λρφλρφ

++=

++= +++

,,,

1,1,1,

~

~

)( ,1,, kjkjkj nn −+∆ +ρ- )

* Measurement model

),0(~ , , ρrv kj

),0(~ , , φrn kj

* Key idea: incremental range is directly measured

dynamics model is not required

Page 42: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

42

−+++=

−+=

∑∑∑

==

=

kj

k

l

lj

k

l

ljkj

k

l

ljkjljkj

nk

kn

kv

k

k

,

1

1

,

1

,,

1

,,,,

111

)~~

(~1ˆ

ρ

φφρρ* Principle

1,jρ2,jρ

3,jρ4,jρ

5,jρ

2, −kjρ1, −kjρ

kj ,ρ

1,,

~~jkj φφ −

1,,

~~jkj φφ −

1,,

~~jkj φφ −

1,,

~~jkj φφ −

1,,

~~jkj φφ −

Page 43: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

43

]~|[ˆ ρXEX =

Code Example:

estusr = initpos;

while ((iter<maxiter)&(norm(beta)>tol))

for (N = 1;N<=numvis;N++)

posdiff = svxyzmat.SubMatrix(1,3,N,N)-estusr.SubMatrix(1,3,1,1);

pr0 = norm(posdiff);

y(N,1) = prvec(N,1) - pr0 - estusr(4,1);

estusr_without_cb = estusr.SubMatrix(1,3,1,1);

mt = H.t()*H;

mt = mt.i();

beta = mt*H.t()*y;

estusr=estusr+beta;

iter=iter+1;

Page 44: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

44

Positioning with Multiple RD Filters

],|[ kk

r

k XEX ρ= 11 )( −−

= kk

T

k

r

k HRHP

],ˆ|[ˆkk

r

k XEX ρ=11 )ˆ(ˆ −−

= kk

T

k

r

k HRHP

=

kJ

k

k

k

R

R

R

R

,

,2

,1

00

00

00

:

L

MOMM

L

L

=

kJ

k

k

k

R

R

R

R

,

,2

,1

ˆ00

0ˆ0

00ˆ

L

MOMM

L

L

* Position Estimation by Compressed PRs

* Position Estimation by Projected PRs

),,(~ r

k

r

k POX

),ˆ,(~ˆ r

k

r

k POX

where

Dimension of Hk and Rk varies according to the number of visible satellites→ If the signal from the satellite corresponding to the smallest Rk is blocked,

large information loss occurs

Page 45: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

45

Comparison: Standalone, DGPS, Filtered-DGPS

Page 46: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

Carrier-phase Differential Positioning

Page 47: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

47

CDGPS(Carrier phase Differential GPS)– GPS 위성이위성이위성이위성이 송신하는송신하는송신하는송신하는 신호의신호의신호의신호의 반송파를반송파를반송파를반송파를 이용하여이용하여이용하여이용하여 위치계산위치계산위치계산위치계산

Page 48: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

48

Ref. station

User

j-th SVi-th SV

i

rλφ i

uλφj

rλφj

uλφ

rR

iRjR

위치해위치해위치해위치해 계산법계산법계산법계산법

– 측정식측정식측정식측정식 :

– 근사방정식근사방정식근사방정식근사방정식

– 정확한정확한정확한정확한 를를를를 알알알알 수수수수 있다면있다면있다면있다면 실수실수실수실수를를를를 계산할계산할계산할계산할 수수수수 있다있다있다있다.

– 람다알고리듬과람다알고리듬과람다알고리듬과람다알고리듬과 실수실수실수실수 로부터로부터로부터로부터 미미미미지정수지정수지정수지정수 를를를를 계산계산계산계산

– 선형근사방정식선형근사방정식선형근사방정식선형근사방정식

– 최소자승법에최소자승법에최소자승법에최소자승법에 의해의해의해의해 위치해위치해위치해위치해 계산계산계산계산

i

r

i

r

i

r

i

r

i

r NbBd ελλφ ++−+=

ij

ru

ij

ru

ij

ru

i

ru

j

ru

ij

ru

i

ru

i

ru

i

ru

i

ru

i

r

i

u

i

ru

Nd

NBd

ελφφλφελφφλφ

++=−=

+++=−=

: DD

: SD

ij

rud

ij

ru

ij

ru

ij

ru Nd λλφ +=ij

ruN~

ij

ruN~

ij

ruN

Tij

ru

ij

ru

ij

ru zyxHN ],,[=−λλφ

Page 49: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

49

순순순순순순순순순순순순

FilteringFiltering

DD 생성DD 생성

SD 생성SD 생성

GPS 측정치

읽기

GPS 측정치

읽기

Ephemeris data 읽기

Ephemeris data 읽기

기준국 좌표

읽기

기준국 좌표

읽기

변수 설정변수 설정

실수해, 공분산 구하기

실수해, 공분산 구하기

Lambda algorithm

Lambda algorithm

Fixed solution

구하기

Fixed solution

구하기

VerificationVerification

Page 50: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

50

다음과다음과다음과다음과 같은같은같은같은 이중이중이중이중 차분식을차분식을차분식을차분식을 고려하면고려하면고려하면고려하면

Float Solution(실수해실수해실수해실수해)

정수인정수인정수인정수인 미지정수를미지정수를미지정수를미지정수를 정정정정수수수수 조건을조건을조건을조건을 제거제거제거제거한한한한 후후후후

다음의다음의다음의다음의 Cost function를를를를 가중가중가중가중 최소최소최소최소 자승법으로자승법으로자승법으로자승법으로 푼푼푼푼 해해해해

y Aa Bb e= + +여기순, y : 관측 데이터와 계산 데이터의 차분 벡터

a : 이중차분 미지정수b : 기저선 벡터의 미지증분A, B : 행렬e : 오차

yofmatrixarianceQQwhere

BbAay

yyQ

Q

y

y

cov:(.)(.)

min

1*2

2

=⋅

−−

Page 51: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

51

Selection of Integer Ambiguity Candidate

LOS direction (changes according to SV’s movement)

Error ellipse constructed by PD Hatch filter’s error covariance matrix

Float ambiguity

Integer grid points

Found integer ambiguity candidate

fast error ellipse shrink

by PD Hatch filter

Page 52: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

52

미미미미지지지지정정정정수수수수 (Integer Ambiguity) 결결결결정정정정

nDDNXLDDDD

DDXLDDDD

baseline

baseline

++=Φ+=λ

ερ~ˆ

ελρ DDnDDNDDDD ++=−Φ ˆ~

( )ρλ ˆ~1ˆ DDDDN −Φ=

),,(~ˆN

RNNT

SMPRNDDRDDR )(

ˆ≅

),(~

),(~

CR

SMPR

ROn

ROε

)()(maxmin CRSMPR

RR σσ >>

operator difference-double:DD

vectorepseudorang smoothed:ρ vectorphase-carrier measured:

user toreference from baseline:baseline

X

where

SMPRR and ,

~,ˆObtain 1. Φρ

Φ~ from ˆSubtract 2. ρ

N and ˆ Compute 3. RN

N

RN

ˆ from distance compute and

) ,ˆ( ellipse the tointernal

point grideach Search 4.

N

Nambiguity integer the toscorrespond

point distance-minimum The 5.

N

N

Page 53: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

53

미미미미지지지지정정정정수수수수 결결결결정정정정 기기기기법법법법

이중이중이중이중 차분된차분된차분된차분된 미지정수는미지정수는미지정수는미지정수는 3333개만이개만이개만이개만이 독립되어독립되어독립되어독립되어 있음있음있음있음

– Measurement Measurement Measurement Measurement 가가가가 많을많을많을많을 경우경우경우경우 미지정수미지정수미지정수미지정수 간의간의간의간의 상관관계가상관관계가상관관계가상관관계가 매우매우매우매우 커짐커짐커짐커짐....

• 불필요한불필요한불필요한불필요한 검색이검색이검색이검색이 증가함증가함증가함증가함

적절한적절한적절한적절한 변환변환변환변환 행렬행렬행렬행렬 Z Z Z Z 를를를를 사용하여사용하여사용하여사용하여 미지정수의미지정수의미지정수의미지정수의 상호상호상호상호 독립성을독립성을독립성을독립성을 높임높임높임높임

– 기존의기존의기존의기존의 미지정수미지정수미지정수미지정수 검색에순검색에순검색에순검색에순 발생하는발생하는발생하는발생하는 불필요한불필요한불필요한불필요한 검색을검색을검색을검색을 줄임줄임줄임줄임

미지정수미지정수미지정수미지정수 검색검색검색검색 공간의공간의공간의공간의 효율화효율화효율화효율화

Page 54: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

54

최소자승법으로최소자승법으로최소자승법으로최소자승법으로 구해진구해진구해진구해진 실수해와실수해와실수해와실수해와 공분산공분산공분산공분산 행렬행렬행렬행렬

– 실수해실수해실수해실수해 :

– 공분산공분산공분산공분산 :

목적함수를목적함수를목적함수를목적함수를 최소화최소화최소화최소화 하는하는하는하는 미지정수를미지정수를미지정수를미지정수를 검색을검색을검색을검색을 통해통해통해통해 결정결정결정결정

• 실수해와실수해와실수해와실수해와 공분산공분산공분산공분산 2개의개의개의개의 입력을입력을입력을입력을 이용이용이용이용

• 검색공간의검색공간의검색공간의검색공간의 효율화를효율화를효율화를효율화를 위해위해위해위해 LAMBDA 방법을방법을방법을방법을 사용사용사용사용

Fixed Solution

– 결정된결정된결정된결정된 미지정수를미지정수를미지정수를미지정수를 다시다시다시다시 대입하여대입하여대입하여대입하여 정확한정확한정확한정확한 위치해위치해위치해위치해 계산계산계산계산

1 1 1

1 1 1

ˆ

ˆ

T T Ty y y

T T Ty y y

B Q B B Q A B Q yb

aA Q B A Q A A Q y

− − −

− − −

= 1 1

ˆ ˆ ˆ

1 1ˆ ˆˆ

T Ty yb ba

T Taab y y

Q Q B Q B B Q A

Q Q A Q B A Q A

− −

− −

=

2ˆmin with

a

n

Qaa a a Z−− ∈

)ˆ(ˆ 1

ˆˆˆaaQQbb aab

(

(

−−=−

Page 55: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

55

미미미미지지지지정정정정수수수수의의의의 검검검검증증증증

LAMBDA 방법방법방법방법

– 미지정수의미지정수의미지정수의미지정수의 검색을검색을검색을검색을 보다보다보다보다 더더더더 정확하게정확하게정확하게정확하게 효율적으로효율적으로효율적으로효율적으로 하는하는하는하는 수단수단수단수단

– 결정된결정된결정된결정된 미지정수를미지정수를미지정수를미지정수를 검증해야검증해야검증해야검증해야 잘못된잘못된잘못된잘못된 위치위치위치위치 해를해를해를해를 제거제거제거제거 가능가능가능가능

검증방법검증방법검증방법검증방법

– 대부분의대부분의대부분의대부분의 경우경우경우경우 비율검사법을비율검사법을비율검사법을비율검사법을 이용이용이용이용

비율검사법비율검사법비율검사법비율검사법

– 잔차의잔차의잔차의잔차의 weighted squared sumweighted squared sumweighted squared sumweighted squared sum을을을을 구하여구하여구하여구하여 비율검사비율검사비율검사비율검사

– 비율이비율이비율이비율이 임계치임계치임계치임계치(1.5(1.5(1.5(1.5----7777사이의사이의사이의사이의 값값값값))))을을을을 넘는넘는넘는넘는 경우경우경우경우 참참참참 미지정수로미지정수로미지정수로미지정수로 확정확정확정확정

2

1

1 2, : :

threshold ratio

where smallest one but smallest

Ω ≥Ω

Ω Ω)ˆ()ˆ( 1

ˆ aaQaa a

T (( −−=Ω −

Page 56: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

56

Validation of Integer Ambiguity Candidate

Validated integer ambiguity

time

threshold duration to validate integer ambiguity

candidate

starting epoch

validation

epoch

Validation fails

Page 57: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

57

Experiment: Epoch-by-Epoch DGPS Solution

2.705 2.71 2.715 2.72 2.725 2.73 2.735 2.74

x 105

-3

-2

-1

0

1

2

3

time (sec)

error (m

)

epoch-by-epoch DGPS solution

errorupper sigma val.

lower sigma val.

Page 58: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

58

Experiment: Float Solution

2.705 2.71 2.715 2.72 2.725 2.73 2.735 2.74

x 105

-1

-0.8

-0.6

-0.4

-0.2

0

0.2

0.4

0.6

0.8

1

time (sec)

error (m

)

float solution

errorupper sigma val.

lower sigma val.

Page 59: GPS/관성센순통합에의한측위및및및및응용응용 - KAUnisl.kau.ac.kr/elec3.pdf · 2012. 1. 12. · ETRI 원내전문교육 GPS/관성센순통합에의한측위및및및및응용응용

59

Experiment: Integer Solution

2.705 2.71 2.715 2.72 2.725 2.73 2.735 2.74

x 105

-0.25

-0.2

-0.15

-0.1

-0.05

0

0.05

0.1

0.15

0.2

0.25

time (sec)

error (m

)

integer solution

error

upper sigma val.

lower sigma val.