Study: Robotics(Robot)/Robot: Positioning

[Positioning] ์œ„์„ฑํ•ญ๋ฒ•์‹œ์Šคํ…œ(GNSS) ์ •๋ฆฌ(5): GPS ์˜์‚ฌ๊ฑฐ๋ฆฌ ์ธก์ • - ์ฝ”๋“œ ๊ธฐ๋ฐ˜(์‹œ๊ฐ„), ์œ„์ƒ ๊ธฐ๋ฐ˜(์œ„์น˜)

DrawingProcess 2023. 3. 28. 12:17
๋ฐ˜์‘ํ˜•
๐Ÿ’ก ๋ณธ ๋ฌธ์„œ๋Š” '์œ„์„ฑํ•ญ๋ฒ•์‹œ์Šคํ…œ(GNSS) ์ •๋ฆฌ(5): GPS ์˜์‚ฌ๊ฑฐ๋ฆฌ ์ธก์ • - ์ฝ”๋“œ ๊ธฐ๋ฐ˜(์‹œ๊ฐ„), ์œ„์ƒ ๊ธฐ๋ฐ˜(์œ„์น˜)'์— ๋Œ€ํ•ด ์ •๋ฆฌํ•ด๋†“์€ ๊ธ€์ž…๋‹ˆ๋‹ค.
์ด์ „ ๋‚ด์šฉ์—์„œ๋Š” '์œ„์„ฑํ•ญ๋ฒ•์‹œ์Šคํ…œ(GNSS)'์˜ ์ด๋ก ์— ๋Œ€ํ•ด ์ •๋ฆฌํ•ด๋ณด์•˜์œผ๋ฉฐ, ์—ฌ๊ธฐ์„œ ๋‹ค๋ฃฌ ์ธก์œ„๊ธฐ๋ฒ•์„ ๊ธฐ๋ฐ˜์œผ๋กœ ์˜ค์ฐจ๋ณด์ •ํ•˜๋Š” ๋ฐฉ๋ฒ• ๋ฐ ์‹ค์ œ ์‚ฌ์šฉ์— ๋Œ€ํ•ด ์ •๋ฆฌํ•˜์˜€์œผ๋‹ˆ ์ฐธ๊ณ ํ•˜์‹œ๊ธฐ ๋ฐ”๋ž๋‹ˆ๋‹ค.

1. GPS ์˜์‚ฌ ๊ฑฐ๋ฆฌ

1.1. ์˜์‚ฌ ๊ฑฐ๋ฆฌ ์ธก์ •

์˜์‚ฌ ๊ฑฐ๋ฆฌ (Pseudo-range)๋Š” GPS ์œ„์„ฑ๊ณผ ์ˆ˜์‹ ๊ธฐ ๊ฐ„์˜ ๊ฑฐ๋ฆฌ๋ผ ๋ณผ ์ˆ˜ ์žˆ๋Š”๋ฐ, ์˜์‚ฌ๊ฑฐ๋ฆฌ๋ฅผ '์ฝ”๋“œ ๊ธฐ๋ฐ˜(์‹œ๊ฐ„ ์‚ฌ์šฉ)'๊ณผ '์œ„์ƒ ๊ธฐ๋ฐ˜(์œ„์น˜ ์‚ฌ์šฉ)' ๊ฑฐ๋ฆฌ ์ธก์ • ๋ฐฉ๋ฒ• ๋‘˜์— ์˜ํ•ด ๊ณ„์‚ฐํ•  ์ˆ˜ ์žˆ๋‹ค.

์ฝ”๋“œ ๊ธฐ๋ฐ˜ ๊ฑฐ๋ฆฌ ์ธก์ • ๋ฐฉ๋ฒ•(์‹œ๊ฐ„ ์‚ฌ์šฉ)์—์„œ๋Š” ์œ„์„ฑ์ด ๋ฐฉ์‚ฌํ•œ C/A์ฝ”๋“œ์™€ P์ฝ”๋“œ ๋“ฑ์„ ์ˆ˜์‹ ํ•ด, ์ˆ˜์‹ ๊ธฐ ์ž์ฒด๊ฐ€ ๋ฐœ์ƒ์‹œํ‚จ ๋™์ผํ•œ ์ฝ”๋“œ์™€์˜ ์‹œ๊ฐ„์ฐจ์ด๋กœ ๊ฑฐ๋ฆฌ๋ฅผ ๊ณ„์‚ฐํ•œ๋‹ค. (์˜์‚ฌ๊ฑฐ๋ฆฌ) = (์ „ํŒŒ ์†๋„) X (์‹œ๊ฐ„ ์ฐจ)์ธ ๊ฒƒ์ด๋‹ค. ์ฃผ๋กœ ์ €๊ฐ€ ์Šค๋งˆํŠธํฐ ๋‚ด์žฅ GPS ๋“ฑ ์ €๊ฐ€ ์ˆ˜์‹ ๊ธฐ์—์„œ๋งŒ ์‚ฌ์šฉํ•œ๋‹ค.

์œ„์ƒ ๊ธฐ๋ฐ˜ ๊ฑฐ๋ฆฌ ์ธก์ • ๋ฐฉ๋ฒ•(์œ„์น˜ ์‚ฌ์šฉ) ํ˜น์€ ๋ฐ˜์†กํŒŒ ๊ธฐ๋ฐ˜ ๊ฑฐ๋ฆฌ ์ธก์ • ๋ฐฉ๋ฒ•์€ ์•„๋ž˜์™€ ๊ฐ™์€ ์›๋ฆฌ๋ฅผ ๊ฐ€์ง„๋‹ค.

์˜์‚ฌ ๋žœ๋ค ์ฝ”๋“œ๋ฅผ ์‚ฌ๊ฐํ•จ์ˆ˜๋กœ ๋‚˜ํƒ€๋ƒˆ์„ ๋•Œ +1 ํ˜น์€ -1์˜ ์‹œ๊ฐ„ ๊ฐ„๊ฒฉ(chip)์„ , ์นฉ์˜ ์‹œ๊ฐ„ ํญ(chip width)๋ผ๊ณ  ํ•œ๋‹ค. ์œ„์„ฑ๊ณผ ์ˆ˜์‹ ๊ธฐ ์‚ฌ์ด์˜ PRN ์ฝ”๋“œ ์นฉ์˜ ๊ฐœ์ˆ˜๋ฅผ , ์ฆ‰ ์‹ ํ˜ธ๊ฐ€ ์ˆ˜์‹ ๋  ๋•Œ ๊ฐ€ ๋ช‡ ๊ฐœ ์žˆ์—ˆ๋Š”์ง€๋ฅผ ๋ผ ํ•˜์ž.

๊ทธ๋ ‡๋‹ค๋ฉด ๋น›์˜ ์†๋„๋ฅผ ๋ผ ํ•  ๋•Œ, (์—๋Ÿฌ๊ฐ€ ์—†๋‹ค ํ•˜๋ฉด) ์‹ค์ œ ๊ฑฐ๋ฆฌ ๋Š” ๊ฐ€ ๋œ๋‹ค. ๋Š” ๋ผ๊ณ ๋„ ํ•  ์ˆ˜ ์žˆ๋Š”๋ฐ ๋Š” Time of Arrival, ์ˆ˜์‹ ๊ธฐ๊ฐ€ ์‹ ํ˜ธ๋ฅผ ์ˆ˜์‹ ํ•œ ์‹œ๊ฐ์ด๋ฉฐ, ๋Š” Time of Departure, ์œ„์„ฑ์ด ์‹ ํ˜ธ๋ฅผ ๋ฐฉ์‚ฌํ•œ ์‹œ๊ฐ„์ด๋‹ค. ๋”ฐ๋ผ์„œ, ์œ„์„ฑ์—์„œ ๋ฐฉ์‚ฌํ•œ ์‹œ๊ฐ„์—์„œ ์ˆ˜์‹ ๊ธฐ๊ฐ€ ์ˆ˜์‹ ํ•œ ์‹œ๊ฐ„์˜ ์ฐจ์— ๋น›์˜ ์†๋„๋ฅผ ๊ณฑํ•˜๋ฉด ๊ฑฐ๋ฆฌ๊ฐ€ ๋œ๋‹ค.

1.2. ์˜์‚ฌ ๊ฑฐ๋ฆฌ ์˜ค์ฐจ

๊ทธ๋Ÿฌ๋‚˜ ์œ„์„ฑ์€ ๊ณ„์† ์›€์ง์ด๊ณ  ์ˆ˜์‹ ๊ธฐ๋งˆ๋‹ค ๊ฐ€์ง„ ์‹œ๊ณ„๊ณผ ์‹œ๊ณ„์˜ ์˜ค๋ฅ˜๊ฐ€ ์žˆ๋‹ค. ๋”ฐ๋ผ์„œ GPS์—์„œ์˜ ๊ฑฐ๋ฆฌ ๊ณ„์‚ฐ์€ ์ •ํ™•ํ•˜๊ฑฐ๋‚˜ ๊ฐ„๋‹จํ•˜์ง€ ์•Š๋‹ค.

ํŠน์ • ์‹œ๊ฐ์—์„œ ์œ„์„ฑ์˜ ์œ„์น˜๋ฅผ ๊ณ„์‚ฐํ•  ์ˆ˜๋Š” ์žˆ๋‹ค. ์œ„์„ฑ์ด ๋ฐฉ์‚ฌํ•˜๋Š” ๋ฉ”์‹œ์ง€ ์ค‘ ๊ถค๋„ ์ด๋ ฅ(ephemeris) ๋ฐ์ดํ„ฐ๊ฐ€ ์žˆ๋Š”๋ฐ, ์ด๋ฅผ ์ด์šฉํ•œ๋‹ค. ์ˆ˜์‹ ๊ธฐ๋Š” ์ž์‹ ์ด ๋ฐ›์€ ์‹ ํ˜ธ๊ฐ€ ์–ผ๋งˆ๋งŒํผ์˜ ์‹œ๊ฐ„์„ ๊ฑฐ์ณ ์ˆ˜์‹ ๋˜์—ˆ๋Š”์ง€ ๊ณ„์‚ฐํ•˜๊ณ , ์œ„์„ฑ์—์„œ ๋ฐฉ์‚ฌ๋œ ์‹œ๊ฐ„์„ ์—ญ์ถ”์ ํ•ด ์œ„์„ฑ์˜ ์œ„์น˜๋ฅผ ๊ตฌํ•  ์ˆ˜ ์žˆ๋‹ค. ๊ทธ๋Ÿฌ๋‚˜ ์ˆ˜์‹ ๊ธฐ ์‹œ๊ณ„ ์ž์ฒด์˜ ์˜ค์ฐจ๊ฐ€ ์žˆ๋‹ค๋ฉด ์— ์—๋Ÿฌ๋ฅผ ํฌํ•จํ•˜๋ฏ€๋กœ ๋ฌธ์ œ๊ฐ€ ๋œ๋‹ค.

์ด๋ฅผ ๋ณด์ •ํ•˜์—ฌ ์‚ฌ์šฉ์ž์™€ ์œ„์„ฑ ๊ฐ„ ์˜์‚ฌ๊ฑฐ๋ฆฌ (Pseudo-range), ์ฆ‰ ์‹œ๊ฐ ์˜ค์ฐจ๊ฐ€ ํฌํ•จ๋œ ๊ฑฐ๋ฆฌ๋ฅผ ๊ณ„์‚ฐํ•  ์ˆ˜ ์žˆ๋‹ค.

๋ฅผ m ๋‹จ์œ„์˜ ์‹œ๊ฐ(clock) ์—๋Ÿฌ์— ๋น›์˜ ์†๋„ ๋ฅผ ๊ณฑํ•œ ๊ฒƒ์ด๋ผ๊ณ  ํ•˜์ž. ์˜ˆ๋ฅผ ๋“ค์–ด, 1์ดˆ ์—๋Ÿฌ๋ผ๋ฉด ์ด๋ฏ€๋กœ ์ด๋‹ค. ์ด ๋ฅผ ๊ธฐ์กด์˜ ์ˆ˜์‹ ์— ๋”ํ•ด ์˜์‚ฌ๊ฑฐ๋ฆฌ ๋กœ ํ‘œํ˜„ํ•  ์ˆ˜ ์žˆ๋‹ค.

๋˜ ๋‹ค๋ฅด๊ฒŒ๋Š” ์œ„์„ฑ์˜ ์œ„์น˜์™€ ์ˆ˜์‹ ๊ธฐ์˜ ์œ„์น˜๋ฅผ ์œ ํด๋ฆฌ๋“œ ๊ฑฐ๋ฆฌ๋กœ ๊ตฌํ•จ์œผ๋กœ์จ ์˜์‚ฌ๊ฑฐ๋ฆฌ๋ฅผ ๊ตฌํ•  ์ˆ˜ ์žˆ๋‹ค. ์œ„์„ฑ์˜ ์œ„์น˜๋ฅผ ), ์ˆ˜์‹ ๊ธฐ์˜ ์œ„์น˜๋ฅผ ๋ผ๊ณ  ํ•  ๋•Œ ์ด๋‹ค.

1.3. ์˜์‚ฌ๊ฑฐ๋ฆฌ ๋ณด์ •

์ด๋ฒˆ์—” ๋ณด์ •์„ ์œ„ํ•œ ์‹์„ ์‚ดํŽด๋ณด์ž.

์‹ ์€ ์‹œ๊ฐ๊ณผ ์œ„์น˜์— ์˜ํ•œ ์˜ค์ฐจ๋ฅผ ๋‚˜ํƒ€๋‚ผ ๊ฒƒ์ด๋‹ค. ์ด๋ฅผ ํ™œ์šฉํ•  ๊ฒƒ์ด๋‹ค.

์œ„์น˜์— ์˜ํ•ด ๊ฑฐ๋ฆฌ๋ฅผ ๊ณ„์‚ฐํ•œ ์‹ ์„ ํ…Œ์ผ๋Ÿฌ ๊ธ‰์ˆ˜๋กœ ๋ฏธ๋ถ„ํ•˜๋ฉด, ๊ฐ€ ๋˜๊ณ , ์•„๋ž˜ ์‹์ฒ˜๋Ÿผ ์„ ํ˜•ํ™”๋œ ์‹์œผ๋กœ ๋‚˜ํƒ€๋‚ผ ์ˆ˜ ์žˆ๋‹ค. ์—ฌ๊ธฐ์„œ 'SV'๋Š” Setellite Vehicle์˜ ์•ฝ์ž๋กœ, ๋ถ„๋ชจ ํ•ญ์€ ๋ช‡ ๋ฒˆ์งธ ์œ„์„ฑ์˜ ์œ„์น˜์™€ ์œ ํด๋ฆฌ๋”” ๊ฑฐ๋ฆฌ ์ฐจ์ด์ธ์ง€๋ฅผ ๋‚˜ํƒ€๋‚ธ๋‹ค. Ephemeris ๋ฐ์ดํ„ฐ๋กœ๋ถ€ํ„ฐ ์œ„์„ฑ์˜ ์œ„์น˜๋ฅผ ๊ณ„์‚ฐํ•  ์ˆ˜ ์žˆ์œผ๋ฏ€๋กœ, ์ˆ˜์‹ ๊ธฐ์˜ ์œ„์น˜๋ฅผ ํŠน์ •ํ•œ๋‹ค๋ฉด ๋ถ„์ž ์—ญ์‹œ ์œ„์„ฑ๊ณผ ์ˆ˜์‹ ๊ธฐ์˜ ์œ„์น˜ ๊ฐ’์œผ๋กœ ๊ณ„์‚ฐํ•  ์ˆ˜ ์žˆ๋‹ค.

์„ ํ˜•ํ™”๋œ ์œ„ ์‹์„ ํ–‰๋ ฌ๋กœ ํ‘œ์‹œํ•˜๋ฉด ์•„๋ž˜์™€ ๊ฐ™๋‹ค.

์„ ํ˜•ํ™” ์‹์— Geometry Matrix์ธ g = ๋ฅผ ๊ณฑํ•˜๋ฉด, ์ˆ˜์‹ ๊ธฐ์˜ ์œ„์น˜์™€ ์‹œ๊ฐ ์˜ค์ฐจ ์„ฑ๋ถ„์„ ์ธก์ •๋œ ์˜์‚ฌ๊ฑฐ๋ฆฌ  ์—๋Ÿฌ ์„ฑ๋ถ„์ด ๋œ๋‹ค.

ํ•ด๋‹น ์‹์„ ๋ฐ˜๋Œ€๋กœ ์ƒ๊ฐํ•ด ๋ณด๋ฉด ์ˆ˜์‹ ๊ธฐ์œ„ ์‹ค์ œ ์œ„์น˜๋ฅผ ๋น„๊ต์  ์ •ํ™•ํ•˜๊ฒŒ ๊ตฌํ•  ์ˆ˜ ์žˆ๋‹ค.

์œ„ ์„ ํ˜•ํ™” ์‹์—์„œ Geometry Matrix๋งŒ ๋‚จ๊ธฐ๊ณ  ์•„๋ž˜์ฒ˜๋Ÿผ ์‹์„ ๋ฐ”๊พผ๋‹ค๋ฉด, ์˜์‚ฌ ๊ฑฐ๋ฆฌ์˜ ๋ณด์ •(์˜ค์ฐจ)๊ฐ’์— ์–ด๋–ค ํ–‰๋ ฌ์„ ๊ณฑํ–ˆ์„ ๋•Œ ์ˆ˜์‹ ๊ธฐ์˜ ์œ„์น˜์™€ ์‹œ๊ฐ์— ๋Œ€ํ•œ ๋ณด์ •๊ฐ’์œผ๋กœ ํ™˜์‚ฐ์ด ๋œ๋‹ค.

๊ฐ€์žฅ ๋จผ์ €, ์ดˆ๊ธฐ ์ˆ˜์‹ ๊ธฐ ์œ„์น˜๋ฅผ ํŠน์ •ํ•ด ๊ทธ๊ณณ์—์„œ ์œ„์„ฑ์˜ ์‹ ํ˜ธ๋“ค์„ ์ธก์ •ํ•ด  ์„ฑ๋ถ„์„ ์–ป๋Š”๋‹ค. ๊ทธ๋Ÿฐ ๋‹ค์Œ ๋กœ ๋ฅผ ์–ป์–ด ์ด๊ฒƒ์ด ๊ณง ํ•ด๋‹น ์œ„์น˜์™€ ์‹œ๊ฐ์— ๋Œ€ํ•œ ๋ณด์ • ์„ฑ๋ถ„์ด ๋œ๋‹ค. ์ด ๋ณด์ • ์„ฑ๋ถ„์„ ํ•ด๋‹น ์œ„์น˜์˜ ์‹ ํ˜ธ์— ๋”ํ•˜๋ฉด ์ƒˆ๋กœ์šด ์œ„์น˜์™€ ์‹œ๊ฐ์„ ์–ป๊ฒŒ ๋œ๋‹ค.

์ƒˆ ์œ„์น˜๋ฅผ ์–ป๊ฒŒ ๋˜์—ˆ์œผ๋ฏ€๋กœ ๊ทธ ์œ„์น˜์—์„œ์˜ ์œ„์„ฑ๊นŒ์ง€์˜ ๊ฑฐ๋ฆฌ๋„ ๋ฐ”๋€” ๊ฒƒ์ด๋‹ค. ๊ทธ๋Ÿผ ๋‹ค์‹œ ์œ ํด๋ฆฌ๋“œ ๊ฑฐ๋ฆฌ, ๋ฅผ ์ƒˆ๋กœ ์—…๋ฐ์ดํŠธํ•ด์•ผ ํ•˜๊ณ ,  ์ฐจ์ด๋กœ ๊ฐ€ ๊ตฌํ•ด์งˆ ์ˆ˜ ์žˆ๋‹ค.

๋กœ ๋‹ค์‹œ ๊ณต์‹์˜ ์ฒ˜์Œ์œผ๋กœ ๋Œ์•„๊ฐ€ Geometry Matrix์˜ ์—ญํ–‰๋ ฌ๊ณผ ๊ณฑํ•˜๋ฉด ๋‹ค์‹œ ์œ„์น˜์™€ ์‹œ๊ฐ์— ๋Œ€ํ•œ ๋ณด์ • ์„ฑ๋ถ„์„ ์–ป๊ฒŒ ๋˜๋Š” ๊ณผ์ •์ด ๋ฐ˜๋ณต๋œ๋‹ค. ์ด๋Ÿฐ ๊ณผ์ •์„ ๋ฐ˜๋ณตํ•˜๋‹ค๋ณด๋ฉด ์–ด๋А ์ˆœ๊ฐ„ ๊ฐ€ ๋งค์šฐ ์ž‘์•„์ ธ ์—…๋ฐ์ดํŠธ๊ฐ€ ๋ถˆํ•„์š”ํ•  ์‹œ์ ์ด ์˜จ๋‹ค. ํ†ต์ƒ์ ์œผ๋กœ 4ํšŒ ๋ฐ˜๋ณต ํ›„์— cm ๋‹จ์œ„๋กœ ์—…๋ฐ์ดํŠธ๋œ๋‹ค.

์œ„์™€ ๊ฐ™์€ ์„ ํ˜•ํ™”์™€ ๋น ๋ฅธ ๊ณ„์‚ฐ์„ ์‚ฌ์šฉํ•ด GPS ์ˆ˜์‹ ๊ธฐ๋Š” ๋น ๋ฅด๊ฒŒ ์œ„์น˜๋ฅผ ๊ณ„์‚ฐํ•  ์ˆ˜ ์žˆ๋‹ค.

์ฐธ๊ณ 

๋ฐ˜์‘ํ˜•