๋ณธ๋ฌธ์œผ๋กœ ๋ฐ”๋กœ๊ฐ€๊ธฐ
728x90

*์ธํ”„๋Ÿฐ <๊ฒŒ์ž„ ์—”์ง„์„ ์ง€ํƒฑํ•˜๋Š” ๊ฒŒ์ž„์ˆ˜ํ•™, ์ด๋“์šฐ ๊ต์ˆ˜๋‹˜> ๊ฐ•์˜๋ฅผ ๋“ฃ๊ณ  ๊ณต๋ถ€ํ•œ ๊ธ€์ž…๋‹ˆ๋‹ค.

 

 

 

1. ํšŒ์ „ ํ–‰๋ ฌ ๊ตฌํ˜„์—์„œ์˜ ๋ฌธ์ œ์ 

 

3์ฐจ์› ๊ณต๊ฐ„์—๋Š” ์„ธ ๊ฐœ์˜ ํ‘œ์ค€ ๊ธฐ์ € ๋ฒกํ„ฐ \(e_1\), \(e_2\), \(e_3\) ๊ฐ€ ์กด์žฌํ•ฉ๋‹ˆ๋‹ค. ์ด ์„ธ ๊ฐœ์˜ ๊ธฐ์ € ๋ฒกํ„ฐ๋ฅผ ํ†ตํ•ด ํšŒ์ „์„ ๊ตฌํ˜„ํ•˜๋ ค๋ฉด, ์„œ๋กœ ์ง๊ตํ•˜๊ณ  ์žˆ๋˜ ์›๋ž˜ ์ƒํƒœ๋ฅผ ๊ทธ๋Œ€๋กœ ์œ ์ง€ํ•œ ์ฑ„๋กœ ๋Œ์•„๊ฐ€์•ผ ํ•˜๊ณ , ๋ณ€ํ™”๋œ ๊ธฐ์ € ๋ฒกํ„ฐ๋“ค์ด ๊ฐ€์ง€๊ณ  ์žˆ๋Š” ๊ฐ’(\(x_{local}, \ y_{local}, \ z_{local}\)) ์„ ํ†ตํ•ด ํšŒ์ „ ํ–‰๋ ฌ์„ ๋งŒ๋“ค ์ˆ˜ ์žˆ์Šต๋‹ˆ๋‹ค.

 

 

๊ทธ๋Ÿฐ๋ฐ ์ด ๋ฐฉ๋ฒ•์€ ๋ถˆํŽธํ•œ ์ ์ด ์žˆ์Šต๋‹ˆ๋‹ค. ์˜ˆ๋ฅผ ๋“ค์–ด, ์šฐ๋ฆฌ๊ฐ€ ์–ด๋–ค ๋ฌผ์ฒด๋ฅผ Y์ถ•์œผ๋กœ 30๋„ ํšŒ์ „ํ•˜๊ณ  ์‹ถ๋‹ค๊ณ  ํ•  ๋•Œ, Y์ถ•์œผ๋กœ 30๋„ ํšŒ์ „ํ–ˆ์„ ๋•Œ์˜ ๊ฐ ๋กœ์ปฌ์ถ•์˜ ๊ฐ’์ด ์–ผ๋งˆ์ธ์ง€ ๊ตฌํ•ด์•ผ ํšŒ์ „์ด ๊ฐ€๋Šฅํ•˜๋‹ค๋Š” ์ด์•ผ๊ธฐ๊ฐ€ ๋ฉ๋‹ˆ๋‹ค. ๋‚˜๋Š” 30๋„ ํšŒ์ „ํ•œ ๊ฒฐ๊ณผ๋ฅผ ์–ป๊ณ  ์‹ถ์€๋ฐ, ๊ทธ๋Ÿฌ๊ธฐ ์œ„ํ•ด์„œ๋Š” 30๋„๋ฅผ ํšŒ์ „ํ–ˆ์„ ๋•Œ์˜ ๊ฐ’์„ ๊ตฌํ•ด์•ผ ํ•˜๋Š” ์ƒํ™ฉ์ธ ์…ˆ์ด์ง€์š”. ์ด๊ฒƒ์€ ๊ฐœ๋ฐœ์ž ์ž…์žฅ์—์„œ ๋งค์šฐ ๋ถˆํŽธํ•œ ๋ฐฉ์‹์ด ๋˜๊ฒ ์ง€์š”.

 

๋˜ํ•œ, ํ–‰๋ ฌ๋กœ ๊ด€๋ฆฌํ•˜๊ธฐ ๋•Œ๋ฌธ์— 9๊ฐœ์˜ ๋ฐ์ดํ„ฐ๊ฐ€ ์š”๊ตฌ๋˜์–ด ๊ณ„์‚ฐ๋Ÿ‰์ด ๋งŽ๋‹ค๋Š” ๋‹จ์ ๋„ ์กด์žฌํ•ฉ๋‹ˆ๋‹ค. ์ด๋Ÿฌํ•œ ๋‹จ์ ๋“ค๋กœ ์ธํ•ด ์ข€ ๋” ์ง๊ด€์ ์ด๊ณ  ํšจ์œจ์ ์ธ ๋ฐฉ๋ฒ•์ด ํ•„์š”ํ•ด์กŒ๋Š”๋ฐ, ์ด๋•Œ ๋งŽ์ด ์‚ฌ์šฉํ•˜๋Š” ๊ฒƒ์ด ์˜ค์ผ๋Ÿฌ ๊ฐ(Euler Angle) ๋ฐฉ์‹์ž…๋‹ˆ๋‹ค. 

 

 


2. ์˜ค์ผ๋Ÿฌ ๊ฐ(Euler Angle) ํ‘œํ˜„ ๋ฐฉ์‹

 

์˜ค์ผ๋Ÿฌ ๊ฐ ํ‘œํ˜„ ๋ฐฉ์‹์€ 3์ฐจ์› ๊ณต๊ฐ„์—์„œ \(x, \ y, \ z\) ๋กœ์ปฌ์ถ•์„ ์ค‘์‹ฌ์œผ๋กœ ํšŒ์ „ํ•œ ์ˆ˜์น˜๊ฐ’์„ ๊ธฐ์ž…ํ•˜๋Š” ๋ฐฉ์‹์ž…๋‹ˆ๋‹ค.

 

[์˜ˆ] ์œ ๋‹ˆํ‹ฐ ์—”์ง„

 

3์ฐจ์› ๊ณต๊ฐ„์„ ์ด๋ฃจ๋Š” ์„ธ ๊ธฐ์ € ์ถ• \(e_1(1, \ 0, \ 0), \ e_2(0, \ 1, \ 0), \ e_3(0, \ 0, \ 1)\) ์€ ๋‹น์—ฐํ•œ ์ •๋ณด๋“ค์ด๋ผ ์‚ฌ์‹ค์ƒ ํ•„์š”๊ฐ€ ์—†์Šต๋‹ˆ๋‹ค. ์ค‘์š”ํ•œ ๊ฒƒ์€ ๊ฐ ์ถ•๋งˆ๋‹ค ์–ผ๋งŒํผ์”ฉ ํšŒ์ „์„ ์‹œ์ผฐ๋Š”์ง€์— ๋Œ€ํ•œ ์–‘์ด์ง€์š”.

์ด๋Ÿฌํ•œ ๋ถ€๋ถ„์—์„œ ๋น„๋กฏ๋˜์–ด, ์ˆœ์„œ๋Œ€๋กœ ๋Œ๋ฆฐ ๊ฐ๋„์˜ ์ •๋ณด๋งŒ ์ €์žฅํ•˜๋ฉด 3์ฐจ์› ๊ณต๊ฐ„์—์„œ์˜ ํšŒ์ „์„ ๋‹ค์Œ๊ณผ ๊ฐ™์€ 3๊ฐœ์˜ ์ˆซ์ž๋กœ ํ‘œํ˜„ํ•  ์ˆ˜ ์žˆ๋‹ค๋Š” ๊ฒƒ์ด ๋ฐ”๋กœ ์˜ค์ผ๋Ÿฌ ๊ฐ ํ‘œํ˜„ ๋ฐฉ์‹์ž…๋‹ˆ๋‹ค.

 

$$ R = (\theta_x, \ \theta_y, \ \theta_z) $$

 

 

1) Yaw, Roll, Pitch

 

์œ ๋‹ˆํ‹ฐ ์—”์ง„์—์„œ๋Š” Vector3(\(x, \ y, \ z\))๋กœ ๊ด€๋ฆฌํ•˜๊ณ , ์–ธ๋ฆฌ์–ผ ์—”์ง„์—์„œ๋Š” Rotator๋ผ๋Š” ๊ตฌ์กฐ์ฒด์—์„œ yaw, roll, pitch๋ผ๋Š” ๊ฐ’์œผ๋กœ ๊ด€๋ฆฌํ•˜๊ณ  ์žˆ์Šต๋‹ˆ๋‹ค. ์œ ๋‹ˆํ‹ฐ ์—”์ง„ ๋ฐฉ์‹์€ ์ข€ ๋” ์ง๊ด€์ ์ด๋ผ ๋ฐ”๋กœ ์ดํ•ด๊ฐ€ ๊ฐ€๋Šฅํ•˜์ง€๋งŒ, ์–ธ๋ฆฌ์–ผ ์—”์ง„์—์„œ ๋งํ•˜๋Š” yaw, roll, pitch ๋ผ๋Š” ๊ฒƒ์€ ๋ฌด์—‡์„ ๋งํ•˜๋Š” ๊ฑธ๊นŒ์š”?

 

yaw, roll, pitch ๋Š” ๋น„ํ–‰๊ธฐ๊ฐ€ ํšŒ์ „ํ•˜๋Š” ๋ชจ์Šต์„ ํ† ๋Œ€๋กœ ์„ค๊ณ„๋œ ํšŒ์ „ ๋ฐฉ์‹์ž…๋‹ˆ๋‹ค. ํ•ญ๊ณตํ•™์—์„œ ์‹œ์ž‘ํ•ด, ์ง€๊ธˆ์€ ๊ฐ์ข… ๊ธฐ๊ณ„ ๊ณตํ•™ ๋ฐ ๊ฒŒ์ž„์—์„œ ๊ณตํ†ต์ ์œผ๋กœ ์‚ฌ์šฉํ•˜๊ณ  ์žˆ๋Š” ํšŒ์ „ ๋ฐฉ์‹์ด์ฃ . ์ด๋Ÿฌํ•œ ๊ณตํ†ต๋œ ํšŒ์ „ ๋ฐฉ์‹์„ ์‚ฌ์šฉํ•จ์œผ๋กœ์จ, ์ถ•์ด ์„œ๋กœ ๋‹ค๋ฅธ ํ”„๋กœ๊ทธ๋žจ๋“ค ๊ฐ„์— ํšŒ์ „ ์ธํ„ฐํŽ˜์ด์Šค๋ฅผ ์ œ์‹œํ•  ์ˆ˜ ์žˆ์Šต๋‹ˆ๋‹ค. 

 

์ถœ์ฒ˜ : Wikipedia

 

์ด๋Ÿฌํ•œ ๋ฐฉ์‹์˜ ํšŒ์ „์€ ์ •๋ฉด์—์„œ ํ•ด๋‹น ๋ฌผ์ฒด๋ฅผ ๋ดค์„ ๋•Œ๋ฅผ ๊ธฐ์ค€์œผ๋กœ ํ•˜์—ฌ, ๋‹ค์Œ๊ณผ ๊ฐ™์ด ๋ฌ˜์‚ฌํ•  ์ˆ˜ ์žˆ์Šต๋‹ˆ๋‹ค.

  • Yaw ํšŒ์ „  ๐Ÿ‘‰๐Ÿป  ํ—ฌ๋ฆฌ์ฝฅํ„ฐ ํ”„๋กœํŽ ๋Ÿฌ ํšŒ์ „
  • Roll ํšŒ์ „  ๐Ÿ‘‰๐Ÿป  ์ •๋ฉด์—์„œ ์›์„ ๊ทธ๋ฆฌ๋Š” ํšŒ์ „
  • Pitch ํšŒ์ „  ๐Ÿ‘‰๐Ÿป  ๊ณ ๊ฐœ๋ฅผ ๋„๋•์ด๋Š” ๋ฐฉํ–ฅ์˜ ํšŒ์ „

 

 

2) ์˜ค์ผ๋Ÿฌ ๊ฐ์˜ ์ ์šฉ ์ˆœ์„œ

 

์ด์ œ ํšŒ์ „ ๋ฐฉํ–ฅ์— ๋Œ€ํ•œ ๊ณตํ†ต ํ‘œ์ค€์€ ์žก์•˜์œผ๋‹ˆ, ์ด๊ฑธ ์–ด๋–ป๊ฒŒ ์ ์šฉํ•  ๊ฑด์ง€์— ๋Œ€ํ•ด ์‚ดํŽด๋ด์•ผ ํ•˜๋Š”๋ฐ์š”.

๊ทธ ์ „์— ์•Œ์•„์•ผ ํ•  ์ ์ด ์˜ค์ผ๋Ÿฌ ๊ฐ์€ ํ•œ ๋ฒˆ์— ์ผ์–ด๋‚˜๋Š” ํšŒ์ „์ด ์•„๋‹Œ, ๊ฐ ํ‘œ์ค€ ๊ธฐ์ € ๋ฒกํ„ฐ ์ถ•์„ ์ค‘์‹ฌ์œผ๋กœ ๋…๋ฆฝ์ ์œผ๋กœ ์ผ์–ด๋‚˜๋Š” ํšŒ์ „์ด๋ž€ ์ ์ž…๋‹ˆ๋‹ค. ์ฆ‰, ๊ฐ ์ถ•๋งˆ๋‹ค ํšŒ์ „์„ ํ•œ ๋ฒˆ์”ฉ ์ˆœ์„œ๋Œ€๋กœ ์ ์šฉํ•˜์—ฌ ์ตœ์ข… ํšŒ์ „ ๊ฒฐ๊ณผ๋ฌผ์„ ๋‚ธ๋‹ค๋Š” ์ด์•ผ๊ธฐ์ฃ .

 

$$ R = R_1 \cdot R_2 \cdot R_3 $$

 

์ด์— ๋”ฐ๋ผ, 3๊ฐ€์ง€ ์ถ•์— ๋Œ€ํ•ด ์–ด๋– ํ•œ ์ˆœ์„œ๋กœ ํšŒ์ „์„ ์ ์šฉํ•  ์ง€์— ๋”ฐ๋ผ ๋‹ค์Œ๊ณผ ๊ฐ™์€ 6๊ฐ€์ง€ ๊ฒฝ์šฐ์˜ ์ˆ˜๊ฐ€ ์ƒ๊น๋‹ˆ๋‹ค.

  • Yaw → Pitch → Roll
  • Yaw → Roll → Pitch
  • Pitch → Roll → Yaw
  • Pitch → Yaw → Roll
  • Roll → Yaw → Pitch
  • Roll → Pitch → Yaw

 

 

์ด ์ค‘์—์„œ ์œ ๋‹ˆํ‹ฐ ์—”์ง„๊ณผ ์–ธ๋ฆฌ์–ผ ์—”์ง„๋ฟ๋งŒ ์•„๋‹ˆ๋ผ, ๊ธฐํƒ€ ๋Œ€๋ถ€๋ถ„์˜ ์—”์ง„์—์„œ ์ฑ„ํƒํ•œ ์ˆœ์„œ๋Š” ๋‹ค์Œ๊ณผ ๊ฐ™์Šต๋‹ˆ๋‹ค.

*์™œ ๊ทธ๋Ÿฐ์ง€ ๊ถ๊ธˆํ•ด์„œ ์ฐพ์•„๋ดค๋Š”๋ฐ, ์ด๋Ÿฌํ•œ ๐Ÿ”—๊ธ€์ด ์žˆ๋”๊ตฐ์š”.

  • Roll → Pitch → Yaw
    (๋น„ํ–‰๊ธฐ์˜ ์ˆ˜ํ‰์„ ์žก๊ณ , ์œ„๋กœ ํ–ฅํ•œ ํ›„, ๋ฐฉํ–ฅ ์žก๊ธฐ)

 

 

 

 

3) ์˜ค์ผ๋Ÿฌ ๊ฐ์œผ๋กœ ํšŒ์ „ ํ–‰๋ ฌ๊ณผ ๋กœ์ปฌ ๋ฒกํ„ฐ ๊ตฌํ•˜๊ธฐ

 

*Y-up ์˜ค๋ฅธ์† ์ขŒํ‘œ๊ณ„ ๊ธฐ์ค€์ž…๋‹ˆ๋‹ค.

๊ฐ ํ‘œ์ค€ ๊ธฐ์ € ๋ฒกํ„ฐ์˜ ๋กœ์ปฌ ์ถ•์„ ์ค‘์‹ฌ์œผ๋กœ ํšŒ์ „ํ•œ ์–‘์„ ๊ธฐ์ž…ํ•˜๋Š” ๋ฐฉ์‹์ด ์˜ค์ผ๋Ÿฌ ๊ฐ์ด๋ผ๊ณ  ํ–ˆ์ง€๋งŒ, ๊ฒฐ๊ตญ ์ˆ˜๋งŽ์€ ์˜ค๋ธŒ์ ํŠธ๋“ค์— ๋Œ€ํ•ด ๋น ๋ฅด๊ณ  ํšจ์œจ์ ์ธ ๊ณ„์‚ฐ์„ ํ•˜๊ธฐ ์œ„ํ•ด์„œ๋Š” ํ–‰๋ ฌ์„ ์‚ฌ์šฉํ•ด์•ผ ํ•ฉ๋‹ˆ๋‹ค. ํšŒ์ „ ํ–‰๋ ฌ์„ ๋งŒ๋“ค๊ธฐ ์œ„ํ•ด, ๋จผ์ € ๊ฐ ์ถ•์— ๋Œ€ํ•œ ํšŒ์ „์„ ํ•œ ๋ฒˆ ์‚ดํŽด๋ณด์ฃ .

 

์šฐ์„  \(X\) ์ถ• ํšŒ์ „๋ถ€ํ„ฐ ๋ณด๊ฒ ์Šต๋‹ˆ๋‹ค. ์˜ค๋ฅธ์† ์ขŒํ‘œ๊ณ„์˜ +๋ฐฉํ–ฅ ํšŒ์ „์€ ํšŒ์ „์ถ•์„ ๊ธฐ์ค€์œผ๋กœ ๋ฐ˜์‹œ๊ณ„๋ฐฉํ–ฅ์ด๋ฏ€๋กœ, \(X\) ๋ฅผ ๋ฐฉํ–ฅ์œผ๋กœ ์˜ค๋ฅธ์† ์—„์ง€๋ฅผ ๋ป—์—ˆ์„ ๋•Œ, ๋‚˜๋จธ์ง€ ๋„ค ์†๊ฐ€๋ฝ์ด ๊ฐ๊ธฐ๋Š” ๋ฐฉํ–ฅ์ด +\(Y\) ์ถ•์—์„œ +\(Z\) ์ถ•์ž…๋‹ˆ๋‹ค.

 

x์ถ• ํšŒ์ „

 

์ด๋Ÿฌํ•œ ๋‚ด์šฉ์„ ํ† ๋Œ€๋กœ, \(X\) ์ถ• ํšŒ์ „์— ๋Œ€ํ•œ ํ–‰๋ ฌ์€ ๋‹ค์Œ๊ณผ ๊ฐ™์ด ์„ค๊ณ„ํ•  ์ˆ˜ ์žˆ์Šต๋‹ˆ๋‹ค.

 

$$ R_x=\left[\begin{matrix}1&0&0\\0&cos\theta&-sin\theta\\0&sin\theta&cos\theta\\\end{matrix}\right] $$

 

\(Y\) ์ถ•๋„ ๋˜‘๊ฐ™์€ ๋ฐฉ์‹์œผ๋กœ ๋งŒ๋“ค ์ˆ˜ ์žˆ์Šต๋‹ˆ๋‹ค.

 

y์ถ• ํšŒ์ „

 

$$ R_y=\left[\begin{matrix}cos\theta&0&sin\theta\\0&1&0\\-sin\theta&0&cos\theta\\\end{matrix}\right]\\ $$

 

๋งˆ์ง€๋ง‰์œผ๋กœ \(Z\) ์ถ•์— ๋Œ€ํ•œ ํšŒ์ „์€ 2์ฐจ์› ๊ณต๊ฐ„์—์„œ ์ต์ˆ™ํ•˜๊ฒŒ ํ–ˆ๋˜, ํšŒ์ „ ๋ณ€ํ™˜์ž…๋‹ˆ๋‹ค.

 

 

$$ R_z=\left[\begin{matrix}cos\theta&-sin\theta&0\\sin\theta&cos\theta&0\\0&0&1\\\end{matrix}\right] $$

 

์ด์ œ ์ด 3๊ฐœ์˜ ํ–‰๋ ฌ์„ ํ†ตํ•ด ํšŒ์ „ ํ–‰๋ ฌ์„ ๋งŒ๋“ค์–ด ๋ณด๊ฒ ์Šต๋‹ˆ๋‹ค.

Y-up ์˜ค๋ฅธ์† ์ขŒํ‘œ๊ณ„๋Š” \(X\) ๊ฐ€ Pitch ํšŒ์ „์ถ•, \(Y\) ๊ฐ€ Yaw ํšŒ์ „์ถ•, \(Z\) ๊ฐ€ Roll ํšŒ์ „์ถ•์ด ๋ฉ๋‹ˆ๋‹ค. ๊ทธ๋ฆฌ๊ณ , ์•„๊นŒ ์œ„์—์„œ ์ˆ˜๋งŽ์€ ์—”์ง„๋“ค์ด Roll → Pitch → Yaw ์ˆœ์„œ๋กœ ์ ์šฉํ•œ๋‹ค๊ณ  ํ–ˆ์—ˆ์ฃ ?.
Yaw, Pitch, Roll์˜ ํšŒ์ „๊ฐ์„ ๊ฐ๊ฐ \(\alpha, \ \beta, \ \gamma\) ๋ผ๊ณ  ํ•˜๋ฉด, ๋‹ค์Œ๊ณผ ๊ฐ™์€ 3์ฐจ์› ํšŒ์ „ ํ–‰๋ ฌ \(R\) ์ด ์™„์„ฑ๋ฉ๋‹ˆ๋‹ค!

 

$$ R_\alpha\cdot\ R_\beta\cdot\ R_\gamma=\left[\begin{matrix}cos\alpha&0&sin\alpha\\0&1&0\\-sin\alpha&0&cos\alpha\\\end{matrix}\right]\left[\begin{matrix}1&0&0\\0&cos\beta&-sin\beta\\0&sin\beta&cos\beta\\\end{matrix}\right]\left[\begin{matrix}cos\gamma&-sin\gamma&0\\sin\gamma&cos\gamma&0\\0&0&1\\\end{matrix}\right] $$

 

$$ \therefore R=\left[\begin{matrix}cos\alpha cos\gamma+sin\alpha sin\beta sin\gamma&-cos\alpha sin\gamma+sin\alpha sin\beta cos\gamma&sin\alpha cos\beta\\cos\beta sin\gamma&cos\beta cos\gamma&-sin\beta\\-sin\alpha cos\gamma+cos\alpha sin\beta sin\gamma&sin\alpha sin\gamma+cos\alpha sin\beta cos\gamma&cos\alpha cos\beta\\\end{matrix}\right] $$

 

 

์ด๋ ‡๊ฒŒ ๊ตฌํ•œ ํšŒ์ „ ํ–‰๋ ฌ์€ 3์ฐจ์› ๊ณต๊ฐ„์˜ ํšŒ์ „ ํ–‰๋ ฌ๊ณผ ๋™์ผํ•˜๋ฏ€๋กœ, ์œ„ ์‹์œผ๋กœ๋ถ€ํ„ฐ ๊ฐ๊ฐ์˜ ๋กœ์ปฌ ๋ฒกํ„ฐ๋ฅผ ์–ป์„ ์ˆ˜ ์žˆ์Šต๋‹ˆ๋‹ค.

  • \(x_{local}=(cos\alpha\ cos\gamma+sin\alpha\ sin\beta\ sin\gamma, \ cos\beta\ sin\gamma, \ -sin\alpha\ cos\gamma+cos\alpha\ sin\beta\ sin\gamma) \)
  • \( y_{local}=(-cos\alpha\ sin\gamma+sin\alpha\ sin\beta\ cos\gamma, \ cos\beta\ cos\gamma, \ sin\alpha\ sin\gamma+cos\alpha\ sin\beta\ cos\gamma) \)
  • \( z_{local}=(sin\alpha\ cos\beta, \ -sin\beta, \ cos\alpha\ cos\beta) \)

 

 


3. ์˜ค์ผ๋Ÿฌ ๊ฐ์˜ ๋ฌธ์ œ์ 

 

1) ์ง๋ฒŒ๋ฝ(Gimbal-Lock) ํ˜„์ƒ

 

์˜ค์ผ๋Ÿฌ ๊ฐ์€ 3๊ฐœ์˜ ์ถ•์— ๋Œ€ํ•ด ๊ฐ๊ฐ ํšŒ์ „์„ ๋‚˜๋ˆ„์–ด ์ ์šฉํ•˜๊ธฐ ๋•Œ๋ฌธ์—, ์ด์ „์— ํšŒ์ „ํ–ˆ๋˜ ๊ฒฐ๊ณผ์— ๋”ฐ๋ผ ์ง€๊ธˆ ํšŒ์ „ํ•œ ๊ฒฐ๊ณผ ๋ชจ์Šต์ด ๋‹ฌ๋ผ์ง‘๋‹ˆ๋‹ค. ์ฆ‰, ๊ฐ ์ถ•๋“ค์€ ์„œ๋กœ ๋…๋ฆฝ์ด ์•„๋‹Œ ์ข…์† ๊ด€๊ณ„์— ์žˆ๋‹ค๋Š” ์†Œ๋ฆฌ์ฃ . ์ข…์† ๊ด€๊ณ„์— ์žˆ๊ธฐ ๋•Œ๋ฌธ์—, ํ•œ ์ถ•์„ ํšŒ์ „ํ•ด๋„ ๋‹ค๋ฅธ ์ถ•๋„ ๋ฉ๋‹ฌ์•„ ํšŒ์ „ํ•˜๊ฒŒ ๋˜๋Š” ๊ฒƒ์ž…๋‹ˆ๋‹ค.

 

๊ทธ๋ ‡๊ธฐ์— ๊ฐ ์ถ•์— ๋Œ€ํ•ด ํšŒ์ „์„ ์ง„ํ–‰ํ•˜๋‹ค ๋ณด๋ฉด, ์–ด๋Š ์ˆœ๊ฐ„ ๋‘ ๊ฐœ ํ˜น์€ ์„ธ ๊ฐœ์˜ ์ถ•์ด ๊ฒน์น˜๊ฒŒ ๋˜์–ด ํšŒ์ „๊ฐ์ด ์†Œ์‹ค๋˜๋Š” ์ƒํ™ฉ์ด ๋ฐœ์ƒํ•ฉ๋‹ˆ๋‹ค. ์ด๊ฒƒ์„ ์ง๋ฒŒ๋ฝ(Gimbal-Lock) ํ˜„์ƒ์ด๋ผ๊ณ  ๋ถ€๋ฆ…๋‹ˆ๋‹ค.

 

์ง๋ฒŒ๋ฝ ํ˜„์ƒ (์ถœ์ฒ˜ : Wikipedia)

 

์ด๋Ÿฌํ•œ ์ง๋ฒŒ๋ฝ ํ˜„์ƒ์€ ์–ธ์ œ ์ •ํ™•ํžˆ ๋ฐœ์ƒํ•˜๋Š”์ง€ ์•Œ์•„๋‚ด๊ธฐ๊ฐ€ ๊นŒ๋‹ค๋กญ๊ธฐ ๋•Œ๋ฌธ์—, ์ด๋Ÿฌํ•œ ๋ฌธ์ œ๋ฅผ ์˜ˆ๋ฐฉํ•˜๊ธฐ ์œ„ํ•ด ๋ฐฉ์–ด ์ฝ”๋“œ๋ฅผ ์ž‘์„ฑ ํ•˜๋Š” ๋ฐ์—๋„ ํ•œ๊ณ„๊ฐ€ ์žˆ์Šต๋‹ˆ๋‹ค. ์ด์— ๋”ฐ๋ผ, ํšŒ์ „์„ ์•ˆ์ „ํ•˜๊ฒŒ ๊ตฌํ˜„ํ•  ์ˆ˜๊ฐ€ ์—†๋‹ค๋Š” ํฐ ๋‹จ์ ์ด ์กด์žฌํ•˜๊ฒŒ ๋˜๋Š” ๊ฒƒ์ด์ฃ .

 

 

2) ํšŒ์ „์˜ ๋ณด๊ฐ„ ๊ณ„์‚ฐ

 

ํšŒ์ „ํ•˜๋Š” ์• ๋‹ˆ๋ฉ”์ด์…˜์ด ์žˆ๋‹ค๊ณ  ํ•œ๋‹ค๋ฉด, ํšŒ์ „์˜ ์‹œ์ž‘๊ณผ ๋ ํ‚ค ํ”„๋ ˆ์ž„์„ ์ง€์ •ํ•˜๊ณ , ์‹œ๊ฐ„์— ๋”ฐ๋ผ ์„œ์„œํžˆ ๋ณด๊ฐ„ํ•˜๋Š” ๊ธฐ๋Šฅ์ด ํ•„์š”ํ•˜๊ฒŒ ๋ฉ๋‹ˆ๋‹ค. ์ด์— ๋Œ€ํ•ด, ์˜ค์ผ๋Ÿฌ ๊ฐ์€ ํ•œ ์ถ•์˜ ํšŒ์ „๋งŒ ์‚ฌ์šฉํ•˜๋Š” ๊ฒฝ์šฐ์—๋Š” ๋ณด๊ฐ„์ด ๊ฐ€๋Šฅํ•ฉ๋‹ˆ๋‹ค.

๋‹ค์Œ๊ณผ ๊ฐ™์ด 3๊ฐœ์˜ ์˜ค์ผ๋Ÿฌ ๊ฐ ํšŒ์ „์ด ์žˆ๋‹ค๊ณ  ํ•˜๋ฉด,

 

$$ R_1 = (0º, \ 15º, \ 0º) $$

$$ R_2 = (0º, \ 30º, \ 0º) $$

$$ R_3 = (0º, \ 45º, \ 0º) $$

 

๊ทธ๋Ÿฐ๋ฐ Y์ถ•์œผ๋กœ "15๋„ ํšŒ์ „ + 30๋„ ํšŒ์ „"ํ•œ ๊ฒฐ๊ณผ๋ฌผ์ด๋‚˜, ์ฒ˜์Œ๋ถ€ํ„ฐ 45๋„๋ฅผ ํšŒ์ „ํ•œ ๊ฒฐ๊ณผ๋Š” ๊ฐ™์Šต๋‹ˆ๋‹ค. ์ด๋ฅผ ํ†ตํ•ด, ์ง๊ด€์ ์œผ๋กœ ๋‹ค์Œ์˜ ์‹์ด ์„ฑ๋ฆฝํ•จ์„ ์•Œ ์ˆ˜ ์žˆ์Šต๋‹ˆ๋‹ค.

 

$$ R_3 = R_2 \cdot R_1 $$

 

์ˆ˜์‹์œผ๋กœ๋„ ์ฆ๋ช…ํ•  ์ˆ˜ ์žˆ๋Š”๋ฐ, ํšŒ์ „ ํ–‰๋ ฌ์˜ ๊ฐ ์š”์†Œ๋ฅผ ํ’€์–ด์“ฐ๋ฉด ๋‹ค์Œ๊ณผ ๊ฐ™๊ธฐ ๋•Œ๋ฌธ์ž…๋‹ˆ๋‹ค.

Yaw ํšŒ์ „๋งŒ ์ง„ํ–‰๋˜๊ธฐ ๋•Œ๋ฌธ์—, ๋‚˜๋จธ์ง€ Roll๊ณผ Pitch ํšŒ์ „์€ ํ•ญ๋“ฑ ํ–‰๋ ฌ \(I\) ๋กœ ์“ธ ์ˆ˜ ์žˆ์Šต๋‹ˆ๋‹ค.

 

$$ R_{yaw3} \cdot I \cdot I = (R_{yaw2} \cdot I \cdot I) \cdot (R_{yaw1} \cdot I \cdot I) $$

$$ \rightarrow \ R_3 = R_2 \cdot R_1 $$

$$ \therefore \theta_3 = \theta_2 + \theta_1 $$

 

ํ•˜์ง€๋งŒ ๋‹ค์Œ๊ณผ ๊ฐ™์ด ๋‘ ์ถ•์˜ ํšŒ์ „์„ ์‚ฌ์šฉํ•˜๋ฉด, ์œ„์˜ ์‹์€ ๋” ์ด์ƒ ์‚ฌ์šฉํ•  ์ˆ˜ ์—†๊ฒŒ ๋ฉ๋‹ˆ๋‹ค.

 

$$ R_1 = (0º, \ 15º, \ 15º) $$

$$ R_2 = (0º, \ 30º, \ 30º) $$

$$ R_3 = (0º, \ 45º, \ 45º) $$

 

$$ R_{yaw3}\cdot I\cdot R_{roll3}\ne  R_{yaw2}\cdot I\cdot R_{roll2}\cdot R_{yaw1}\cdot I\cdot R_{roll1} $$

$$ \therefore R_3\ne R_2\cdot R_1 $$

 

์œ„ ์‹์ด ๋™์ผํ•˜๋ ค๋ฉด ๊ฐ™์€ ์ฐจ์›์˜ ๊ฐ์ด ์„œ๋กœ ์ด์–ด์ ธ ์žˆ์–ด์•ผ ํ•ฉ๋‹ˆ๋‹ค. ํ•˜์ง€๋งŒ ์œ„ ์‹์€ Yaw์™€ Roll ํšŒ์ „์ด ์„œ๋กœ ๋ฒˆ๊ฐˆ์•„๊ฐ€๋ฉฐ ๋ฐฐ์น˜๋˜์–ด ์žˆ์–ด ์„œ๋กœ ๋‹ค๋ฅธ ์ถ•์„ ํ†ตํ•ด ํšŒ์ „ํ•˜๊ธฐ์— ๋™์ผํ•˜๋‹ค๊ณ  ๋ณด์žฅํ•  ์ˆ˜๊ฐ€ ์—†์Šต๋‹ˆ๋‹ค.

 

๋”ฐ๋ผ์„œ, ๋‘ ์ถ• ์ด์ƒ์˜ ํšŒ์ „์œผ๋กœ ์ง€์ •๋œ ์˜ค์ผ๋Ÿฌ ๊ฐ์œผ๋กœ๋Š” ๋ณด๊ฐ„ํ•˜๋Š” ๋ฐฉ๋ฒ•์ด ์˜คํžˆ๋ ค ๋ณต์žกํ•ด์ง€๊ธฐ์—, ์ด ๋•Œ๋Š” 3์ฐจ์› ๊ณต๊ฐ„์—์„œ ์ถ•๊ฐ ๋ฐฉ์‹์˜ ํšŒ์ „ ๋ฐฉ๋ฒ•์„ ์‚ฌ์šฉํ•ด์•ผ ํ•ฉ๋‹ˆ๋‹ค. ์ถ•๊ฐ ๋ฐฉ์‹์€ ์ž„์˜์˜ ์ถ•์„ ์ง€์ •ํ•˜๊ณ , ํ•ด๋‹น ์ถ•์„ ํ†ตํ•ด ์‹œ์ž‘ ํšŒ์ „๊ณผ ๋ ํšŒ์ „์„ ์ง€์ •ํ•˜๋Š” ๋ฐฉ์‹์ž…๋‹ˆ๋‹ค. ๋Œ€ํ‘œ์ ์œผ๋กœ ๋กœ๋“œ๋ฆฌ๊ฒŒ์Šค ํšŒ์ „ ๋ฐฉ์‹๊ณผ ์‚ฌ์›์ˆ˜๊ฐ€ ์žˆ์Šต๋‹ˆ๋‹ค.

 

 

728x90
๋ฐ˜์‘ํ˜•