2. ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ๊ธฐ์ค ๋์ญํ ๋ชจ๋ธ๊ณผ ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง ๋์ญํ ๋ชจ๋ธ
์ด ์ฅ์์๋ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ๊ธฐ์ค ๋์ญํ ๋ชจ๋ธ๊ณผ ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง ๋์ญํ ๋ชจ๋ธ์ ์ป๋๋ค. ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ๊ธฐ์ค ๋์ญํ ๋ชจ๋ธ์ ์ํ์ ์ผ๋ก ํํ๋๋ ๋์ญํ
๋ชจ๋ธ๋ก ๋ด๋ถ์ ๋ง์ ํ๋ผ๋ฏธํฐ๋ฅผ ํฌํจํ๊ณ ์๋ค. ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง ๋์ญํ ๋ชจ๋ธ์ ์ค์ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ์
์ถ๋ ฅ ๋ฐ์ดํฐ๋ฅผ ํตํด ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง์ ํ์ตํ์ฌ ์ป์์ผ๋ก์จ
๊ธฐ์ค ๋์ญํ ๋ชจ๋ธ์ ์ ๋ชจ์ฌํ ์ ์๋ ๋์ญํ ๋ชจ๋ธ์ด๋ค.
2.1 ์ ๋ฐฉํฅ ์ด๋๋ก๋ด ๊ธฐ์ค ๋์ญํ ๋ชจ๋ธ
์ํ์ ์ผ๋ก ํํํ ์ ์๋ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ๊ธฐ์ค ๋์ญํ ๋ชจ๋ธ์ ์ค๊ณํ๋ค. ๊ทธ๋ฆผ 1์ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ๋ชจ๋ธ์ ๋ํ๋ด๋ฉฐ ์ค๊ณํ๊ณ ์ํ๋ ๋์ญํ ๋ชจ๋ธ์ ์์คํ
์ด๋ค.
๊ทธ๋ฆผ. 1. ์ ๋ฐฉํฅ ์ด๋๋ก๋ด ๋ชจ๋ธ
Fig. 1. Omnidirectional mobile robot model
๊ตฌ๋๊ธฐ ๋ถ๋ถ์ ์ด 3๊ฐ($F_{1}$, $F_{2}$, $F_{3}$)๋ก ๊ตฌ์ฑ๋์ด ์๊ณ ๊ฐ ๊ตฌ๋๊ธฐ์๋ ์ ๋ฐฉํฅ ํ ์ด ์ฅ์ฐฉ๋์ด ์ ๋ฐฉํฅ ๊ตฌ๋์ด ๊ฐ๋ฅํ๊ฒ
๋๋ค. ๊ทธ๋ฌ๋ ๋ก๋ด ์์คํ
์ ๊ตฌ๋๊ธฐ๋ DC ๋ชจํฐ๋ฅผ ๋ง์ด ์ฌ์ฉํ๊ธฐ ๋๋ฌธ์ ์ค์ ์
๋ ฅ์ ๊ตฌ๋๊ธฐ์ ์
๋ ฅ์ธ ์ ์์ด ๋๋ค. ๊ตฌ๋๊ธฐ๋ฅผ ๊ณ ๋ คํ ๋์ญํ ๋ชจ๋ธ์ ์ป๊ธฐ
์ํด์๋ ๊ตฌ๋๊ธฐ ๋์ญํ์ ํฌํจํ์ฌ ์ ์ฒด ์์คํ
์ ๋์ญํ ๋ชจ๋ธ๋ง์ด ํ์ํ๋ค. ๋ณธ ๋
ผ๋ฌธ์์๋ ๊ตฌ๋๊ธฐ ๋์ญํ์ ํฌํจํ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ๋์ญํ ๋ชจ๋ธ์ ๋ค๋ฃฌ๋ค.
์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ๊ฒฌ์ธ๋ ฅ์ ๋ฐฉํฅ์ผ๋ก์ ๋ฐํด ๋ฏธ๋๋ฌ์ง์ด ์๊ณ , ๋ฐํด๋ค์ด ๋ฐ๋ฅ๊ณผ ์ ์ดํ์ฌ ๋ฐ์ํ๋ ๋ง์ฐฐ๋ ฅ์ ๊ฐ ๋ฐํด์ ๊ฒฌ์ธ๋ ฅ์ ๋ฐฉํฅ์ผ๋ก๋ง ์์ฉํ๋ค๊ณ ๊ฐ์ ํ์ฌ,
(11)์์ ์ ๋๋ ๊ตฌ๋๊ธฐ์ ๋์ญํ์ ํฌํจํ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ๊ธฐ์ค ๋์ญํ ์์ ๋ค์๊ณผ ๊ฐ๋ค.
์ฌ๊ธฐ์ $G=I+HBB^{T}\dfrac{n^{2}J_{0}}{R^{2}}$์ด๊ณ , ํ๋ ฌ $H$์ $B$๋ ๊ฐ๊ฐ
$u$, $v$์ ๊ฐ๊ฐ ๋ก๋ด ํ๋ ์์ $x$, $y$ ๋ฐฉํฅ์ผ๋ก์ ์๋, $r$์ ํ์ ์๋, $m$์ ๋ก๋ด์ ์ง๋, $I_{z}$๋ ๋ก๋ด์ ๊ด์ฑ๋ชจ๋ฉํธ,
$R$์ ๋ฐํด์ ๋ฐ์ง๋ฆ์ด๋ค. ๋ํ ๊ตฌ๋๊ธฐ ๋ด๋ถ์ ๋ง์ ํ๋ผ๋ฏธํฐ๋ฅผ ํฌํจํ๊ณ ์๋๋ฐ, $E:=[E_{1},\: E_{2},\: E_{3}]^{T}$๋
๋ชจํฐ์ ์ธ๊ฐํ๋ ์ ์, $n$๋ ๋ชจํฐ์ ๊ธฐ์ด๋น, $R_{a}$๋ ๋ชจํฐ ๋ด๋ถ์ ์ ๊ธฐ์ ์ ํญ, $J_{0}$๋ ๋ชจํฐ์ ๋ฐํด๊น์ง์ ๊ด์ฑ๋ชจ๋ฉํธ, $b_{0}$๋
์ ์ฑ ๋ง์ฐฐ๊ณ์, $k_{2}$์ $k_{3}$๋ ๊ฐ๊ฐ ๋ชจํฐ ํ ํฌ์์์ ์ญ๊ธฐ์ ๋ ฅ ์์์ด๋ค. ์(1)์ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ๋์ญํ ๋ชจ๋ธ์ ๊ธฐ์ค ๋์ญํ ๋ชจ๋ธ๋ก ์ ์ ํ๊ณ ์ด๋ฅผ ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง์ผ๋ก ์ป์ ๋์ญํ ๋ชจ๋ธ๊ณผ ๋น๊ตํ๋ค.
๊ธฐ์ค ๋์ญํ ๋ชจ๋ธ์์ ๋ก๋ด์ ๋ฌด๊ฒ, ๋ฐํด ๋ฐ์ง๋ฆ ๋ฑ ์ค์ ๋ก ์ธก์ ๊ฐ๋ฅํ ํ๋ผ๋ฏธํฐ๊ฐ ์๋ ๋ฐ๋ฉด์ ์ง์ ์ธก์ ์ด ์ด๋ ค์ด ๋ชจํฐ ์์, ๊ด์ฑ๋ชจ๋ฉํธ ๋ฑ์ ๋ชจํฐ
์๋ณ๊ณผ ๋์ญํ ๋ชจ๋ธ ์๋ณ์ ํตํด ๊ตฌํด์ผ ํ๋ค. ๊ทธ๋ฌ๋ ์๋ณ์ ํตํด ์ป์ ํ๋ผ๋ฏธํฐ๋ ๋ก๋ด์ ๊ตฌ๋ํ๋ฉด์ ์ ์ฐจ ์ค์ ๋ก๋ด๊ณผ ๋ง์ง ์์ ๊ฒฝ์ฐ๊ฐ ๋ฐ์ํ ์
์์ผ๋ฏ๋ก ์ ํํ ๋์ญํ ํ๋ผ๋ฏธํฐ๋ค์ ์ป๊ธฐ ์ํด์๋ ์ฃผ๊ธฐ์ ์ผ๋ก ๋์ญํ ํ๋ผ๋ฏธํฐ๋ค์ ์์ ํ ํ์๊ฐ ์๊ณ ์๋ณ๊ณผ์ ๋ํ ๋งค์ฐ ์ด๋ ค์ธ ์ ์๋ค. ๋ค์ ํ 1์์๋ ๋ณธ ๋
ผ๋ฌธ์์ ๋ค๋ฃฐ ๊ธฐ์ค ๋์ญํ ๋ชจ๋ธ์ ํ๋ผ๋ฏธํฐ๋ฅผ ๋ํ๋ธ๋ค.
ํ 1. ๊ธฐ์ค ๋์ญํ ๋ชจ๋ธ์ ํ๋ผ๋ฏธํฐ๋ค
Table 1. Parameters of reference dynamics
์ ๋ฐฉํฅ ์ด๋๋ก๋ด ๊ธฐ์ค ๋์ญํ ๋ชจ๋ธ์ ํ๋ผ๋ฏธํฐ [๋จ์]
|
$m = 0.85[kg]$, $I_{z}= 0.4138[kgm^{2}]$, $L = 0.225[m]$, $n = 20$,
$R_{a}= 0.74[\Omega]$, $k_{3}= 0.02[Vs/rad]$, $k_{2}= 0.02[Nm/A]$,
$J_{0}= 9.38\times 10^{-6}[kgm^{2}]$, $b_{0}= 1.10\times 10^{-6}[kg^{2}/s]$, $R =
0.03[m]$
|
2.2 ์ ๋ฐฉํฅ ์ด๋๋ก๋ด ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง ๋์ญํ ๋ชจ๋ธ
๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง์ ๋
ธ๋๋ผ๊ณ ํํํ๋ ์ธ๊ณต ๋ด๋ฐ์ด ์ธต์ ์์ ๊ตฌ์ฑํ๊ฒ ๋๊ณ ์ด๋ฌํ ์ธต๋ค์ด ๋ชจ์ฌ ์ ๊ฒฝ๋ง์ ๊ตฌ์ฑํ๋ ํํ๋ฅผ ๊ฐ์ง๋ค. ํ๋์ ์ธ๊ณต ๋ด๋ฐ์ ๋ํ์ฌ
์ํ์ ์ผ๋ก ํํํ๋ฉด ๋ค์๊ณผ ๊ฐ๋ค.
์ฌ๊ธฐ์ $U$์ $Y$๋ ๊ฐ๊ฐ ์
๋ ฅ๊ณผ ์ถ๋ ฅ ๋ฒกํฐ์ด๊ณ , $W^{T}$๋ ๊ฐ์ค์น ๋ฒกํฐ, $bias$๋ ๋
ธ๋์ ๋ถ์ด์๋ ์์์ด๋ค. ์ด ๊ณผ์ ์ ๊ทธ๋ฆผ์ผ๋ก ํํํ๋ฉด
๊ทธ๋ฆผ 2์ ๊ฐ๋ค.
๊ทธ๋ฆผ. 2. ์ธ๊ณต ๋ด๋ฐ์ ์ํ์ ๋ชจ๋ธ
Fig. 2. athematical model of artificial neurons
(12)์์๋ ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง์ด ๊ฐ์ง๋ 3๊ฐ์ง ํน์ฑ์ ๋ค์๊ณผ ๊ฐ์ด ์ค๋ช
ํ๋ค. ์ฒซ ๋ฒ์งธ๋ ๋น์ ํ์ ์ธ ์
๋ ฅ๊ณผ ์ถ๋ ฅ์ ๋ํด ๋งคํํ ์ ์๋ค. ๋น์ ํ ์์คํ
์ ๊ฒฝ์ฐ
๊ทธ ์์คํ
์ด ๋ณต์กํ์ฌ ์
์ถ๋ ฅ ๊ด๊ณ๋ฅผ ํํํ๊ธฐ ์ด๋ ค์ธ ์ ์์ง๋ง, ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง์ผ๋ก ์
์ถ๋ ฅ ๊ด๊ณ๋ฅผ ๋น๊ต์ ์ ํํ ํํ๊ฐ๋ฅํ๋ค. ๋ ๋ฒ์งธ๋ ์ ์์ ํ์ต๋ฅ๋ ฅ์ด
์๋ค. ์
์ถ๋ ฅ ์ ๋ณด๋ฅผ ๊ฐ์ง๊ณ ์ด๊ธฐ์๋ ๋ถ์ ํํ ๊ด๊ณ๋ฅผ ์ป์ง๋ง ์ ์ฐจ ํ์ต์ ํตํด ์ ์์ ์ผ๋ก ์
์ถ๋ ฅ ๊ด๊ณ๋ฅผ ํ์ฑํด์ค๋ค. ์ธ ๋ฒ์งธ๋ ์ผ๋ฐํ ๋ฅ๋ ฅ์ ๊ฐ์ง๋ค.
ํ์ต ๋ฐ์ดํฐ๋ฅผ ๊ฐ์ง๊ณ ํ์ต์ ์ํจ ํ ํ์ต ๋ฐ์ดํฐ ์ด์ธ์ ์
๋ ฅ์ ๋ณด์ ๋ํด์๋ ๋ณด๋ค ์ ํํ ์ถ๋ ฅ ๊ฐ์ ์ป์ ์ ์๋ค. ๋ฐ๋ผ์ ์ด๋ฌํ ํน์ฑ์ ๋ฐํ์ผ๋ก
๋ณต์กํ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ๋์ญํ ๋ชจ๋ธ์ ๋ํด์๋ ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง์ ํตํด ๋์ญํ ๋ชจ๋ธ์ ๊ตฌํ ์ ์๊ฒ ๋๋ค.
2.2.1 ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง ๋์ญํ ๋ชจ๋ธ ๊ตฌ์กฐ
๋ณธ ๋
ผ๋ฌธ์์ ๊ตฌ์ฑํ ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง ๋์ญํ ๋ชจ๋ธ์ ๊ทธ๋ฆผ 3๊ณผ ๊ฐ๋ค. ๊ฐ ์๋์ธต์๋ ๋
ธ๋ 10๊ฐ๋ฅผ ๊ฐ์ง๊ณ ํ์ฑ ํจ์๋ ์๊ณกํ์ ํธ ์๊ทธ๋ชจ์ด๋(tansig) ํจ์๋ฅผ ์ฌ์ฉํ๋ค. ์ด ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง์ ์
๋ ฅ๊ณผ ์ถ๋ ฅ์
๊ฐ๊ฐ 3๊ฐ์ด๋ฉฐ, ์(1)์์์ ์
๋ ฅ $E_{1}$, $E_{2}$, $E_{3}$์ ์ถ๋ ฅ $u$, $v$, $r$์ด๋ค.
2.2.2 ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง ๋์ญํ ๋ชจ๋ธ ํ์ต
๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง ๋์ญํ ๋ชจ๋ธ์ ํ์ตํ๊ธฐ ์ํด์ ๋งคํธ๋ฉ(MATLAB) ์ธ๊ณต์ ๊ฒฝ๋ง ํด๋ฐ์ค(nntraintool)๋ฅผ ์ฌ์ฉํ๋ค. ์
๋ ฅ ๋ฐ์ดํฐ๋ ๋ฌด์์ํ๊ฒ ๋๋ ์
๊ฒ์ฆ์ ์ฌ์ฉํ๋ค. ํ์ต์ ์ฌ์ฉ๋๋ ์
๋ ฅ ๋ฐ์ดํฐ๋ฅผ ํ์ตํ๊ณ ์ ํ๋ ์ ๊ฒฝ๋ง์ ์
๋ ฅ์ผ๋ก ๋ฃ์์ ๋์ ์ถ๋ ฅ ๊ฐ๊ณผ ์ฌ์ ์ ์ป์ ์ถ๋ ฅ ๊ฐ์ ๋น๊ตํ์ฌ ํ๊ท ์ ๊ณฑ
์ค์ฐจ(Mean Squared Error, MSE)๋ฅผ ์ป๊ณ , ์ด ์ค์ฐจ๋ฅผ ์ค์ด๋ ๋ฐฉํฅ์ผ๋ก Levenberg-Marquardt(LM) ์๊ณ ๋ฆฌ์ฆ(13)์ ์ฌ์ฉํ์ฌ ๊ฐ์ค์น๋ฅผ ์กฐ์ ํ์ฌ ํ์ตํ๋ค. LM ์๊ณ ๋ฆฌ์ฆ์ ๊ฒฝ์ฌํ๊ฐ๋ฒ(Gradient descent)๊ณผ ๊ฐ์ฐ์ค-๋ดํด๋ฒ(Gauss-Newton method)์
๋ชจ๋ ์ฌ์ฉํ์ฌ ์ต์ ์ ํด๋ฅผ ์ฐพ๋ ๊ธฐ๋ฒ์ผ๋ก, ์๋ง์ ๊ฐ์ค์น๋ฅผ ๊ฐ์ง๋ ์ ๊ฒฝ๋ง์ ํ์ต์ํฌ ๋ ๋งค์ฐ ํจ์จ์ ์ธ ๋ฐฉ๋ฒ์ด๋ค(14). ํ์ต ๋ฐ์ดํฐ๋ ์ฌ์ ์ ์ค์ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ผ๋ก๋ถํฐ ์
์ถ๋ ฅ ๋ฐ์ดํฐ๋ฅผ ์ทจ๋ํ์ฌ ์ป๊ณ ์คํ๋ผ์ธ์ผ๋ก ํ์ต์ ์ํํ๋ค. ๊ทธ๋ฆผ 4๋ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด ์
์ถ๋ ฅ ๋ฐ์ดํฐ ์ทจ๋ ๊ณผ์ ์ ๋ณด์ฌ์ค๋ค. ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ๊ตฌ๋๋ถ๋ DC ๋ชจํฐ(Maxon DCX26L-GB-KL- 24V)์ ์ ๋ฐฉํฅ
ํ (Swedish wheels)์ ์ฌ์ฉํ๊ณ , ์ ์ด๊ธฐ๋ก๋ ๋ง์ดํฌ๋ก ์ปจํธ๋กค๋ฌ(TMS320C28346)๊ฐ ํ์ฌ๋์ด ์๋ค. ์ ๋ฐฉํฅ ์ด๋๋ก๋ด ์๋จ์ ๋ง์ปค(Markers)๋ฅผ
๋ถ์ฐฉํ์ฌ ๋ชจ์
์บก์ฒ ์ฅ์น(VICON bonita cameras)๋ก๋ถํฐ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ์๋ $u$, $v$, $r$๋ฅผ ์ป๋๋ค. ๊ทธ๋ฆผ 5๋ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ์ธ๊ฐํ๋ ์
๋ ฅ ์ ์๋ค์ ๋ํ๋ด๊ณ , ๊ทธ๋ฆผ 6์ ๋ชจ์
์บก์ณ ์ฅ์น๋ก๋ถํฐ ์ป์ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ์ถ๋ ฅ ์๋๋ฅผ ๋ํ๋ธ๋ค.
๊ทธ๋ฆผ. 3. ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง ๋์ญํ ๋ชจ๋ธ์ ๊ตฌ์กฐ
Fig. 3. Multi-layer neural network dynamics structure
2.2.3 ํ์ต ๊ฒฐ๊ณผ ๋ฐ ๊ธฐ์ค ๋์ญํ ๋ชจ๋ธ๊ณผ ๋น๊ต
๊ทธ๋ฆผ 7์ ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง ๋์ญํ ๋ชจ๋ธ์ ํ์ต ์ฑ๋ฅ์ ๋ณด์ฌ์ค๋ค. ํ๊ท ์ ๊ณฑ ์ค์ฐจ๋ก ํํ๋๋ ๊ฒ์ฆ ์ฑ๋ฅ์ด 79๋ฒ์งธ ์ธ๋(Epoch)์์ 0.0031546์ด๋ฉฐ
๋งค์ฐ ์์ ํ์ต ์ค์ฐจ๋ก ํ์ต์ด ์ด๋ค์ง์ ํ์ธํ ์ ์๋ค. ๊ทธ๋ฆผ 8-10์ ๊ธฐ์ค ๋์ญํ ๋ชจ๋ธ๊ณผ ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง ๋์ญํ ๋ชจ๋ธ์ ๊ฐ ์ถ๋ ฅ ์๋ $u$, $v$, $r$์ ๋น๊ตํ ๊ทธ๋ฆผ์ด๋ค. ๊ทธ๋ฆผ 5์ ๊ทธ๋ฆผ 6์์ ํ์ต ๋ฐ์ดํฐ๊ฐ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ๊ฐ๋ ๋ฒ์์ ๋ชจ๋ ์์ญ์ ์ ํํํด์ฃผ๊ธฐ ๋๋ฌธ์ ํ์ต๋ ๋์ญํ ๋ชจ๋ธ์ด ๊ธฐ์ค ๋์ญํ ๋ชจ๋ธ๊ณผ ๋งค์ฐ ์ ์ฌํ ์๋ต์ ๋ณด์ธ๋ค.
๊ทธ๋ฆผ. 4. ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ์
์ถ๋ ฅ ๋ฐ์ดํฐ ์ทจ๋
Fig. 4. Input/Output data acquisition of omnidirectional mobile robot
๊ทธ๋ฆผ. 5. ์ค์ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ์
๋ ฅ ์ ์ ๋ฐ์ดํฐ
Fig. 5. Input voltage data of actual omnidirectional mobile robot
๊ทธ๋ฆผ. 6. ์ค์ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ์ถ๋ ฅ ์๋ ๋ฐ์ดํฐ
Fig. 6. Output velocity data of actual omnidirectional mobile robot
๊ทธ๋ฆผ. 7. ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง ๋์ญํ ๋ชจ๋ธ์ ํ์ต ์ฑ๋ฅ
Fig. 7. Learning performance of Multi-layer neural network dynamics
3. ์๋์ผ์๊ฐ ์๋ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ์์๊ธฐ๋ฐ ๋น์ฃผ์ผ ์๋ณด์
์ด ์ฅ์์๋ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ์์๊ธฐ๋ฐ ๋น์ฃผ์ผ ์๋ณด์ ์ ์ด๊ธฐ๋ฅผ ์ค๊ณํ๋ค. ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ๋ถ์ฐฉ๋ ์นด๋ฉ๋ผ๋ก ๋ชฉํ๋ฌผ์ ํน์ง์ ์ ๋ณด๋ฅผ ์ป๊ณ , ๊ธฐ์ค ํน์ง์ ๊ณผ์
์ค์ฐจ๋ฅผ ์ ์ํ์ฌ ๊ทธ ์ค์ฐจ๊ฐ 0์ผ๋ก ์๋ ดํ๋๋ก ํ๋ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ๊ธฐ์ค ์๋๋ฅผ ์์ฑํ๋ค. ์์ฑํ ๊ธฐ์ค์๋๋ฅผ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ด ์ถ์ข
ํ๊ธฐ ์ํด์๋ ์ธ๋ถ
์๋ ์ ์ด๊ธฐ๋ฅผ ์ค๊ณํด์ผ ํ๊ณ , ์ด ์๋ ์ ์ด๊ธฐ์์๋ ์ ๋ฑกํฅ ์ด๋๋ก๋ด์ ์๋์ผ์๋ก๋ถํฐ ์๋๋ฅผ ํผ๋๋ฐฑ ๋ฐ์์ผ ํ๋ค.
๊ทธ๋ฆผ. 8. ๊ธฐ์ค ๋์ญํ๊ณผ ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง ๋์ญํ์ ์ถ๋ ฅ ์๋ $u$ ๋น๊ต
Fig. 8. Comparison of output velocity $u$ between reference dynamics and neural network
dynamics
๊ทธ๋ฆผ. 9. ๊ธฐ์ค ๋์ญํ๊ณผ ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง ๋์ญํ์ ์ถ๋ ฅ ์๋ $v$ ๋น๊ต
Fig. 9. Comparison of output velocity $v$ between reference dynamics and neural network
dynamics
๊ทธ๋ฆผ. 10. ๊ธฐ์ค ๋์ญํ๊ณผ ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง ๋์ญํ์ ์ถ๋ ฅ ์๋ $r$ ๋น๊ต
Fig. 10. Comparison of output velocity $r$ between reference dynamics and neural
network dynamics
์ผ๋ฐ์ ์ผ๋ก ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ์๋์ผ์๋ก๋ ๊ตฌ๋๊ธฐ์ ๊ฒฐํฉ๋ ์์ฝ๋ ์ผ์๋ฅผ ์ด์ฉํ๋ค. ํ์ง๋ง ์ด๋ฌํ ์๋์ผ์๋ ๋ฐํด์ ๋ฏธ๋๋ฌ์ง๊ณผ ํ๋๋ ํ์์ผ๋ก ๋ถํ์ค์ฑ์
๊ฐ์ง๋ค. ์๋ ์ ๋ณด๋ฅผ ์ ํํ ์ป๊ธฐ ์ํด์ (9)์์๋ ์ ์ญ ๋น์ ์ผ์๋ฅผ ์ฌ์ฉํ์ฌ ์๋๋ฅผ ๊ณ์ฐํ์ง๋ง, ์นด๋ฉ๋ผ ์์์ผ๋ก๋ถํฐ ๊ณ์ฐํ๊ธฐ ๋๋ฌธ์ ์ฐ์ฐ๋์ด ๋ง์ ์ค์๊ฐ์ฑ์ ๋ณด์ฅํ๊ธฐ ์ด๋ ต๊ณ , ์นด๋ฉ๋ผ ๋ด๋ถ ๊ณ ์
๋ณ์๋ค์ ๋ถํ์ค์ฑ์ด ๋ฐ์ํ์ฌ ์๋ ์ ๋ณด์ ๋ถํ์ค์ฑ์ ๊ธฐ์ธํ ์ ์๋ค. (10)์์๋ ์๋๋ฅผ ์ป์ง ์๊ณ ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง์ ํตํด ์ง์ ์ ์ผ๋ก ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ์์ธ ์ง๋ น์ ์์ฑํ์ง๋ง, ์ง๋ น์ ๋ฐ๋ฅธ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ์ค์ ์๋๊ฐ ์๋ ดํจ์
๋ณด์ด์ง ์์ ์ ํํ ์ ์ด๋ฅผ ๊ธฐ๋ํ๊ธฐ ์ด๋ ต๋ค. ๋ณธ ์ฅ์์๋ ์๋์ผ์์ ๋ถํ์ค์ฑ์ ์ง์ ์ ์ผ๋ก ํด๊ฒฐํ๊ธฐ ์ํ ๋ฐฉ๋ฒ์ ์ ์ํ๋ค. 2์ฅ์์ ์ค๊ณํ ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง
๋์ญํ ๋ชจ๋ธ์ ์ค์ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ๊ตฌ๋ํ๋ฉด์ ์ป๋ ์คํ ๋ฐ์ดํฐ๋ฅผ ๋ฐํ์ผ๋ก ์ค๊ณ๋์๊ณ , ๊ตฌ๋๊ธฐ์ ์
๋ ฅํ๋ ์ ์๊ณผ ๋ชจ์
์บก์ฒ ์ฅ์น๋ก๋ถํฐ ์ป๋ ์ ํํ
์ค์ ์๋์ ๊ด๊ณ๋ฅผ ํํํ๋ค. ๋ฐ๋ผ์ ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง ๋์ญํ์ ํตํด ๋ถํ์ค์ฑ์ ํฌํจํ ์๋์ผ์๊ฐ ์๋ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ์์๊ธฐ๋ฐ ๋น์ฃผ์ผ ์๋ณด์์ ๊ตฌํํ๋ค.
์นด๋ฉ๋ผ ์ขํ๊ณ์์ 3์ฐจ์ ๋ชฉํ๋ฌผ์ ์ขํ $p:=[x,\: y,\: z]^{T}$๋ฅผ 2์ฐจ์ ์ด๋ฏธ์ง ํ๋ฉด์ผ๋ก ํฌ์ํ ์ขํ $s:=[f_{x},\: f_{y}]^{T}$๋
๋ค์๊ณผ ๊ฐ์ด ํํํ ์ ์๋ค(15).
์ฌ๊ธฐ์ $u_{p}$์ $v_{p}$๋ ์ด๋ฏธ์ง ๊ณต๊ฐ์์ ํฝ์
๋จ์๋ก ํํ๋๋ ์ ์ ์ขํ์ด๊ณ , $c_{u}$, $c_{v}$, $f$, $\alpha$๋
์นด๋ฉ๋ผ ๋ด๋ถ์ ๊ณ ์ ๋ณ์๋ค์ด๋ค. ์ด๋ $s$์ ์นด๋ฉ๋ผ์ ์ ์๋์ ๊ฐ์๋๋ฅผ ํฌํจํ ์๋๋ณ์ $v_{c}:=[\dot p_{c},\: w_{c}]$์์
๊ด๊ณ๋ฅผ ๋ค์๊ณผ ๊ฐ์ด ๋ํ๋ผ ์ ์๋ค.
์ฌ๊ธฐ์ ์ํธ๊ด๊ณ ํ๋ ฌ $L_{o}$๋
์ด๋ค. ์์ ๋กญ๊ฒ ์์ง์ด๋ ์นด๋ฉ๋ผ๋ ์ฌ์ฏ ๊ฐ์ ์์ ๋๋ฅผ ๊ฐ์ง๋ง ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ๋ถ์ฐฉ๋ ์นด๋ฉ๋ผ๋ ์ธ ๊ฐ์ ์์ ๋๋ก ์ ํ๋๊ณ , ์นด๋ฉ๋ผ๊ฐ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด
์ค์ฌ์ ๋ถ์ฐฉ๋์ด ์๋ค๊ณ ๊ฐ์ ํ๋ฉด
์ ๊ฐ์ ๊ด๊ณ๋ฅผ ์ป์ ์ ์๋ค. ๋ฐ๋ผ์ ์(6)์ ๊ฐ๋ตํ๊ฒ ์ ๋ฆฌํ๋ฉด ๋ค์๊ณผ ๊ฐ๋ค.
์ฌ๊ธฐ์ ๊ฐ๋ตํํ ์ํธ๊ด๊ณ ํ๋ ฌ $L_{c}$๋
์ด๋ค. ๋ค ๊ฐ์ ๋ชฉํ๋ฌผ์ ํน์ง์ $s_{c}:=[s_{1},\: s_{2},\: s_{3,\:},\: s_{4}]^{T}$์ ์์์์ ๊ฒ์ถํ๊ณ ๋ชฉํ๋ฌผ์
์ํ๋ ํน์ง์ $s_{d}:=[s_{d1},\: s_{d2},\: s_{d3},\: s_{d4}]^{T}$์ ๋ํ์ฌ ์์ ํน์ง์ ์ค์ฐจ $e$$\in
โ^{8}$๋ฅผ
์ ๊ฐ์ด ์ ์ํ๋ค. ์ด๋ ๋ค ๊ฐ์ ํน์ง์ ์ ๋ํ ์ํธ๊ด๊ณ ํ๋ ฌ๋ค์ ๋ชจ๋ ํฌํจํ ์ํธ๊ด๊ณ ํ๋ ฌ $L_{s}:=[L_{c1},\: L_{c2},\: L_{c3},\:
L_{c4}]^{T}$$\in โ^{8\times 3}$์ ๋ํ์ฌ ์์ ํน์ง์ ์ค์ฐจ๋ฅผ 0์ผ๋ก ์๋ ดํ๊ธฐ ์ํ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ์ํ๋ ์๋๋ ๋ค์๊ณผ
๊ฐ์ด ์ค๊ณ๋๋ค.
์ฌ๊ธฐ์ $\widehat{L_{s}^{+}}:=\left(\widehat{L_{s}^{T}} \widehat{L}_{s}\right)^{-1} L_{s}^{T}
\in \mathbb{R}^{3 \times 8}$๋ ๋ฌด์ด-ํ๋ก์ฆ ์์ฌ ์ญํ๋ ฌ์ด๊ณ (16), $K$$\in โ^{8\times 8}$๋ ์์ ํน์ง์ ์ค์ฐจ์ ์๋ ด์๋๋ฅผ ๊ฒฐ์ ํ๋ ์์ ์ ๋ถํธ ํ๋ ฌ(Positive definite matrix)์ด๋ค.
์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ์๋๊ฐ ์(12)์ ์๋๋ฅผ ๋ฐ๋ผ๊ฐ๊ธฐ ์ํ์ฌ ์๋ ์ถ์ข
์ค์ฐจ
์ ๋ํ์ฌ ์(1)์์ ๋ค์๊ณผ ๊ฐ์ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ์ ์ด ์
๋ ฅ์ ์์ฑํ๋ค.
์ ์์ ์ํด ์(1)์ ๋ค์๊ณผ ๊ฐ์ด ์ ๋ฆฌ๋๋ค.
์ฌ๊ธฐ์ ์ ์ฌ ์
๋ ฅ $\upsilon$๋ฅผ PI(Proportional-Integral) ์ ์ด๊ธฐ ํํ๋ก ์ค๊ณํ๋ฉด ๋ค์๊ณผ ๊ฐ๋ค.
์ฌ๊ธฐ์ $k_{p}:=2\zeta w_{n}$์ $k_{i}:=w_{n}^{2}$๋ ์์ ์์(Positive constant)์ด๋ค. $\zeta$์
$w_{n}$์ ์ ์ ํ ์ค๊ณํ๋ฉด ์๋ ์ถ์ข
์ค์ฐจ๋
์ ๊ฐ์ ์ด์ฐจ ๋ฏธ๋ถ ๋ฐฉ์ ์ ํํ์ด๋ฏ๋ก $e_{v}$๋ ์ ๊ทผ์ ์ผ๋ก 0์ ์๋ ดํ๊ฒ ๋๋ค. ๋ฐ๋ผ์ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ์๋ $u$, $v$, $r$์ ๊ฐ๊ฐ
$u_{d}$, $v_{d}$, $r_{d}$๋ก ์๋ ดํ๊ณ , ์ ์ ๋ชฉํ๋ฌผ ํน์ง์ ๋ค์ ๋ํ์ฌ ์(12)๋ฅผ ์(9)์ ๋์
ํ๋ฉด ๋ค์๊ณผ ๊ฐ๋ค.
์ฌ๊ธฐ์ ์นด๋ฉ๋ผ์ ๋ชฉํ๋ฌผ ์ฌ์ด์ ๊น์ด(Depth) $z$๋ฅผ $e$๊ฐ 0์ผ ๋์ ๊ฐ์ธ ์์๋ก ์ค์ ํ๋ฉด $L_{s}\hat L_{s}^{+}$๋ ํญ์ ์์
์ค์ ๋ถํธ ํ๋ ฌ(Positive semidefinite matrix)์ ๋ง์กฑํ๋ค(15). ๋ฐ๋ผ์ ์์ ํน์ง์ ์ค์ฐจ๋ (15)์์์ ๊ฐ์ด ์ ๊ทผ์ ์ธ ์์ ์ฑ์ ๋ณด์ฅํ๋ค.
4. ๋ชจ์์คํ
๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง ๋์ญํ ๋ชจ๋ธ์ ํตํด ์ป์ ์๋ ์ ๋ณด๋ค๋ก ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ๋น์ฃผ์ผ ์๋ณด์ ๋ชจ์์คํ์ ๊ตฌํํจ์ผ๋ก์จ ๋ณธ ๋
ผ๋ฌธ์์ ์ ์ํ ๊ธฐ๋ฒ์ ํ๋น์ฑ์ ๊ฒ์ฆํ๋ค.
์(12)์ (16)์์ ์ ์ด๊ธฐ ์ค๊ณ ํ๋ผ๋ฏธํฐ๋ ํ 2์ ๊ฐ์ด ์ค๊ณํ๋ค.
ํ 2. ์ ์ด๊ธฐ ์ค๊ณ ํ๋ผ๋ฏธํฐ
Table 2. Controller design parameters
$K=\left[\begin{array}{ccc}0.20 & 0 & 0 \\ 0 & \ddots & 0 \\ 0 & 0 & 0.20\end{array}\right],
\zeta=0.90, w_{n}=4.85$
|
๊ทธ๋ฆผ 11์ 3 ์ฐจ์ ๊ทธ๋ํ๋ก ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ๋ชจ์
์ ๋ณด์ฌ์ค๋ค. ์นด๋ฉ๋ผ ์ขํ๊ณ์์ $z$์ถ ๋ฐฉํฅ์ผ๋ก ์ด๊ธฐ 2.5m ๋จ์ด์ง ๋ชฉํ๋ฌผ์ ์์น์์ ์์ํ์ฌ, ์ ๋ฐฉํฅ
์ด๋๋ก๋ด์ด ๋ชฉํ์ ์ผ๋ก๋ถํฐ ๊ฑฐ๋ฆฌ๊ฐ 0.35m์ผ ๋ ์ป์ด์ง๋ ํน์ง์ ๋ค์ ๊ธฐ์ค ํน์ง์ ๋ค๋ก ์ค์ ํ๋ค. ํ๋ก๋
ธ๋ฏนํ ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ํน์ง์ผ๋ก ์ด๋๊ถค์ ์ด ์ผ์ง์ ์ผ๋ก
๋ํ๋จ์ ํ์ธํ ์ ์๋ค. ๊ทธ๋ฆผ 12๋ ์นด๋ฉ๋ผ ์์์์์ ํน์ง์ ๋ค์ ์ด๋์ ๋ณด์ฌ์ค๋ค. ์นด๋ฉ๋ผ ์์์ 640โจฏ480 ํฌ๊ธฐ๋ฅผ ๊ฐ์ง๋ค๊ณ ๊ฐ์ ํ๊ณ ์์์ (Initial)์์ ์ข
๋ฃ์ (Final)๊น์ง
๋งค๋๋ฝ๊ฒ ์ด๋ํจ์ ํ์ธํ ์ ์๋ค. ๊ทธ๋ฆผ 13์ ์๋ ์ถ์ข
์ค์ฐจ $e_{v}$์ ๋ณํ๋ฅผ ๋ณด์ฌ์ฃผ๋ฉฐ, ๊ฐ ์๋ ์ถ์ข
์ค์ฐจ๊ฐ ์ ๊ทผ์ ์ผ๋ก 0์ ์๋ ด์ ํ์ธํ ์ ์๋ค. ๊ทธ๋ฆผ 14-17์ ๋ค ๊ฐ์ ์ ๊ทํ(Normalized)๋ ํน์ง์ ์ค์ฐจ๋ค์ ๋ณด์ฌ์ฃผ๋ฉฐ, ๊ฐ๊ฐ์ ๊ทธ๋ฆผ์์ $x$์ถ๊ณผ $y$์ถ ํน์ง์ ์ค์ฐจ๋ค์ด 0์ผ๋ก ์๋ ดํจ์ ํ์ธํ ์
์๋ค. ์ด๋ฌํ ๋ชจ์์คํ ๊ฒฐ๊ณผ๋ฅผ ํตํด ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ ๋ค์ธต์ธ๊ณต์ ๊ฒฝ๋ง ๋์ญํ์ ์ด์ฉํ ์์๊ธฐ๋ฐ ๋น์ฃผ์ผ ์๋ณด์ ์ ์ด๊ธฐ๊ฐ ์ ๋์ํจ์ ํ์ธํ ์ ์๋ค.
๊ทธ๋ฆผ. 11. ์ ๋ฐฉํฅ ์ด๋๋ก๋ด์ 3 ์ฐจ์ ๋ชจ์
Fig. 11. 3D motion of omnidirectional mobile robot
๊ทธ๋ฆผ. 12. ์นด๋ฉ๋ผ ์์์์์ ๋ค ๊ฐ์ ํน์ง์ ๋ค
Fig. 12. Four feature points in camera view
๊ทธ๋ฆผ. 13. ์๋ ์ถ์ข
์ค์ฐจ
Fig. 13. Velocity tracking errors
๊ทธ๋ฆผ. 14. ์ฒซ ๋ฒ์งธ ํน์ง์ ์ ๊ฐ ์ถ๋ณ ์ค์ฐจ๋ค
Fig. 14. Errors of the first feature point
๊ทธ๋ฆผ. 15. ๋ ๋ฒ์งธ ํน์ง์ ์ ๊ฐ ์ถ๋ณ ์ค์ฐจ
Fig. 15. Errors of the second feature point
๊ทธ๋ฆผ. 16. ์ธ ๋ฒ์งธ ํน์ง์ ์ ๊ฐ ์ถ๋ณ ์ค์ฐจ
Fig. 16. Errors of the third feature point
๊ทธ๋ฆผ. 17. ๋ค ๋ฒ์งธ ํน์ง์ ์ ๊ฐ ์ถ๋ณ ์ค์ฐจ
Fig. 17. Errors of the fourth feature point