๐Catching Objects in Flight ๋ฆฌ๋ทฐ
- ์ด ๋ ผ๋ฌธ์ ๋ถ๊ท์นํ ํํ์ ๊ณ ์ ๋นํ ๋ฌผ์ฒด์ ๊ถค์ ์ ์์ธกํ๊ณ ์ฑ๊ณต์ ์ผ๋ก ํฌํํ๋ ๋ก๋ด ์์คํ ์ ์ ์ํฉ๋๋ค.
- ์์คํ ์ ์์ฐ ํ์ต์ ํตํด ๋ฌผ์ฒด ์ญํ ๋ชจ๋ธ๊ณผ ๋ก๋ด์ ํฌ์ฐฉ ๊ฐ๋ฅ ๋ฐ ๋๋ฌ ๊ฐ๋ฅ ๊ณต๊ฐ ๋ชจ๋ธ์ ๊ตฌ์ถํ๊ณ , ๊ฒฐํฉ ๋์ ์์คํ (Coupled Dynamical Systems, CDS)์ผ๋ก ์-ํ ํ์ ๋์์ ์ค์๊ฐ์ผ๋ก ์์ฑํฉ๋๋ค.
- iCub ์๋ฎฌ๋ ์ด์ ๋ฐ KUKA LWR 4+ ์ค์ ์คํ์์ ํด๋จธ, ๋ผ์ผ, ๋ณ ๋ฑ ๋ค์ํ ๋ณต์กํ ๋ฌผ์ฒด๋ค์ ์ฑ๊ณต์ ์ผ๋ก ํฌํํ์ฌ, ๋ถํ์ค์ฑ ํ๊ฒฝ์์์ ์ด๊ณ ์ ๋ก๋ด ์ ์ด ๊ฐ๋ฅ์ฑ์ ์ ์ฆํ์ต๋๋ค.

1 Brief Review
์ด ๋ ผ๋ฌธ์ ๋ถ๊ท์นํ ํํ์ ๋นํ ๋ฌผ์ฒด๋ฅผ ์ก๋ ์ด๋ ค์ด ๋ฌธ์ ๋ฅผ ๋ค๋ฃน๋๋ค. ์ด ๋ฌธ์ ๋ ์ธ ๊ฐ์ง ๋ณต์กํ ํ์ ๋ฌธ์ ์ ํด๊ฒฐ์ ์๊ตฌํฉ๋๋ค: ๋น ๋ฅธ ์๋๋ก ์์ง์ด๋ ๋ฌผ์ฒด์ ๊ถค์ ์ ์ ํํ๊ฒ ์์ธกํ๋ ๊ฒ, ๊ฐ๋ฅํ ์ก๊ธฐ ์์ธ(catching configuration)๋ฅผ ์์ธกํ๋ ๊ฒ, ๊ทธ๋ฆฌ๊ณ ๋ก๋ด ํ์ ์์ง์์ ๋ฐ๋ฆฌ์ด ๋จ์๋ก ๋น ๋ฅด๊ฒ ๊ณํํ๋ ๊ฒ์ ๋๋ค.
ํต์ฌ ๋ฐฉ๋ฒ๋ก
๋ณธ ์ฐ๊ตฌ๋ โ์๋ฒ์ ํตํ ํ๋ก๊ทธ๋๋ฐ(programming-by-demonstration)โ ์ ๊ทผ ๋ฐฉ์์ ์ฑํํ์ฌ ๋ฌผ์ฒด ๋์ญํ ๋ฐ ํ ์์ง์ ๋ชจ๋ธ์ ํ์ตํฉ๋๋ค. ํนํ, ํ๋ฅ ๋ก ์ ๋ฐฉ์์ผ๋ก ์คํ ๊ฐ๋ฅํ ์ก๊ธฐ ์์ธ๋ฅผ ์ฐพ๋ ์๋ก์ด ๋ฐฉ๋ฒ๋ก ์ ์ ์ํ๋ฉฐ, ์ฌ๋ฌ ์๋ฒ์ผ๋ก๋ถํฐ ์์ง์์ ์ธ์ฝ๋ฉํ๊ธฐ ์ํด ๋์ญํ ์์คํ (Dynamical Systems, DS) ์ ๊ทผ ๋ฐฉ์์ ์ฌ์ฉํฉ๋๋ค. ์ด๋ ์ผ์ ๋ถํ์ค์ฑ์ด ์กด์ฌํ๋ ์ํฉ์์๋ ํ ์์ง์์ ๋น ๋ฅด๊ณ ๋ฐ์์ ์ผ๋ก ์ ์์ํค๋ ๊ฒ์ ๊ฐ๋ฅํ๊ฒ ํฉ๋๋ค.
1. ์์ง์ด๋ ๋ฌผ์ฒด์ ๋์ญํ ํ์ต (Learning the Dynamics of a Moving Object)
- ๋ฌธ์ ์ ์: ๊ณต๊ธฐ ์ ํญ, ๋ถ๊ท์นํ ํํ, ์ง๋ ์ค์ฌ(COM)์ด ์๋ ์ง์ ์์ ์ก์์ผ ํ๋ ๋น๊ฐ์ฒด ๋๋ ๋ถ๊ท์นํ ๋ฌผ์ฒด์ ๋น์ ํ์ ์ธ ๋ณ์ง ๋ฐ ํ์ ์ด๋์ ์์ธกํ๋ ๊ฒ์ ๋งค์ฐ ์ด๋ ต์ต๋๋ค. ๊ธฐ์กด์ ๊ฐ์ฒด ์ญํ ๋ชจ๋ธ์ ๋ฌผ์ฒด์ ์ง๋, COM ์์น, ๊ด์ฑ ๋ชจ๋ฉํธ์ ๊ฐ์ ๋ฌผ๋ฆฌ์ ์์ฑ ์ ๋ณด๋ฅผ ํ์๋ก ํ์ง๋ง, ์ด๋ค์ ์์์ ๋ฌผ์ฒด์ ๋ํด ์ธก์ ํ๊ธฐ ์ด๋ ต๊ฑฐ๋ ๋นํ ์ค ๋ณํ ์ ์์ต๋๋ค(์: ๋ถ๋ถ์ ์ผ๋ก ์ฑ์์ง ๋ณ).
- ์ ์ํ๋ ๋ฐฉ๋ฒ: ์ ์๋ ์๋ฒ์ ํตํด ๊ด์ฐฐ๋ ๋ฌผ์ฒด์ ์์ง์์ผ๋ก๋ถํฐ ์ง์ ๋ฌผ์ฒด์ ๋น์ ํ ๋์ญํ์ ํ์ตํฉ๋๋ค. ๋ฌผ์ฒด์ ๊ด์ฌ ์ง์ (point of interest)์ ์ํ \xi \in \mathbb{R}^D (์์น ๋ฐ ์ฟผํฐ๋์ธ์ ์ฌ์ฉํ ์์ธ)์ ๊ทธ ๋ฏธ๋ถ ๊ฐ \dot{\xi}, \ddot{\xi}๋ฅผ ์ฌ์ฉํ์ฌ ๋ฌผ์ฒด์ ๋์ญํ์ 2์ฐจ ์์จ ๋์ญํ ์์คํ ์ผ๋ก ๋ชจ๋ธ๋งํฉ๋๋ค: \ddot{\xi} = f(\xi, \dot{\xi})
- ํ์ต ๊ณผ์ : ๋ฏธ์ง์ ํจ์ f(.)๋ ์ํฌํธ ๋ฒกํฐ ํ๊ท(Support Vector Regression, SVR)๋ฅผ ์ฌ์ฉํ์ฌ ๋ชจ๋ธ๋ง๋ฉ๋๋ค. ์
๋ ฅ \zeta = [\xi; \dot{\xi}] \in \mathbb{R}^{2 \times D}์ ๋ํด ๊ฐ ์ฐจ์๋ง๋ค D๊ฐ์ SVR ๋ชจ๋ธ d f_{SVR}๊ฐ ํ์ต๋ฉ๋๋ค. ํ๊ท ์ถ์ ์น๋ ๋ค์๊ณผ ๊ฐ์ต๋๋ค: \ddot{\xi} = f_{SVR}(\zeta) = [\mathrm{d}f_{SVR}(\zeta)]_{d=1...D}
- ์ฌ๊ธฐ์ \mathrm{d}f_{SVR}(\zeta) = \sum_{m=1}^M \mathrm{d}\alpha_m K (\zeta, \mathrm{d}\zeta_m) + \mathrm{d}b ์ ๋๋ค.
- ์ปค๋ ํจ์ K(\zeta, \zeta_m) = \exp(-\gamma\|\zeta - \zeta_m\|^2)๋ ๋ฐฉ์ฌํ ๊ธฐ์ ํจ์(RBF) ์ปค๋์ ์ฌ์ฉํฉ๋๋ค. ํ์ต๋ ๋ชจ๋ธ์ ์นผ๋ง ํํฐ(Extended Kalman Filter, EKF)์ ๊ฒฐํฉ๋์ด ์ก์์ด ์๋ ์ผ์ฑ์ ๋ํ ๊ฒฌ๊ณ ์ฑ์ ํ๋ณดํฉ๋๋ค.
2. ์ก๊ธฐ ์์ธ ์์ธก (Predicting the Catching Configuration)
์ด ๋จ๊ณ๋ ์ธ ๊ฐ์ง ํ์ ๋ฌธ์ ๋ก ๊ตฌ์ฑ๋ฉ๋๋ค: ๋ฌผ์ฒด๋ฅผ ์ก์ ์ ์๋ ์์ธ ํ์ต, ๋ก๋ด์ ๋๋ฌ ๊ฐ๋ฅํ ๊ณต๊ฐ ๋ชจ๋ธ๋ง, ๊ทธ๋ฆฌ๊ณ ์ด ๋ ๋ชจ๋ธ์ ๊ฒฐํฉํ์ฌ ์ต์ ์ ์ก๊ธฐ ์์ธ ๋ฐ ์๊ฐ์ ๊ฒฐ์ ํ๋ ๊ฒ์ ๋๋ค. ์ก๊ธฐ ์์ธ \eta = [\eta_{pos}; \eta_{ori}]๋ ์๋-์ดํํฐ์ ์์น \eta_{pos} \in \mathbb{R}^3์ ์์ธ \eta_{ori} \in \mathbb{R}^6 (ํ์ ํ๋ ฌ์ ์ฒ์ ๋ ์ด ๋ฒกํฐ๋ก ๊ตฌ์ฑ)๋ก ์ ์๋ฉ๋๋ค.
- ์ก์ ์ ์๋ ๊ณต๊ฐ ๋ชจ๋ธ (Graspable-Space Model):
- ํ์ต: ๋ก๋ด ํธ๋๋ฅผ ์๋์ผ๋ก ๋ฌผ์ฒด์ ๊ฐ์ ธ๋ค ๋๋ ์๋ฒ์ ํตํด ๋ค์ํ ์ก๊ธฐ ์์ธ(์์น ๋ฐ ์์ธ)๋ฅผ ๊ธฐ๋กํฉ๋๋ค. ์ด ๋ฐ์ดํฐ๋ ๋ฌผ์ฒด ์ขํ๊ณ์์ ์ ์ฅ๋ฉ๋๋ค.
- ๋ชจ๋ธ๋ง: ๊ธฐ๋ก๋ ์ก๊ธฐ ์์ธ์ ๋ฐ๋ ๋ถํฌ๋ ๊ฐ์ฐ์์ ํผํฉ ๋ชจ๋ธ(Gaussian Mixture Model, GMM)์ ์ฌ์ฉํ์ฌ ๋ชจ๋ธ๋ง๋ฉ๋๋ค: M_{grasp} = \{\pi_k, \mu_k, \Sigma_k\}_{k=1:K}.
- ํ๋ฅ ๋ฐ๋: ์ฃผ์ด์ง ์ก๊ธฐ ์์ธ \eta \in \mathbb{R}^9์ ๋ํ ํ๋ฅ ๋ฐ๋๋ ๋ค์๊ณผ ๊ฐ์ต๋๋ค: P(\eta|M_{grasp}) = \sum_{k=1}^K \pi_k \mathcal{N}(\eta|\mu_k, \Sigma_k)
- ์คํ ๊ฐ๋ฅ์ฑ: P(\eta|M_{grasp})๊ฐ ํน์ ์๊ณ๊ฐ \rho_{grasp}๋ฅผ ์ด๊ณผํ๋ฉด ํด๋น ์์ธ๋ ์คํ ๊ฐ๋ฅํ ๊ฒ์ผ๋ก ๊ฐ์ฃผ๋ฉ๋๋ค.
- ์ขํ๊ณ ๋ณํ: ๋ฌผ์ฒด๊ฐ ์์ง์ด๋ฏ๋ก ๋ฌผ์ฒด ์ขํ๊ณ์ ๋ชจ๋ธ์ ๋ก๋ด ์ขํ๊ณ๋ก ๋ณํํด์ผ ํฉ๋๋ค: \text{robot}\mu_k(t) = \Omega(t)\text{obj}\mu_k + P(t) \text{robot}\Sigma_k(t) = \Omega(t)\text{obj}\Sigma_k\Omega(t)^T
- ์ฌ๊ธฐ์ P(t) = \begin{pmatrix} p(t) \\ \text{zeros}(6, 1) \end{pmatrix}์ด๊ณ , \Omega(t) = \text{diag}(R(t), R(t), R(t))์ ๋๋ค. p(t)์ R(t)๋ ๋ฌผ์ฒด ์ฐธ์กฐ ํ๋ ์์ ์์น ๋ฒกํฐ์ ํ์ ํ๋ ฌ์ ๋๋ค.
- ๋๋ฌ ๊ฐ๋ฅํ ๊ณต๊ฐ ๋ชจ๋ธ (Reachable-Space Model):
- ํ์ต: ๋ก๋ด ํ์ ๋ชจ๋ ๊ด์ ๋ณ์๋ฅผ ์ฒด๊ณ์ ์ผ๋ก ์ํ๋งํ์ฌ ๋ก๋ด์ด ๋ฌ์ฑํ ์ ์๋ ์๋-์ดํํฐ ์์ธ(์์น ๋ฐ ์์ธ)๋ฅผ ๊ธฐ๋กํฉ๋๋ค. ์ด ์ํ๋ค๋ GMM M_{reach} = \{\pi_l, \mu_l, \Sigma_l\}_{l=1:L}๋ก ๋ชจ๋ธ๋ง๋ฉ๋๋ค.
- ์ ํ์ฑ ๋ฐ ์ ์ฝ: GMM์ ๊ฐ์ฐ์์ ๊ฐ์๋ ๋ฒ ์ด์ง์ ์ ๋ณด ๊ธฐ์ค(BIC)์ผ๋ก ๊ฒฐ์ ๋ฉ๋๋ค. ๋ชจ๋ธ์ ์ ํ๋๋ ๋ฌด์์ ์ํ๋ง์ ํตํด ๊ฒ์ฆ๋ฉ๋๋ค. ๋ํ, ๋ก๋ด์ด ํ ์ด๋ธ๊ณผ์ ์ถฉ๋์ ํผํ๊ธฐ ์ํด z < 0.1 \text{m}์ธ ๋๋ฌ ๊ฐ๋ฅํ ์ํ์ ๋ฒ๋ ค์ง๋๋ค. ์์ฒด ์ถฉ๋์ ํผํ๊ธฐ ์ํด ๋ณด์์ ์ธ ๊ด์ ๋ฒ์๊ฐ ์ค์ ๋๋ฉฐ, ์๋ฐ๋ฅ ๋ฐฉํฅ์ด ์ง๋ฉด์ ํฅํ๋ ์์ธ๋ ์ ์ธ๋ฉ๋๋ค.
- ์ต์ ์ก๊ธฐ ์์ธ ์์ธก (Predicting Catching Configuration):
- ๊ฒฐํฉ ๋ชจ๋ธ: ์ก์ ์ ์๋ ๊ณต๊ฐ ๋ชจ๋ธ๊ณผ ๋๋ฌ ๊ฐ๋ฅํ ๊ณต๊ฐ ๋ชจ๋ธ์ ํต๊ณ์ ์ผ๋ก ๋ ๋ฆฝ์ ์ด๋ฏ๋ก, ๋ ๋ชจ๋ธ์ ํ๋ฅ ๋ถํฌ๋ฅผ ๊ณฑํ์ฌ ๊ฒฐํฉ ํ๋ฅ ๋ถํฌ M_{joint}(t)๋ฅผ ๊ณ์ฐํ ์ ์์ต๋๋ค. ๊ฒฐํฉ๋ GMM์ ๊ฐ ๊ฐ์ฐ์์ ํ๋ผ๋ฏธํฐ j=(l-1) \times L + k๋ ๋ค์๊ณผ ๊ฐ์ต๋๋ค: \Sigma_j(t) = (\Sigma_k^{-1}(t) + \Sigma_l^{-1})^{-1} \mu_j(t) = \Sigma_j(t) (\Sigma_k^{-1}(t)\mu_k(t) + \Sigma_l^{-1}\mu_l) \pi_j(t) = \pi_k(t)\eta_{grasp} \cdot \pi_l\eta_{reach} \cdot \mathcal{N}(\mu_k(t)|\mu_l, \Sigma_k(t) + \Sigma_l)
- ์ต์ ํ: ์์ธก๋ ๋ฌผ์ฒด ์์ธ์์ ์ต์ ์ ์ก๊ธฐ ์์ธ \eta(t)๋ฅผ ์ฐพ๊ธฐ ์ํด, ๊ฒฐํฉ ๋ชจ๋ธ M_{joint}(t)์ ๋ํด ๊ฒฝ์ฌ ์์น๋ฒ(gradient ascent)์ ์ฌ์ฉํ์ฌ P(\eta(t)|M_{joint}(t))๋ฅผ ์ต๋ํํฉ๋๋ค. ์ด๊ธฐ๊ฐ์ ํ์ฌ ์ ์์ธ์ ๊ฐ์ฅ ๊ฐ๊น์ด ๊ฐ์ฐ์์์ ์ค์ฌ \mu_j(t)๋ก ์ค์ ๋ฉ๋๋ค.
- ์ถฉ๋ ํํผ ํด๋ฆฌ์คํฑ: ์์ด ๋ฌผ์ฒด์ ์ถฉ๋ํ ์ํ์ ์ค์ด๊ธฐ ์ํด, ์ก๊ธฐ ์์ธ์์ ๋ก๋ด ์๋ฐ๋ฅ์ ๋ฐฉํฅ์ด ๋ฌผ์ฒด ์๋ ๋ฐฉํฅ์ ๋ฐ๋์ฌ์ผ ํ๋ค๋ ์ ์ฝ ์กฐ๊ฑด์ ์ถ๊ฐํฉ๋๋ค: \text{dot}(\dot{\eta}_{pos}(t), \eta_{palm}(t)) < d. ์ด๋ ์ค์๊ฐ ์ถฉ๋ ํํผ ๊ณ์ฐ์ ๋ถ์ฌ๋ฅผ ๋ณด์ํฉ๋๋ค.
3. ํ-์ ํ์ ์ด๋ (HandโArm Coordinated Motion)
- ์ ๊ทผ ๋ฐฉ์: ์๋-์ดํํฐ์ ์์น \xi_h \in \mathbb{R}^3์ ์์ธ \xi_o \in \mathbb{R}^3 (์ค์ผ์ผ๋ ์ถ-๊ฐ ํํ) ๊ถค์ ์ ๋์ญํ ์์คํ ๊ธฐ๋ฐ ๋ชจ๋ธ์ ์ฌ์ฉํ์ฌ ๋ชจ๋ธ๋ง๋ฉ๋๋ค. ์ด๋ ์์ ์ ์ธ ๋์ญํ ์์คํ ์ถ์ ๊ธฐ(Stable Estimator of Dynamical System, SEDS) ๊ธฐ์ ๋ก ํ์ต๋ฉ๋๋ค. ์-์๊ฐ๋ฝ ์ฐ๋์ ๊ฒฐํฉ ๋์ญํ ์์คํ (Coupled Dynamical Systems, CDS) ๋ชจ๋ธ์ ์ฌ์ฉํ์ฌ ๋ชจ๋ธ๋ง๋ฉ๋๋ค.
- CDS ๋ชจ๋ธ: CDS๋ ์ธ ๊ฐ์ง GMM์ผ๋ก ํ์ต๋ ๋
๋ฆฝ์ ์ธ ๋์ญํ ์์คํ
์ผ๋ก ๊ตฌ์ฑ๋ฉ๋๋ค:
- ๋ง์คํฐ ์๋ธ์์คํ : ์ ์ด๋์ ๋์ญํ์ ์ธ์ฝ๋ฉํ๋ P(\xi_h, \dot{\xi}_h|\theta_h).
- ์ฌ๋ ์ด๋ธ ์๋ธ์์คํ : ์๊ฐ๋ฝ ์์ง์์ ๋์ญํ์ ์ธ์ฝ๋ฉํ๋ P(\xi_f, \dot{\xi}_f|\theta_f).
- ์ถ๋ก ์๋ธ์์คํ : ์๊ฐ๋ฝ์ ์ถ๋ก ๋ ์ํ์ ํ์ฌ ์ ์์น์ ๊ฒฐํฉ ํ๋ฅ ๋ถํฌ๋ฅผ ์ธ์ฝ๋ฉํ๋ P(\Psi(\xi_h), \xi_f|\theta_{inf}). ์ฌ๊ธฐ์ \Psi(\xi_h)๋ ์์ ํ์ฌ ์ํ๋ฅผ ์๊ฐ๋ฝ ์์ง์์ ์ฐ๊ฒฐํ๋ ๊ฒฐํฉ ํจ์์ ๋๋ค.
- ๊ถค์ ์์ฑ ๋ฐ ํ์ด๋ฐ ์ ์ด: ์ก๊ธฐ ๋์์ ์คํํ๋ ๋์, ๋ง์คํฐ DS๋ ์๋-์ดํํฐ ์๋ ๋ช ๋ น์ ์์ฑํ๋ฉฐ, ์ด๋ ์ค์นผ๋ผ ๋ถ์คํธ ์ธ์๋ก ์ง์์ ์ผ๋ก ํฌ๊ธฐ๊ฐ ๋ณด์ ๋์ด ๋ก๋ด์ด ์ํ๋ ์๊ฐ์ ์ก๊ธฐ ์์ธ์ ๋๋ฌํ๋๋ก ํฉ๋๋ค. ์๊ฐ๋ฝ ๊ด์ ์ ์ถ๋ก ๋ (์ํ๋) ์ํ๋ก ์์ง์ด๋ ๋ฐ ํ์ํ ์๋๊ฐ ๊ฐ์ฐ์์ ํผํฉ ํ๊ท(Gaussian mixture regression)๋ฅผ ํตํด ์์ฑ๋ฉ๋๋ค. Cartesian ๊ณต๊ฐ์ ๊ถค์ ์ ์ญ๊ธฐ๊ตฌํ(Inverse Kinematics, IK)์ ์ฌ์ฉํ์ฌ 7-์์ ๋ ๊ด์ ์ํ๋ก ๋ณํ๋ฉ๋๋ค.
์คํ ๊ฒ์ฆ (Empirical Validation)
์ ์๋ ์์คํ ์ ์ฑ๋ฅ์ ํ๊ฐํ๊ธฐ ์ํด ๋ ๊ฐ์ง ์คํ์ ์ํํ์ต๋๋ค: iCub ์๋ฎฌ๋ ์ดํฐ์ ์ค์ KUKA LWR 4+ ๋ก๋ด(Allegro Hand ์ฅ์ฐฉ).
- iCub ์๋ฎฌ๋ ์ด์ : ํด๋จธ์ ํ ๋์ค ๋ผ์ผ์ ์ฌ์ฉํ์ฌ 20๋ฒ์ ๋์ง๊ธฐ ์๋ฒ์ผ๋ก ๋์ญํ ๋ชจ๋ธ์ ํ์ตํ์ต๋๋ค. ๋ฌด์์ ์ด๊ธฐ ์์น, ์๋, ๊ฐ์๋๋ก 50๋ฒ์ ๋์ง๊ธฐ๋ฅผ ์ํํ์ฌ 100%์ ์ฑ๊ณต๋ฅ ์ ๊ธฐ๋กํ์ต๋๋ค (๋๋ฌ ๊ฐ๋ฅํ ๊ณต๊ฐ ๋ฐ์ผ๋ก ๋๊ฐ 3๋ฒ์ ์๋๋ ์ ์ธ).
- ์ค์ KUKA LWR 4+ ๋ก๋ด: ๋น ๋ณ, ๋ถ๋ถ์ ์ผ๋ก ์ฑ์์ง ๋ณ, ํ
๋์ค ๋ผ์ผ, ๊ณจํ์ง ์์ ๋ฑ ๋ค ๊ฐ์ง ๋ฌผ์ฒด๋ฅผ ์ฌ์ฉํ์ต๋๋ค. ๊ฐ ๋ฌผ์ฒด๋ 20๋ฒ ๋์ ธ์ ธ ๋์ญํ ๋ชจ๋ธ ํ์ต์ ์ฌ์ฉ๋์๊ณ , ์ตํฐํธ๋(Optitrack) ๋ชจ์
์บก์ฒ ์์คํ
์ผ๋ก ๋ฌผ์ฒด์ ๋ก๋ด ํธ๋์ ์์ธ๋ฅผ 240Hz๋ก ๊ธฐ๋กํ์ต๋๋ค. ๋ฌผ์ฒด์ ๋์ญํ ๋ชจ๋ธ์ SVR-RBF๋ก ํ์ต๋์์ผ๋ฉฐ, ๋ถ๋ถ์ ์ผ๋ก ์ฑ์์ง ๋ณ์ ๋ํ ๊ฐ์ฒด ์ญํ ๋ชจ๋ธ๊ณผ์ ๋น๊ต์์ SVR-RBF๊ฐ ํจ์ฌ ๋์ ์์ธก ์ ํ๋๋ฅผ ๋ณด์์ต๋๋ค. ์-ํ ํ์ ๋ชจ๋ธ์ ํค๋ค์คํฑ ์๋ฒ(kinesthetic demonstrations)๊ณผ ์ธ๊ฐ์ด ๋ฌผ์ฒด๋ฅผ ์ก๋ ์๋ฒ(๋ชจ์
์บก์ฒ ๋ฐ 5DT ๋ฐ์ดํฐ ๊ธ๋ฌ๋ธ ์ฌ์ฉ)์ ํตํด ํ์ต๋์์ต๋๋ค.
- ์ฑ๊ณต๋ฅ : ์ด 80๋ฒ์ ์๋ ์ค ๋ก๋ด์ ๋๋ฌ ๊ฐ๋ฅํ ๊ณต๊ฐ์ ๋ค์ด์ค์ง ์์ 9๋ฒ์ ์๋๋ฅผ ์ ์ธํ 71๋ฒ์ ์๋์์ 52๋ฒ ์ฑ๊ณตํ์ฌ 73.2%์ ์ฑ๊ณต๋ฅ ์ ๋ณด์์ต๋๋ค.
- ์คํจ ์์ธ:
- IK ํด๋ฒ์ ์คํ ๋ถ๊ฐ๋ฅ์ฑ: ๋ชฉํ ๊ด์ ์์ธ๊ฐ ์ด๊ธฐ ์์ธ์ ๋๋ฌด ๋ฉ์ด ๋ก๋ด์ด ์ ์๊ฐ์ ๋๋ฌํ ์ ์๋ ๊ฒฝ์ฐ (19๋ฒ์ ์คํจ ์ค 12๋ฒ).
- ์๊ฐ๋ฝ์ด ๋ฌผ์ฒด๋ฅผ ์ณ์ ํ๊ฒจ๋ด๋ ๊ฒฝ์ฐ (19๋ฒ์ ์คํจ ์ค 4๋ฒ).
- ๊ด์ ํ ํฌ ํ๊ณ ์๋ฐ์ผ๋ก ๋ก๋ด์ด ์๋์ผ๋ก ๋ฉ์ถ๋ ๊ฒฝ์ฐ (19๋ฒ์ ์คํจ ์ค 3๋ฒ).
- ์ธ๊ฐ๊ณผ์ ๋น๊ต: ๋์ผํ ์ ์ฝ ์กฐ๊ฑด์์ ์ธ๊ฐ์ 100๋ฒ์ ์๋ ์ค 38๋ฒ ์ฑ๊ณตํ์ฌ 38%์ ์ฑ๊ณต๋ฅ ์ ๋ณด์์ผ๋ฉฐ, ์ด๋ ๋ก๋ด๋ณด๋ค ํ์ ํ ๋ฎ์ ์์น์ ๋๋ค.
๊ฒฐ๋ก ๋ฐ ํ๊ณ
๋ณธ ๋ ผ๋ฌธ์ ๋ถ๊ท์นํ ์ง๋ ๋ถํฌ์ ๋น๊ฐ์ฒด ์ง๋ ๋ถํฌ๋ฅผ ๊ฐ์ง ๋นํ ๋ฌผ์ฒด๋ฅผ ์ก๋ ๋ก๋ด ํ๋ ์์ํฌ๋ฅผ ์ ์ํ์ต๋๋ค. ์ด ํ๋ ์์ํฌ๋ ์ธ๊ฐ ์๋ฒ์ ํตํ ํ์ต๊ณผ ํ์์ ํตํด ํ๋ก์ธ์ค์ ๊ฐ ๋จ๊ณ๋ฅผ ๋ก๋ด์ด ์ต๋ํ๋๋ก ํฉ๋๋ค. ์ด๋ ๋ ๊ฐ์ง ๋ค๋ฅธ ๋ก๋ด ํ๋ซํผ(iCub ์๋ฎฌ๋ ์ดํฐ, KUKA LWR 4+)๊ณผ ๋ณต์กํ ๋์ญํ์ ๊ฐ์ง ๋ค ๊ฐ์ง ๋ฌผ์ฒด์ ๋ํด ๊ฒ์ฆ๋์์ต๋๋ค. ์ ์๋ ๋ฐฉ๋ฒ์ ๊ธฐ์กด์ ์ฐ๊ตฌ๋ณด๋ค ๊ณ์ฐ ์๋๊ฐ ๋งค์ฐ ๋น ๋ฅด๋ฉฐ, ๋ณต์กํ ๋ฌผ์ฒด์ ๋ํ ๋์ ์ฑ๊ณต๋ฅ ์ ๋ณด์์ต๋๋ค.
ํ๊ณ ๋ฐ ํฅํ ์ฐ๊ตฌ:
- SVR-RBF ๊ธฐ๋ฐ ๋์ญํ ๋ชจ๋ธ์ ํ์ต๋ ์ํ ๊ณต๊ฐ์์ ๋ฉ๋ฆฌ ๋จ์ด์ง ์์ญ์์๋ ์์ธก ์ ํ๋๊ฐ ๋จ์ด์ง ์ ์์ต๋๋ค (๊ตญ์์ ์ธ ์ผ๋ฐํ).
- ๋ช ์์ ์ธ ์ค์๊ฐ ์ถฉ๋ ํํผ๊ฐ ์์ผ๋ฉฐ, ์๋ฐ๋ฅ ๋ฐฉํฅ ํด๋ฆฌ์คํฑ์ ์์กดํฉ๋๋ค. ์ด๋ ์ผ๋ถ ์คํจ์ ์์ธ์ด ๋ฉ๋๋ค.
- ์ก์ ์ ์๋ ๋ชจ๋ธ์ ์ฃผ๋ก ํ์ ๊ทธ๋ฆฝ์ ์ค์ ์ ๋์์ผ๋ฉฐ, ์ ๋ฐ ๊ทธ๋ฆฝ์ ๋ค๋ฃจ์ง ์์์ต๋๋ค.
- ๋ก๋ด์ ๋์ญํ(์: ๊ด์ ์๋, ํ ํฌ ํ๊ณ)์ด ๋ชจ๋ธ๋ง๋์ง ์์, ์์ฑ๋ ๊ถค์ ์ด ๋ก๋ด์๊ฒ ์คํ ๋ถ๊ฐ๋ฅํ ์ ์์ต๋๋ค. ํฅํ ์ฐ๊ตฌ์์๋ ์ต์ ์ ์ด๋ฅผ ํตํด ๋ก๋ด ๋์ญํ์ ๋ง์กฑํ๋ ์คํ ๊ฐ๋ฅํ ๊ถค์ ์ ์์ฑํ์ฌ CDS ๋ชจ๋ธ์ ๋ณด๊ฐํ๋ ๋ฐฉํฅ์ด ๊ณ ๋ ค๋ ์ ์์ต๋๋ค.
์ด๋ฌํ ๋ฌธ์ ์ ๋ค์ ํฅํ ์ฐ๊ตฌ์์ ๋ค๋ฃจ์ด์ง ๊ณผ์ ๋ก ๋จ์์์ต๋๋ค.
2 Detail Review
2.1 ์๋ก : ๋นํ ๋ฌผ์ฒด ์ก๊ธฐ์ ์ด๋ ค์๊ณผ ์ฐ๊ตฌ ๋ชฉํ
๊ณ ์์ผ๋ก ๋นํํ๋ ๋ฌผ์ฒด๋ฅผ ๋ก๋ด์ด ๊ณต์ค์์ ์ก์๋ด๋ ๊ฒ์ ๋ก๋ด๊ณตํ์์ ๋งค์ฐ ๋์ ์ ์ธ ๊ณผ์ ์ ๋๋ค. ์ด ์์ ์ ์ํด์๋ (1) ๋น ๋ฅด๊ฒ ์์ง์ด๋ ๋ฌผ์ฒด์ ๊ถค์ ์ ์ ํํ ์์ธกํ๊ณ , (2) ๋ฌผ์ฒด๋ฅผ ์ก๊ธฐ ์ํ ์ต์ ์ ๋ก๋ด ํ-์ ์์ธ(์ก๊ธฐ ๊ตฌ์ฑ)๋ฅผ ์ฐพ์๋ด๋ฉฐ, (3) ์ ํ๋ ์๊ฐ ๋ด์ ๋ก๋ด ํ์ ๊ถค์ ์ ๊ณํํ์ฌ ๋ชฉํ ์ง์ ์ ๋๋ฌํ๋๋ก ์ ์ดํ๋ ๊ฒ, ์ด ์ธ ๊ฐ์ง ๋ฌธ์ ๋ฅผ ๋ชจ๋ ํ์ด์ผ ํฉ๋๋ค. ์ด๋ฌํ ๋ชจ๋ ์ฒ๋ฆฌ๋ฅผ ๋ฐ๋ฆฌ์ด(ms) ๋จ์์ ์๊ฐ ์์ ์ํํด์ผ ํ๋ค๋ ์ ์์ ๊ธฐ์ ์ ๋๋๊ฐ ๋งค์ฐ ๋์ต๋๋ค. ํนํ ๊ณต์ค์์ ์ก์ผ๋ ค๋ ๋์์ด ๋ง์น, ๋ผ์ผ, ๋ณ๊ณผ ๊ฐ์ด ๋ฌด๊ฒ ์ค์ฌ์ด ํ์ชฝ์ผ๋ก ์น์ฐ์น๊ฑฐ๋ ๋น๋์นญ์ธ ๋ฌผ์ฒด์ธ ๊ฒฝ์ฐ, ๋จ์ํ ํฌ๋ฌผ์ ๋ชจ๋ธ๋ก๋ ์ด๋์ ์ค๋ช ํ๊ธฐ ์ด๋ ต๊ณ ๋ฌผ์ฒด์ ์์ธ(orientation)๊น์ง ๊ณ ๋ คํด์ผ ํ๋ฏ๋ก ๋ฌธ์ ๊ฐ ๋์ฑ ๋ณต์กํด์ง๋๋ค.
์ด ๋ ผ๋ฌธ์ ์ ์๋ค์ ์ด๋ฌํ ๋ฌธ์ ๋ฅผ ํด๊ฒฐํ๊ธฐ ์ํด ํ๋ก๊ทธ๋๋ฐ-๋ฐ์ด-๋ฐ๋ชฌ์คํธ๋ ์ด์ (programming by demonstration) ์ ๊ทผ์ ํ์ฉํ์์ต๋๋ค. ์ฆ, ์ฌ๋์ด๋ ๋ก๋ด์ด ๋ฌผ์ฒด๋ฅผ ๋์ง๊ณ ์ก๋ ์๋ฒ ๋ฐ์ดํฐ๋ก๋ถํฐ ํ์ตํจ์ผ๋ก์จ, ๋ฌผ์ฒด์ ๋ํน์ฑ๊ณผ ๋ก๋ด ํ์ ์์ง์์ ๋ชจ๋ธ๋งํ์์ต๋๋ค. ์ด๋ฅผ ํตํด ๋ฌผ์ฒด ๋นํ ๊ถค์ ์ ํ์ต ๊ธฐ๋ฐ ์์ธก ๋ชจ๋ธ์ ์ป๊ณ , ํ๋ฅ ์ ์ธ ๋ฐฉ๋ฒ์ผ๋ก ๋ก๋ด์ ์ก๊ธฐ ์์ธ๋ฅผ ๊ฒฐ์ ํ๋ฉฐ, ๋์ ์์คํ (Dynamical System, DS) ๊ธฐ๋ฐ์ ์ ์ด๊ธฐ๋ก ๋ก๋ด ํ์ ๋น ๋ฅด๊ณ ์ ์ฐํ๊ฒ ์์ง์ด๋๋ก ํ์์ต๋๋ค. ์ด๋ฌํ ํตํฉ ํ๋ ์์ํฌ๋ฅผ ํตํด ์ผ์ ๋ ธ์ด์ฆ๋ ์๊ธฐ์น ์์ ๋ณํ์๋ ์ค์๊ฐ์ผ๋ก ๋์ํ๋ฉด์ ๋ก๋ด ํ์ด ๊ณต์ค์ ๋ฌผ์ฒด๋ฅผ ์ก์ ์ ์๋๋ก ํ์์ต๋๋ค. ๋ณธ ๋ฆฌ๋ทฐ์์๋ ํด๋น ๋ ผ๋ฌธ์ ๊ธฐ์ ์ ๊ธฐ์ฌ๋ฅผ ์ค์ฌ์ผ๋ก, ์ ์๋ ๋ฐฉ๋ฒ๋ก (์๊ณ ๋ฆฌ์ฆ, ์คํ ์ค์ , ํ๋์จ์ด/์ํํธ์จ์ด ๊ตฌ์ฑ, ๋ฐ์ดํฐ ํ๋ฆ ๋ฑ)์ ์์ธํ ๋ถ์ํ๊ณ , ๊ธฐ์กด ์ฐ๊ตฌ๋ค๊ณผ์ ์ฐจ๋ณ์ ์ ํจ๊ป ๋ ผ์ํฉ๋๋ค.

๊ทธ๋ฆผ 1: KUKA LWR 4+ ๋ก๋ด ํ๊ณผ Allegro ๋ก๋ด ์์ ์ด์ฉํด ๊ณต์ค์ ๋์ ธ์ง ์ฐ์ ๋ณ ํํ์ ๋ฌผ์ฒด๋ฅผ ์ก๋ ์ฅ๋ฉด. ํด๋น ์ฐ๊ตฌ์์ ๋ก๋ด์ ํ ๋์ค ๋ผ์ผ, ๋ง์น, ๋น ๋ณ, ๋ด์ฉ๋ฌผ์ด ์ผ๋ถ ๋ ๋ณ, ๋ฐ์ค ๋ฑ ๋ค์ํ ํํ์ ๋ฌผ์ฒด๋ฅผ 0.5์ด ์ด๋ด์ ๋นํ ์๊ฐ ๋์ ์ถ์ ํ์ฌ ์ก์๋ผ ์ ์์์ ์ ์ฆํ์๋ค.
2.2 ๊ธฐ์กด ์ฐ๊ตฌ์์ ์ฐจ๋ณ์ฑ
๊ณ ์ ๋นํ ๋ฌผ์ฒด ํฌํ์ ๊ดํ ์ ํ ์ฐ๊ตฌ๋ค์ ์ฃผ๋ก ์ด๋ก ์ ๋ชจ๋ธ์ด๋ ์ฌ์ ์ ์๋ ๊ถค์ ์ ๊ธฐ๋ฐํ ์ ๊ทผ์ ์ทจํด์์ต๋๋ค. ์๋ฅผ ๋ค์ด, ๊ณต์ ์ก๋ ๋ฌธ์ ์์๋ ๋ฌผ์ฒด์ ๊ถค์ ์ ํฌ๋ฌผ์ (ํ๋)์ผ๋ก ๊ฐ์ ํ๊ณ ์ต์์์น ๋ฑ์ ๊ธฐ๋ฒ์ผ๋ก ์ค์๊ฐ ์ถ์ ํ๊ฑฐ๋, ๊ณต๊ธฐ ์ ํญ์ ํฌํจํ ํ๋ ๋ชจ๋ธ์ ํ์ฅ ์นผ๋ง ํํฐ(EKF)๋ฅผ ๊ฒฐํฉํ์ฌ ๊ถค์ ์ ์์ธกํ๋ ์๋๊ฐ ์์์ต๋๋ค. ์ด๋ฌํ ๋ฐฉ๋ฒ๋ค์ ๋ฌผ์ฒด์ ๋์ญํ ๋ชจ๋ธ์ด ์ ํํ ์๋ ค์ ธ ์๋ ๊ฒฝ์ฐ์๋ ๊ถค์ ์ถ์ ์ ํ๋๊ฐ ๋์์ง๋ง, ๋ชจ๋ธ์ ๋ํ ์ฌ์ ์ง์(์: ๋ฌผ์ฒด์ ์ง๋, ๋ฌด๊ฒ์ค์ฌ ์์น, ๊ด์ฑ ๋ชจ๋ฉํธ ๋ฑ)์ด ํ์ํ๊ณ , ์ฃผ๋ก ๊ตฌ ํํ์ ๋ฌผ์ฒด(๊ณต)๋ฅผ ์ ์ ๋ก ์ง์ (COM) ๊ถค์ ๋ง ์ถ์ ํ๊ธฐ ๋๋ฌธ์ ๋ง์น๋ ๋ผ์ผ์ฒ๋ผ ๋ณต์กํ ํํ์ ๋ฌผ์ฒด์๋ ์ ์ฉํ๊ธฐ ์ด๋ ต๋ค๋ ํ๊ณ๊ฐ ์์ต๋๋ค. ๋ฐ๋ฉด ์ด ๋ ผ๋ฌธ์์๋ ์์ ํํ์ ๋ฌผ์ฒด์๋ ์ ์ฉ ๊ฐ๋ฅํ๋๋ก, ๋ฐ์ดํฐ ๊ธฐ๋ฐ์ผ๋ก ๋ฌผ์ฒด์ ์ด๋์ ํ์ตํ์ฌ ๋ชจ๋ธ์ ๊ตฌ์ถํจ์ผ๋ก์จ ์ฌ์ ์ ๋ฌผ๋ฆฌ์ ๋งค๊ฐ๋ณ์๋ฅผ ์ ํ์ ์์ด ๊ถค์ ์ ์์ธกํ ์ ์๊ฒ ํ์ต๋๋ค. ์ค์ ๋ก ์ ์๋ค์ ์ด์ ์ฐ๊ตฌ์์๋ ์ฌ๋์ ๋์ง๊ธฐ ์ๆผ์ผ๋ก๋ถํฐ ๋ฌผ์ฒด ์ด๋์ ๋์ญํ์ ํ์ตํ์ฌ, ๋ฌผ์ฒด์ ์ง๋์ด๋ ๊ด์ฑ ๋ฑ์ ์ ๋ณด ์์ด๋ 6์์ ๋(์์น+์์ธ) ๊ถค์ ์ ์์ธกํ๋ ์์จ ๋์ ์์คํ ๋ชจ๋ธ์ ๊ตฌํํ ๋ฐ ์์ต๋๋ค.
๋ ๋ค๋ฅธ ์ฐจ๋ณ์ ์ ์ค์๊ฐ์ฑ๊ณผ ๋ถํ์ค์ฑ ๋์์ ๋๋ค. ๊ณผ๊ฑฐ์ ์ฌ๋ฌ ๋ก๋ด catching ์ฐ๊ตฌ๋ค์ ์ฌ์ ์ ๊ณ์ฐ๋ ์๊ฐ-์์กด ๊ถค์ (์: ๋คํญ์ ๋ณด๊ฐ, ์ต์ ๊ฐ์๋ ๊ถค์ ๋ฑ)์ผ๋ก ๋ก๋ด์ ์์ง์ด๋๋ก ํ๊ธฐ ๋๋ฌธ์, ์ผ๋จ ๊ถค์ ์์ฑ ํ์ ์๊ฐ์์ ๊ต๋์ด๋ ๋ชฉํ ์์น์ ๋ณํ๊ฐ ์๊ธฐ๋ฉด ๋์ํ๊ธฐ ์ด๋ ค์ ์ต๋๋ค. ์ฆ, ์ก๊ธฐ ๋์์ด ์์๋ ํ์ ๋ฌผ์ฒด์ ์ด๋์ ๋ณํ๊ฐ ์๊ฒจ๋ ๋ก๋ด ๊ถค์ ์ ์ฆ๊ฐ ์ฌ๊ณ์ฐํ๊ธฐ ์ด๋ ต๋ค๋ ๋ฌธ์ ์ ๋๋ค. ๋ณธ ์ฐ๊ตฌ์์๋ ์ด๋ฌํ ํ๊ณ๋ฅผ ๊ทน๋ณตํ๊ธฐ ์ํด ์๊ฐ-๋ถ๋ณ์ ๋์ ์์คํ ์ ๊ธฐ๋ฐ์ผ๋ก ํ ๋ฐ์ํ ์ ์ด๊ธฐ๋ฅผ ์ฌ์ฉํ๊ณ , ์ฌ๊ธฐ์ ์๊ฐ ์กฐ์จ ๊ธฐ๋ฒ(fast-forward integration & scaling)์ ์ ์ฉํ์ฌ ์ก๋ ์๊ฐ์ ์ ํํ ๋๋ฌํ๋๋ก ๊ถค์ ์ ์ค์๊ฐ์ผ๋ก ์กฐ์ ํฉ๋๋ค. ๊ทธ ๊ฒฐ๊ณผ, ์์ธก๋ catching ์์ธ๊ฐ ์์๋ก ๋ณ๊ฒฝ๋์ด๋ ๋ก๋ด ํ์ DS ์ ์ด ๊ถค์ ์ ๊ทธ์ ๋ง๊ฒ ๊ณ ์ ์ฌ๊ณํ(์ฝ 10ms ์ฃผ๊ธฐ)ํ ์ ์์ด, ๋นํ ์ค ๋ฐ์ํ๋ ์ผ์ ์ง์ฐ์ด๋ ์ก๊ธฐ ์์ ๋ณํ์๋ ๋์ํ ์ ์์ต๋๋ค. ํนํ ๋ ผ๋ฌธ์์๋ ์ ์ํ ํ๋ฅ ์ ๋ชจ๋ธ ๋๋ถ์ ์ ์ฒด ๋นํ ์๊ฐ์ด 0.7์ด ์ดํ์ธ ๊ฒฝ์ฐ์๋ ๋ก๋ด์ด ๋ฌผ์ฒด๋ฅผ ์ก์ ์ ์์๊ณ , ์ต์ ์ก๊ธฐ ์์ธ ๊ณ์ฐ์๋ 0.2ms ์ ๋๋ฐ์ ๊ฑธ๋ฆฌ์ง ์์๋ค๊ณ ๋ณด๊ณ ํฉ๋๋ค. ์ด๋ ์ด์ ์ฐ๊ตฌ๋ค๊ณผ ๋น๊ตํด ์๋์ ์ผ๋ก ๋น ๋ฅธ ๊ณ์ฐ ๋ฐ ์ ์ ์๋๋ฅผ ๋ณด์ฌ์ฃผ๋ ๊ฒ์ผ๋ก, ๊ณผ๊ฑฐ์๋ ์ด ์ ๋ ์๋์ ๊ถค์ ์ฌ๊ณํ์ ์ํด 32์ฝ์ด ๋ณ๋ ฌ์ปดํจํ ์ ํ์ฉํ ๋ณต์กํ ์ต์ ํ ๊ธฐ๋ฒ์ ์จ์ผ ํ๋ ์ฌ๋ก๋ ์์๋ ๊ฒ๊ณผ ๋๋น๋ฉ๋๋ค.
๋ง์ง๋ง์ผ๋ก, ๋ก๋ด ์๊ฐ๋ฝ ์ ์ด ์ธก๋ฉด์์๋ ๋ณธ ์ฐ๊ตฌ๋ ๊ธฐ์กด ๋ฐฉ์๊ณผ ์ฐจ๋ณ๋ฉ๋๋ค. ์ ํต์ ์ผ๋ก ๋ก๋ด์ด ๋ฌผ์ฒด๋ฅผ ์ก์ ๋๋ ์๋์ดํํฐ(์๋ฐ๋ฅ)์ ๋ฌผ์ฒด ์ฌ์ด ๊ฑฐ๋ฆฌ๊ฐ ์ผ์ ์๊ณ๊ฐ ์ดํ๋ก ์ขํ์ง๋ ์๊ฐ ์๊ฐ๋ฝ์ ๋ซ๋ ๊ฐ๋จํ ํธ๋ฆฌ๊ฑฐ ๋ฐฉ์์ด ์ฃผ๋ก ์ฌ์ฉ๋์์ต๋๋ค. ์ด๋ฌํ ๋ฐฉ์์ ์๊ฐ๋ฝ ๋ซ๋ ํ์ด๋ฐ, ์๋ ๋ฑ์ ๋งค๊ฐ๋ณ์๋ฅผ ์ฌ๋์ด ํ๋ํด์ผ ํ๊ณ ๋ฌผ์ฒด์ ์ ๊ทผ ๋ฐฉํฅ์ด๋ ์๋ ๋ณํ์ ๋ฐ๋ผ ์ต์ ์ ํ์ด๋ฐ์ ๋ณด์ฅํ๊ธฐ ์ด๋ ต์ต๋๋ค. ๋ฐ๋ฉด ์ด ๋ ผ๋ฌธ์์๋ ํ๊ณผ ์๊ฐ๋ฝ์ ํ๋์ ์ฐํฉ๋ ๋์ ์์คํ (CDS)์ผ๋ก ๋ชจ๋ธ๋งํ์ฌ, ํ์ ์ด๋ ๊ถค์ ๊ณผ ์๊ฐ๋ฝ์ ๋ซํ ๋์์ด ์์ฐ์ค๋ฝ๊ฒ ๋๊ธฐํ๋๋๋ก ๋ง๋ค์์ต๋๋ค. ์ฆ, ํ์ ์์ง์ ์ํ์ ๋ฐ๋ผ ์๊ฐ๋ฝ ๋์์ด ์๋์ผ๋ก ๊ฒฐ์ ๋๋ฏ๋ก, ๋ณ๋์ ์๊ณ๊ฐ ํธ๋ฆฌ๊ฑฐ ์์ด๋ ๋ฌผ์ฒด๊ฐ ์๋ฐ๋ฅ์ ๋ฟ๋ ์ ํํ ์๊ฐ์ ์๊ฐ๋ฝ์ด ๋ซํ๊ฒ ๋ฉ๋๋ค. ์ด๋ ํ ์ด๋์ด ์์ธก๊ณผ ๋ฌ๋ฆฌ ์ง์ฐ๋๊ฑฐ๋ ๊ฐ์๋๋๋ผ๋ ์๊ฐ๋ฝ ํ์ด๋ฐ์ด ํจ๊ป ์กฐ์ ๋๋ฏ๋ก, ๋ฌผ์ฒด๋ฅผ ํ๋ฆฌ๊ฑฐ๋ ํ๊ฒจ๋ด์ง ์๊ณ ์์ ์ ์ผ๋ก ์ก์ ํ๋ฅ ์ ๋์ฌ์ค๋๋ค. ์ด๋ฌํ ํ-์ ์ฐํฉ ์ ์ด ๊ธฐ๋ฒ์ ์ ์๋ค์ ์ ํ ์ฐ๊ตฌ์์ ์ ์๋ ๊ฒ์ผ๋ก, ๋ณธ ๋ ผ๋ฌธ์์๋ ์ด๋ฅผ ์ค์ 7์์ ๋ KUKA ํ๊ณผ 4-์๊ฐ๋ฝ Allegro Hand ํ๋ซํผ์ ์ ์ฉํ์ฌ ์ ํจ์ฑ์ ๊ฒ์ฆํ์์ต๋๋ค.
2.3 ๋ฌผ์ฒด ๊ถค์ ํ์ต๊ณผ ์์ธก (Dynamics Learning)
์ด ๋ ผ๋ฌธ์์๋ ๋นํ ๋ฌผ์ฒด์ ๊ถค์ ์ ๋ชจ๋ธ๋งํ๊ธฐ ์ํด ๋น์ ํ ๋์ญํ ๋ชจ๋ธ์ ํ์ตํ๋ ์ ๊ทผ๋ฒ์ ์ฌ์ฉํ์ต๋๋ค. ๋ฌผ์ฒด์ ์ํ๋ฅผ \xi = [p,; q]๋ก ์ ์ํ๋๋ฐ, ์ฌ๊ธฐ์ p๋ ๋ฌผ์ฒด์ ๊ณ ์ ๋ ํน์ ๊ด์ฌ ์ง์ (point of interest)์ 3์ฐจ์ ์์น์ด๊ณ , q๋ ๋ฌผ์ฒด์ ์์ธ(orientation)๋ฅผ ๋ํ๋ด๋ ์ฌ์์(quaternion)์ ๋๋ค. ๋ฌผ์ฒด์ ์ด๋ ๋ฐฉ์ ์์ 2์ฐจ ์์จ ๋์ ์์คํ (์ด์ฐจ ๋ฏธ๋ถ๋ฐฉ์ ์)์ผ๋ก ๊ฐ์ ๋๋ฉฐ, ํํ๋ ๋ค์๊ณผ ๊ฐ์ต๋๋ค:
- \ddot{\xi} = f(\xi,; \dot{\xi}), ์ฆ ๊ฐ์๋ \ddot{\xi}๊ฐ ํ์ฌ์ ์์น์ ์๋ (\xi, \dot{\xi})์ ํจ์๋ก ํํ๋ฉ๋๋ค. ์ด๋ f(\cdot)๋ ๋น์ ํ ํจ์๋ก์ ๋ช ์์ ์์์ ์ ์ ์์ผ๋ฏ๋ก, ๋จธ์ ๋ฌ๋ ๊ธฐ๋ฐ ํ๊ท๋ก ๊ทผ์ฌํ๊ฒ ๋ฉ๋๋ค.
์ ์๋ค์ ์ํฌํธ ๋ฒกํฐ ํ๊ท(Support Vector Regression, SVR) ๊ธฐ๋ฒ์ ํ์ฉํ์ฌ ์ด ํจ์๋ฅผ ํ์ต์์ผฐ์ต๋๋ค. N๊ฐ์ ๋์ง๊ธฐ ์คํ์ผ๋ก๋ถํฐ ์ป์ ๋ฌผ์ฒด ๊ถค์ ๋ฐ์ดํฐ(๊ฐ ๊ถค์ ์ ์๊ฐ์์ผ๋ก T๊ฐ์ ์ํ ๋ฐ์ดํฐ ํฌํจ)๋ฅผ ์ฌ์ฉํ์ฌ, ์ ๋ ฅ \zeta = [\xi; \dot{\xi}] (์์น+์์ธ์ ๊ทธ ๋ฏธ๋ถ์ ์ด์ด๋ถ์ธ ๋ฒกํฐ)์ ๋ฐ๊ณ ์ถ๋ ฅ \ddot{\xi} (๊ฐ์๋)์ ์์ธกํ๋ SVR ๋ชจ๋ธ์ ํ๋ จํฉ๋๋ค. ๊ฐ ์ถ๋ ฅ ์ฐจ์(\xi์ ๊ฐ ์ฑ๋ถ)์ ๋ํด ๋ณ๋์ SVR์ ํ์ตํ์ฌ ์ด D๊ฐ์ ํ๊ท ๋ชจ๋ธ f_{SVR}^d๋ฅผ ์ป์ผ๋ฉฐ, RBF ์ปค๋์ ์ฌ์ฉํ์ฌ ๋น์ ํ ํน์ฑ์ ๋ชจ๋ธ๋งํ์ต๋๋ค. ์ต์ ์ ์ปค๋ ๋งค๊ฐ๋ณ์ ๋ฐ ์ ๊ทํ ํ๋ผ๋ฏธํฐ C๋ ๊ต์ฐจ๊ฒ์ฆ(grid search)์ ํตํด ๊ฒฐ์ ๋์๊ณ , ํ์ต ์๋ฃ ํ SVR ๋ชจ๋ธ์ ๋ค์๊ณผ ๊ฐ์ ํ๊ท ํจ์๋ฅผ ์ ๊ณตํฉ๋๋ค:
\hat{\ddot{\xi}} = f_{SVR}(\zeta) = \sum_{m=1}^{M} \alpha_m K(\zeta, \zeta_m) + b,
์ฌ๊ธฐ์ M์ ์ํฌํธ ๋ฒกํฐ์ ์, \alpha_m์ ํ์ต๋ ๊ณ์, K๋ RBF ์ปค๋ ํจ์์ ๋๋ค. ์ด ํ๊ท์์ด ๊ณง ๋ฌผ์ฒด ์ด๋ ๋ฐฉ์ ์ f(\cdot)์ ๋ํ ๊ทผ์ฌ์ด๋ฉฐ, ์์์ ํ์ฌ ์ํ (\xi, \dot{\xi})๋ฅผ ๋ฃ์ผ๋ฉด ๋ค์ ์๊ฐ์ ๊ฐ์๋๋ฅผ ์์ธกํ ์ ์์ต๋๋ค.
์ด๋ ๊ฒ ํ์ต๋ ๋ฌผ์ฒด ๋์ญํ ๋ชจ๋ธ์ ์ด์ฉํ๋ฉด, ๋ก๋ด์ ๋นํ ๋ฌผ์ฒด์ ํ์ฌ ์ํ ์ธก์ ๊ฐ(์์น, ์์ธ, ์๋)์ ์ ๋ ฅํ์ฌ ๋ฏธ๋์ ๊ถค์ ์ ์ค์๊ฐ์ผ๋ก ์์ธกํ ์ ์์ต๋๋ค. ๋ ผ๋ฌธ์์๋ ์ด ์์ธก ๋ชจ๋์ ์ฃผ๊ธฐ์ ์ผ๋ก ๊ฐฑ์ ํ๋๋ก ์ค๊ณํ์๋๋ฐ, ์นด๋ฉ๋ผ ๋ฑ์ ์ผ์๋ก๋ถํฐ ์๋ก์ด ๋ฌผ์ฒด ์์น/์์ธ ๋ฐ์ดํฐ๊ฐ ๋ค์ด์ฌ ๋๋ง๋ค SVR ๋ชจ๋ธ๋ก ๋จ์ ๋นํ ๊ฒฝ๋ก๋ฅผ ๋น ๋ฅด๊ฒ ๊ณ์ฐํฉ๋๋ค. ๋ํ ์์ ์ธ๊ธํ ๋๋ก ์์ธก ๊ณผ์ ์ EKF ๊ธฐ๋ฐ์ ๋ณด์ ์ ๊ฒฐํฉํ์ฌ, ์ผ์ ๋ ธ์ด์ฆ๋ ์ธ๋์ผ๋ก ์ธํ ๋ถํ์ค์ฑ์ ์ค์์ต๋๋ค. ์์ปจ๋, SVR ํ๊ท๊ฐ ์ด์์ ์ธ ์ด๋์ ๋ด๋ค๋ณด๋ ์ญํ ์ ํ๊ณ , EKF ์ถ์ ๊ธฐ๊ฐ ์๋ก์ด ๊ด์ธก๊ฐ์ผ๋ก ๊ทธ ์์ธก์ ๋ฏธ์ธ ์กฐ์ ํจ์ผ๋ก์จ, ๋ ธ์ด์ฆ์ ๊ฐ์ธํ๋ฉด์๋ ๋น ๋ฅธ ๊ถค์ ์์ธก์ ๊ตฌํํ ๊ฒ์ ๋๋ค.
์ ์๋ค์ ๋ฌผ์ฒด ๋์ญํ ๋ชจ๋ธ์ ํ์ตํ๊ธฐ ์ํด ๋ค์ํ ์ด๊ธฐ ์กฐ๊ฑด์ผ๋ก ๋ฌผ์ฒด๋ฅผ ๋์ง๋ ์คํ์ ์ํํ์ฌ ๋ฐ์ดํฐ์ ์ ๊ตฌ์ถํ์ต๋๋ค. ์๋ฅผ ๋ค์ด, ์๋ฎฌ๋ ์ด์ ์์ iCub ๋ก๋ด์ ์ด์ฉํด ๋ง์น์ ํ ๋์ค๊ณต์ 20ํ์ฉ ๋์ ธ ์๋ก ๋ค๋ฅธ ๊ถค์ ์ ๋ง๋ค๊ณ , ์ค์ ์คํ์์๋ ๋น ๋ณ, ๋ฌผ์ด ์ ๋ฐ ๋ ๋ณ, ๋ผ์ผ, ์์ ๋ฑ์ ๊ฐ๊ฐ ์ฌ๋ฌ ์ฐจ๋ก ๋์ ธ ๋ฐ์ดํฐ๋ก ํ์ฉํ์ต๋๋ค. ๊ฐ ๋์ง๊ธฐ ๊ถค์ ์ ์ต๋ 100Hz๋ก ๊ธฐ๋ก๋์๊ณ , ์ฌ์ ์ ์ ์ญ ํต๊ณผ ํํฐ(Butterworth, 25Hz)๋ก ๋ ธ์ด์ฆ๋ฅผ ์ ๊ฑฐํ ํ ์๋์ ๊ฐ์๋๋ฅผ ๊ณ์ฐํ์ฌ ํ์ต์ ์ฌ์ฉํ์ต๋๋ค. ์ด๋ ๊ฒ ์์งํ ์ฝ 20๊ฐ ๋ด์ธ์ ๊ถค์ ๋ฐ์ดํฐ๋ก SVR์ ํ๋ จํ ๊ฒฐ๊ณผ, ๋ถ๊ณผ ์์ญ ๊ฐ์ ์์ฐ๋ง์ผ๋ก๋ ๋ฌผ์ฒด ์ด๋์ ๋น์ ํ ํจํด์ ํ์ตํ ์ ์์์ต๋๋ค. ํ์ต๋ ๋ชจ๋ธ์ ํ ์คํธ ํ์ผ๋ก ์ ์ฅํ์ฌ ์ค์๊ฐ ์คํ ์ ๋ถ๋ฌ์ค๋๋ก ๊ตฌ์ฑํ์์ผ๋ฉฐ, C++ ๊ธฐ๋ฐ ์ ์ด ์ํํธ์จ์ด์์ ํด๋น ๋ชจ๋ธ์ ํ์ฉํด ๋งค ์ฃผ๊ธฐ๋ง๋ค ๋ฌผ์ฒด์ ๋ค์ ์์น์ ์์ธ๋ฅผ ์์ธกํ๊ฒ ๋ฉ๋๋ค.
์์ธก ์ฑ๋ฅ ํ๊ฐ๋ฅผ ์ํด ์งํ๋ ์๋ฎฌ๋ ์ด์ ์คํ์์, ์ ์ํ SVR-RBF ๊ธฐ๋ฐ ๋ชจ๋ธ์ ๋งค์ฐ ์ ํํ ๊ถค์ ์์ธก์ ๋ณด์ฌ์ฃผ์์ต๋๋ค. iCub ์๋ฎฌ๋ ์ดํฐ ์์์ ๋ง์น์ ๋ผ์ผ์ ๋ฌด์์ ์ด๊ธฐ์กฐ๊ฑด์ผ๋ก 50ํ ๋์ ธ๋ณธ ๊ฒฐ๊ณผ, ๊ทธ ์ค ๋ก๋ด ์์ ๊ณต๊ฐ ๋ด๋ก ๋ค์ด์จ ์๋ 47ํ์ ๋ํด ๋ก๋ด์ด 100%์ ์ฑ๊ณต๋ฅ ๋ก ๋ฌผ์ฒด๋ฅผ ์ก์์ต๋๋ค. (๋๋จธ์ง 3ํ๋ ๋ฌผ์ฒด๊ฐ ๋ก๋ด์ด ๋ฟ์ ์ ์๋ ๋ฒ์๋ฅผ ๋ฒ์ด๋ ์์ ์ก์ ์ ์๋ ๊ฒฝ์ฐ์์ต๋๋ค.) ํนํ ์๋ฎฌ๋ ์ด์ ์์๋ ๊ณต๊ธฐ์ ํญ์ด๋ ์ผ์ ์ค์ฐจ ๋ฑ์ ๋ถํ์ค์ฑ์ด ์์๊ธฐ ๋๋ฌธ์, ์ฒ์ ๋ช ํ๋ ์์ ๊ด์ธก๋ง์ผ๋ก๋ ๊ถค์ ์์ธก์ด ์ค์ ๊ถค์ ์ ๊ฑฐ์ ์๋ ดํ์๊ณ ์์ธก ์ค์ฐจ๋ ๋งค์ฐ ์์์ต๋๋ค. ํํธ, ๋ถ๋ถ์ ์ผ๋ก ๋ฌผ์ด ๋ ๋ณ๊ณผ ๊ฐ์ด ์ง๋ ๋ถํฌ๊ฐ ๋ณํํ๋ ๋ณต์กํ ๋ฌผ์ฒด์ ๊ฒฝ์ฐ, SVR๋ก ํ์ตํ ๋ชจ๋ธ๊ณผ ์ ํต์ ์ธ ๊ฐ์ฒด ๋์ญํ ๋ชจ๋ธ์ ์์ธก ์ฑ๋ฅ์ ๋น๊ตํ ๊ฒฐ๊ณผ๊ฐ ํฅ๋ฏธ๋กญ์ต๋๋ค. ๊ฐ์ฒด ๋ชจ๋ธ์ ์ํด ๋ณ์ ์ด๊ธฐ ๋ฌด๊ฒ์ค์ฌ๊ณผ ์ง๋, ๊ด์ฑ ๋ฑ์ ๊ณ์ธกํ์ฌ ํฌ๋ฌผ์ +ํ์ ์ด๋ ๋ฐฉ์ ์์ ๊ตฌ์ฑํด ๋ณด์์ผ๋, SVR ํ์ต ๋ชจ๋ธ์ ์ค์ ๊ถค์ ์ ์ ํํ ๋ง์ถ ๋ฐ๋ฉด, ๊ฐ์ฒด ๋ชจ๋ธ์ ํนํ ๋ฌผ์ฒด์ ํ์ (์์ธ) ์์ธก์์ ํฐ ์ค์ฐจ๋ฅผ ๋ณด์์ต๋๋ค. ๋ ผ๋ฌธ์ ์ ์๋ ๋ถ๋ถ์ฑ์์ง ๋ฌผ๋ณ์ ๊ถค์ ๊ทธ๋ํ(Fig. 13)๋ฅผ ๋ณด๋ฉด, SVR ๊ธฐ๋ฐ ์ถ์ ์ ๋ฌผ์ฒด์ ๋ณต์กํ ์ด๋(๋น์ ํ ๊ณต์คํ์ ๊น์ง ํฌํจ)์ ์ ๋ฐ๋ผ๊ฐ๋ ๋ฐ๋ฉด, ๊ฐ์ฒด ์ญํ ๋ชจ๋ธ์ ์๊ฐ ๊ฒฝ๊ณผ์ ๋ฐ๋ผ ์์ธก ์์ธ๊ฐ ์ค์ ์ ๋๋จ์ด์ ธ ๊ฒฐ๊ตญ ๋ฌผ์ฒด๋ฅผ ๋์น๋ ์ํฉ์ผ๋ก ์ด์ด์ง์ ์ ์ ์์ต๋๋ค. ์ด ๊ฒฐ๊ณผ๋ ์ฌ์ ๋ชจ๋ธ๋ง ์์ด ๋ฐ์ดํฐ๋ก๋ถํฐ ํ์ตํ ์ ๊ทผ๋ฒ์ ์ฐ์์ฑ์ ๋ณด์ฌ์ฃผ๋ ์ฌ๋ก๋ก, ํนํ ๋ฌผ์ฒด์ ๋ฌผ๋ฆฌ์ ํน์ฑ์ด ๋ถ์์ ํ๊ฑฐ๋ ๋ณํํ๋ ์ํฉ์์ ์ ์ฉํจ์ ์์ฌํฉ๋๋ค.
2.4 ์ต์ ์ก๊ธฐ ์์ธ ๊ฒฐ์ : ๊ฐ์ฉ ๊ณต๊ฐ & ํ์ง ๊ณต๊ฐ ๋ชจ๋ธ๋ง
๋นํ ๋ฌผ์ฒด๋ฅผ ์ก๊ธฐ ์ํด์๋ ๋ก๋ด ํ์ด ์ด๋ค ์์น์์ ์ด๋ค ์์ธ๋ก ๋ฌผ์ฒด๋ฅผ ํฌ์ฐฉํ ๊ฒ์ธ์ง ๊ฒฐ์ ํด์ผ ํฉ๋๋ค. ์ผ๋ฐ์ ์ธ ๋ก๋ด๊ณตํ ์ฉ์ด๋ก, ์ด๋ ๋ก๋ด์ ์์ ๊ณต๊ฐ(reachable space)๊ณผ ๋ฌผ์ฒด์ ํ์ง(grasp) ๊ฐ๋ฅํ ์์ธ ๊ณต๊ฐ์ด ๊ต์งํฉ์ ์ด๋ฃจ๋ ์ง์ ์ ์ฐพ๋ ๋ฌธ์ ๋ก ๋ณผ ์ ์์ต๋๋ค. ๋ณธ ๋ ผ๋ฌธ์์๋ ์ด ๋ฌธ์ ๋ฅผ ํ๊ธฐ ์ํด ๋ก๋ด์ ๊ฐ์ฉ ๊ณต๊ฐ ๋ชจ๋ธ๊ณผ ๋ฌผ์ฒด์ ํ์ง ๊ณต๊ฐ ๋ชจ๋ธ์ ํ๋ฅ ์ ๋ฐฉ์์ผ๋ก ํ์ตํ๊ณ , ๋ ๋ชจ๋ธ์ ๊ฒฐํฉํ์ฌ ์ค์๊ฐ์ผ๋ก ์ต์ ์ ์ก๊ธฐ ์์ธ(์ธํฐ์ ํธ ์ง์ )๋ฅผ ๊ฒฐ์ ํ๋ ์๋ก์ด ๋ฐฉ๋ฒ๋ก ์ ์ ์ํ์ต๋๋ค.
๋จผ์ ๋ก๋ด์ ๊ฐ์ฉ ๊ณต๊ฐ(reachable space) ๋ชจ๋ธ๋ง๋ถํฐ ์ดํด๋ณด๊ฒ ์ต๋๋ค. ๋ก๋ด ํ์ด ๋๋ฌ ๊ฐ๋ฅํ ๋ชจ๋ ์๋ ์์ธ(์์น+๋ฐฉํฅ)์ ์งํฉ์ ์ผ๋ฐ์ ์ผ๋ก 6์ฐจ์(SE(3)) ๊ณต๊ฐ์์ ๋งค์ฐ ๋ณต์กํ ํํ์ ์์ญ์ ์ด๋ฃน๋๋ค. ์ด๋ฅผ ๋ถ์ํ๊ธฐ ์ํด ๊ณผ๊ฑฐ ์ฐ๊ตฌ๋ค์์๋ ๋ก๋ด์ ์์ ๊ณต๊ฐ ๊ฒฝ๊ณ๋ฅผ ๊ธฐํํ์ ์ผ๋ก ํด์ํ๊ฑฐ๋, ๊ฒฉ์ํ๋ 3D ๊ณต๊ฐ์ ์ ๋ค์ ๋ํด ์ญ๊ธฐ๊ตฌํ(IK)์ผ๋ก ๋๋ฌ ๊ฐ๋ฅ ์ฌ๋ถ๋ฅผ ์ผ์ผ์ด ๊ฒ์ฌํ์ฌ ๋ฐ์ดํฐ๋ฒ ์ด์ค๋ฅผ ๋ง๋๋ ์ ๊ทผ์ด ์๋๋์์ต๋๋ค. ๊ทธ๋ฌ๋ ์ด๋ฌํ ๋ฐฉ๋ฒ๋ค์ ๋ถ์ฐ์์ (discrete)์ธ ๊ทผ์ฌ๋ง ์ ๊ณตํ๊ฑฐ๋ ๋ก๋ด ์ข ๋ฅ๋ง๋ค ๊ฐ๋ณ ์ค๊ณ๊ฐ ํ์ํ๋ฉฐ, ์ค์๊ฐ์ผ๋ก ํ์ฉํ๊ธฐ ์ด๋ ต๋ค๋ ๋จ์ ์ด ์์ต๋๋ค. ์ด์ ๋ฐํด ๋ณธ ๋ ผ๋ฌธ์์๋ ๋ก๋ด์ 6D ๊ฐ์ฉ ๊ณต๊ฐ์ ํ๋์ ํ๋ฅ ๋ถํฌ๋ก ๋ชจ๋ธ๋งํ๋ ์์ด๋์ด๋ฅผ ์ทจํ์ต๋๋ค. ๊ตฌ์ฒด์ ์ผ๋ก, ๋ก๋ด์ด ์ทจํ ์ ์๋ ์๋์ ์์น ๋ฐ ๋ฐฉํฅ ๋ฐ์ดํฐ๋ฅผ ์์ฑ ํ๋ณธ(positive examples)์ผ๋ก ์์งํ ๋ค, ์ด๋ฅผ ํ์ต์์ผ ํ๋ฅ ๋ฐ๋ ํจ์๋ก ํํํฉ๋๋ค. ์ ์๋ค์ ์ด๋ฌํ one-class ๋ถ๋ฅ ์ ๊ทผ๋ฒ์ ์ฌ์ฉํ๋ฉด, ์ค๋ก์ง ๋๋ฌ ๊ฐ๋ฅํ ๊ฒฝ์ฐ์ ๋ฐ์ดํฐ๋ง์ผ๋ก๋ ๋ก๋ด ์์ ๊ณต๊ฐ์ ์ถฉ๋ถํ ๋ฌ์ฌํ ์ ์๊ณ , ๋๋ฌ ๋ถ๊ฐ๋ฅํ ์์ญ์ ๋ํด์๋ ๋ชจ๋ธ์ ๋ฐ๋ ๊ฐ์ด ์์ฐ์ค๋ฝ๊ฒ 0์ ๊ฐ๊น์์ ธ ๊ฑฐ์ง ์์ฑ(false positive)์ ๊ฑฐ์ ๋ด์ง ์๋๋ค๊ณ ์ค๋ช ํฉ๋๋ค.
๊ฐ์ฉ ๊ณต๊ฐ ๋ชจ๋ธ ํ์ต์ ์ํ ๋ฐ์ดํฐ ํ๋์ ๋ ๊ฐ์ง ๋ฐฉ์์ผ๋ก ์ด๋ฃจ์ด์ก์ต๋๋ค. ์ฒซ์งธ, ์ธ๊ฐ ์กฐ์์ ํตํ ๋ก๋ด ํ ์๋ฒ์ ๋๋ค. ์ฐ๊ตฌ์ง์ KUKA LWR 4+ ๋ก๋ดํ์ ์ฌ๋์ด ์ง์ ์ด๋์ด(kinesthetic teaching) ๋ค์ํ ์์น๋ก ์์ง์ด๋ ์๋ฒ ์กฐ์์ ์ํํ์ฌ, ๋ก๋ด์ด ๋ฟ์ ์ ์๋ ๋๋ถ๋ถ ์์ธ๋ค์ ์์งํ์ต๋๋ค. ํนํ ๋ก๋ด์ด ๋งค๋ฒ ๋์ผํ ์ด๊ธฐ ์์ธ(๋๊ธฐ์์ธ)์์ ์ถ๋ฐํ์ฌ, ์์ ๊ณต๊ฐ ๋ด ์ฌ๋ฌ ์ง์ ์ ํฅํด ํ์ ๋ป๋ ์ฝ 20๊ฐ์ ๋ฐ๋ชจ๋ฅผ ์งํํจ์ผ๋ก์จ, ๋ก๋ด์ด ์ด๋๊น์ง ํ์ ๋ป์ ์ ์๋์ง ๋ค์ํ ๋ฐฉํฅ์ผ๋ก ๋ฐ์ดํฐ๋ฅผ ์ป์์ต๋๋ค. ๊ฐ ๋ฐ๋ชจ์ ๋ง๋จ ์์ธ(์๋ ์์น์ ์์ธ)๋ฅผ ๋ชจ์ผ๋ฉด ๋ก๋ด reachable space ๊ฒฝ๊ณ ๋ถ๊ทผ์ ํ๋ณธ์ ์ป์ ์ ์๋๋ฐ, ์ฐ๊ตฌ์ง์ 20๊ฐ ์ ๋์ ๋ฐ๋ชจ๋ก๋ ์ถฉ๋ถํ ์์ ์ ์ธ ์์ ๊ณต๊ฐ ๋ชจ๋ธ์ ํ์ตํ ์ ์์๋ค๊ณ ํฉ๋๋ค. ๋์งธ, ์ด๋ฌํ ์ธ๊ฐ ์๋ฒ ์ธ์ ์๊ณ ๋ฆฌ์ฆ์ ํ๋ณธ ์์ฑ๋ ํ์ฉ๋์์ต๋๋ค. ์๋ฅผ ๋ค์ด ๋ก๋ด์ ๊ด์ ๊ณต๊ฐ์ ์์๋ก ์ํ๋งํ์ฌ ์๋์ 6D ์์ธ๋ฅผ ๊ณ์ฐํ๊ณ , ์๊ฐ ์ถฉ๋์ด๋ ํน์ด์ ๋ฑ์ ๊ฑธ๋ฌ๋ธ ์ ํจ ์์ธ๋ค์ ๋ชจ์ ์๋ ์์ต๋๋ค. ๋ ผ๋ฌธ์์๋ ์์ธํ ๊ตฌํ์ ๋ฐํ์ง ์์์ผ๋, ์ธ๊ธ๋ Section II-B2์ ๋ฐฉ๋ฒ์ผ๋ก LWR 4+ ๋ก๋ด์ reachable space๋ฅผ ์ถ๊ฐ๋ก ๋ชจ๋ธ๋งํ๋ค๊ณ ๋์ด ์์ต๋๋ค. ๊ฒฐ๊ณผ์ ์ผ๋ก ์ด๋ ๊ฒ ์์ง๋ ์์ฒ ๊ฐ ์ด์์ ์๋ ์์ธ ๋ฐ์ดํฐ์ ๋ํด ๊ฐ์ฐ์์ ํผํฉ ๋ชจ๋ธ(GMM)์ ํ์ตํจ์ผ๋ก์จ, ๋ก๋ด ํ์ด ์ด๋ค ์์น์์ ์ด๋ค ๋ฐฉํฅ์ผ๋ก ์๋ชฉ์ ํฅํ๊ฒ ํ ์ ์๋์ง์ ๋ํ ํ๋ฅ ๋ชจ๋ธ์ ๋ง๋ค์์ต๋๋ค.

์๋ฅผ ๋ค์ด, ๋ ผ๋ฌธ์ ์ ์๋ Fig. 7์ 7-DOF LWR ๋ก๋ด์ reachable space๋ฅผ ๋ํ๋ธ ๊ทธ๋ฆผ์ผ๋ก, ๋ก๋ด ์๋์ 3์ฐจ์ ์์น๋ฅผ ๋๋ฌ์ผ ๋ฑ๊ณ ์ (plots)๊ณผ ๋์ ๊ฐ๋ฅํ ์๋ชฉ ๋ฐฉํฅ์ ๋ถํฌ๋ฅผ ์๊ฐํํ๊ณ ์์ต๋๋ค. ์ด ๋ชจ๋ธ์ ์ด์ฉํ๋ฉด, ์ด๋ค 3D ์์น๊ฐ ๋ก๋ด์ผ๋ก reachable ํ์ง๋ฅผ ๋ฐ๋ ๊ฐ์ผ๋ก ํ๋จํ ์ ์์ ๋ฟ ์๋๋ผ, ํน์ ์์น์์ ๋ก๋ด์ด ์ทจํ ์ ์๋ ์ต์ ์๋ชฉ ๋ฐฉํฅ์ด ๋ฌด์์ธ์ง๋ ์กฐ๊ฑด๋ถ ํ๋ฅ ์ง์๋ก ์ป์ ์ ์์ต๋๋ค. ์ฆ, ํ์ต๋ GMM์ผ๋ก๋ถํฐ โ๋ง์ฝ ์๋ ์์น๊ฐ (x,y,z)๋ผ๋ฉด, ๋ก๋ด ์๋ชฉ์ ์ด๋ค ๋ฐฉํฅ ์ชฝ์ผ๋ก ํฅํ ์ ์๋๊ฐ?โ๋ฅผ ์ง์ํ๋ฉด ๊ฐ์ฅ ๊ฐ๋ฅ๋ ๋์ ๋ฐฉํฅ(orientation)์ ๊ณ์ฐํ ์ ์๊ณ , ๋ฐ๋๋ก โ์๋ชฉ ๋ฐฉํฅ์ ํน์ ๊ฐ๋๋ก ์ ํ๋ฉด reachable ์์น๊ฐ ์ด๋์ธ๊ฐ?โ๋ ์ถ๋ก ํ ์ ์๋ ๊ฒ์ ๋๋ค.
ํํธ, ๋ฌผ์ฒด์ ํ์ง ๊ณต๊ฐ(graspable space) ๋ชจ๋ธ๋ง์ ๋ฌผ์ฒด๋ฅผ ์ด๋ค ์์ธ๋ก ์ฅ ์ ์๋์ง๋ฅผ ํ๋ฅ ์ ์ผ๋ก ํํํ ๊ฒ์ ๋๋ค. ๋ก๋ด์ด ๊ณต์ค์์ ๋ฌผ์ฒด๋ฅผ ์ก๋ ๊ฒฝ์ฐ, ์๋ฌด ์์น๋ ์ก๋ ๊ฒ์ด ์๋๋ผ ์ ํด์ง ๋ถ๋ถ(์: ๋ผ์ผ์ ์์ก์ด, ๋ง์น์ ์์ก์ด ๋ถ๋ถ ๋ฑ)์ ์ก์์ผ ํ๋ฉฐ, ๋ ๋ก๋ด ์๊ฐ๋ฝ์ด ๋ฌผ์ฒด๋ฅผ ๋๋ฌ์ธ๋ ๋ฐฉํฅ๋ ์ ํ๋ฉ๋๋ค. ๋ฐ๋ผ์ ๋ฌผ์ฒด๋ง๋ค ์ก๊ธฐ ์ข๊ฒ ์์ ๊ฐ์ ธ๊ฐ ์ ์๋ ์์น์ ์์ธ์ ์งํฉ์ด ์กด์ฌํ๋ฉฐ, ์ด๋ฅผ Graspable space๋ผ ์ ์ํฉ๋๋ค. ์ด ๋ํ 6์ฐจ์ ๊ณต๊ฐ(์๋์ ์๋์ ์ธ ์์น+์์ธ)์์ ๋ณต์กํ ๋ถํฌ๋ฅผ ๊ฐ์ง๋ฏ๋ก, ์๋ฒ ํ์ต์ ํตํด ๋ชจ๋ธ๋งํ์์ต๋๋ค. ์ฐ๊ตฌ์ง์ ๊ฐ ๋ฌผ์ฒด์ ๋ํด ์ธ๊ฐ์ด ์ง์ ๋ก๋ด ํ๊ณผ ์์ ์์ง์ฌ์ ๋ฌผ์ฒด๋ฅผ ์ก๋ ์๋ฒ์ ์ ๊ณตํ๊ณ , ์ด ๊ณผ์ ์์ ๋ฌผ์ฒด์ ๋ก๋ด ์์ ์๋์ ์ธ ์์น/์์ธ๋ฅผ ์บก์ณํ์ฌ ๋ฐ์ดํฐ๋ก ํ์ฉํ์ต๋๋ค. ์๋ฅผ ๋ค์ด Allegro Hand๋ก ๋ณ์ ์ก๋ ํ์ง ๊ณต๊ฐ์ ํ์ตํ๊ธฐ ์ํด, ์ฌ๋ ์ฐ๊ตฌ์๊ฐ ๋ก๋ด ํ์ ์๋์ผ๋ก ์ด๋์ด ์ฝ 15์ด ๋์ ์ฌ๋ฌ ๊ฐ๋์์ ๋ณ์ ์ฅ์ด๋ณด๋ ์๋ฒ์ ๋ณด์์ต๋๋ค. ์ด ๋์ 240Hz๋ก ๋ชจ์ ์บก์ณ ์์คํ ์ด ๋ฌผ์ฒด์ ์ขํ์ ๋ก๋ด ์๋์ ์ขํ๋ฅผ ๋๊ธฐํํ์ฌ ๊ธฐ๋กํ์๊ณ , ์ด ์ฝ 3600๊ฐ์ ์๊ฐ ์์ธ ํ๋ณธ์ ์ป์์ต๋๋ค. ์ด๋ ๊ฒ ๋ชจ์ธ ๋ฐ์ดํฐ ์ค ๋ํ์ ์ธ 300๊ฐ ํ๋ณธ์ ๋ฌด์์ ์ถ์ถํ์ฌ GMM ํ์ต์ ์ฌ์ฉํจ์ผ๋ก์จ, ํด๋น ๋ฌผ์ฒด๋ฅผ ์ก์ ์ ์๋ ์ ์์น/๋ฐฉํฅ์ ํ๋ฅ ๋ชจ๋ธ์ ๊ตฌ์ถํ์ต๋๋ค. Fig. 4์ ๊ทธ ์์๊ฐ ์ ์๋์ด ์๋๋ฐ, (a)๋ ๋ก๋ด ์, (b)๋ ์๋ฒ ๊ณผ์ , (c)๋ ์๋ฒ์ผ๋ก ์ป์ ํ์ง ์์ธ ํ๋ณธ ๋ถํฌ, (d)๋ GMM์ผ๋ก ๋ชจ๋ธ๋งํ ํ ํน์ ์์น์์์ ์๋ชฉ๋ฐฉํฅ ๊ฐ๋ฅ๋ ๋ถํฌ ๋ฑ์ผ๋ก ๊ตฌ์ฑ๋์ด ์์ต๋๋ค. ์ด๋ฅผ ํตํด ๋ฌผ์ฒด์ ๋ํด โ์ด๋ค ์๋์ ์์ธ๋ก ๋ก๋ด ์์ ๊ฐ์ ธ๊ฐ๋ฉด ์ก์ ์ ์๋คโ๋ฅผ ํ๋ฅ ์ ์ผ๋ก ํํํ ์ ์๊ฒ ๋์์ต๋๋ค.
๊ฐ์ฉ ๊ณต๊ฐ ๋ชจ๋ธ๊ณผ ํ์ง ๊ณต๊ฐ ๋ชจ๋ธ์ด ๋ชจ๋ ์ค๋น๋์๋ค๋ฉด, ์ด์ ๋นํ ๋ฌผ์ฒด๋ฅผ ์ธ์ ์ด๋์ ์ก์์ง ๊ฒฐ์ ํ๋ ์ผ๋ง ๋จ์ต๋๋ค. ์ ์๋ค์ ๋ ๋ชจ๋ธ์ ํตํฉ์ ์ผ๋ก ํ์ฉํ์ฌ ์ต์ ์ catching ์์ธ์ ์์ ์ ์ฐ์ถํ๋ ์๊ณ ๋ฆฌ์ฆ์ ๊ตฌํํ์ต๋๋ค. ๊ฐ๋ต์ ์ธ ๊ณผ์ ์ ๋ค์๊ณผ ๊ฐ์ต๋๋ค. ์ฐ์ ์์ ์ค๋ช ํ SVR ๊ธฐ๋ฐ ๋ฌผ์ฒด ๊ถค์ ์์ธก ๋ชจ๋์ ํตํด, ๋ฌผ์ฒด๊ฐ ์์ผ๋ก ๋นํํ ๊ฒฝ๋ก(์ฐ์์ ์ธ ์์น์ ์์ธ์ ์๊ฐ ํจ์)๋ฅผ ์์ธกํฉ๋๋ค. ์ด ์์ธก ๊ถค์ ์์์ ์ผ์ ํ ์๊ฐ ๊ฐ๊ฒฉ์ผ๋ก ํ๋ณด ํฌ์ธํธ(๋ฏธ๋ ์๊ฐ t_i์์์ ๋ฌผ์ฒด ์์ธ)๋ฅผ ์ํ๋งํฉ๋๋ค. ๊ทธ๋ฐ ๋ค์ ๊ฐ ํ๋ณด (p_i, q_i)์ ๋ํด ๋ก๋ด์ด ๊ทธ ์ง์ ์์ ์ก์ ์ ์๋์ง๋ฅผ ํ๊ฐํ๋๋ฐ, ์ด๊ฒ์ด ๋ฐ๋ก reachable-space ๋ชจ๋ธ๊ณผ graspable-space ๋ชจ๋ธ์ ๊ฒฐํฉ ํ๋จ์ ๋๋ค. ๊ตฌ์ฒด์ ์ผ๋ก, ํ๋ณด ๋ฌผ์ฒด ์์ธ (p_i, q_i)๊ฐ ์ฃผ์ด์ง๋ฉด ์ฐ์ ๋ก๋ด ๊ฐ์ฉ ๊ณต๊ฐ ๋ชจ๋ธ์ ์ด์ฉํด ๊ทธ ์์น p_i์์ ๋ก๋ด ์๋์ด ์ทจํ ์ ์๋ ๋ฐฉํฅ ๋ถํฌ๋ฅผ ๊ณ์ฐํ ์ ์์ต๋๋ค. ๋์์ ํ์ง ๊ณต๊ฐ ๋ชจ๋ธ๋ก๋ถํฐ๋ ๋ฌผ์ฒด๊ฐ ์์ธ q_i์ผ ๋ ๋ก๋ด ์์ด ์ทจํด์ผ ํ ์๋ ๋ฐฉํฅ์ ์ป์ต๋๋ค. ์ด ๋์ด ์ผ์นํ๋ค๋ฉด (์ฆ, ๋ฌผ์ฒด์ ๊ทธ ์์ธ์์ ๋ก๋ด์ด ์์ ๋ฃ์ด ์ก์ ์ ์๋ ๊ฒฝ์ฐ), ํด๋น ์ง์ ์ ์ ํจํ catching ์์ธ๊ฐ ๋ฉ๋๋ค. ๋ ผ๋ฌธ์์๋ ์ด ๊ณผ์ ์ ๋์ฑ ํจ์จํํ๊ธฐ ์ํด, ์์ reachable-space์ graspable-space๋ฅผ ํ๋์ ๊ฒฐํฉ ํ๋ฅ ๋ชจ๋ธ M_{\text{joint}}๋ก ๊ฐ์ฃผํ์ฌ, ํน์ ๋ฌผ์ฒด ์์ธ์ ๋ํ ๊ณต๋ ํ๋ฅ ๋ฐ๋๋ฅผ ๊ณ์ฐํ๋ ๋ฐฉ๋ฒ์ ์ทจํ์ต๋๋ค. ์๋ฅผ ๋ค์ด โ์๊ฐ t_i์ ๋ฌผ์ฒด๊ฐ ์์ธ (p_i, q_i)์ผ ํ๋ฅ โ๊ณผ โ๊ทธ๋ ๋ก๋ด ์์ด ์์ธ (p_i, o) (์ด๋ค ๋ฐฉํฅ o)๋ก ๋๋ฌํ ์ ์์ ํ๋ฅ โ์ ํจ๊ป ๊ณ ๋ คํ๋ ์์ ๋๋ค. ์ด joint ๋ชจ๋ธ์ ๋ฐ๋๊ฐ ๊ฐ์ฅ ๋์ (p, q, o, t) ์กฐํฉ์ด ๋ฐ๋ก ์ต์ ์ก๊ธฐ ์์ธ ๋ฐ ์์ ์ผ๋ก ์ ํ๋ฉ๋๋ค. ์ ์๋ค์ ์ฌ๊ธฐ์ ํ๋์ ์ถ๊ฐ์ ์ธ ํด๋ฆฌ์คํฑ์ ์ ์ฉํ๋๋ฐ, ์ก๊ธฐ ์ง์ ๋ก๋ด ์๋ฐ๋ฅ์ ๋ฐฉํฅ์ด ๋ ์์ค๋ ๋ฌผ์ฒด์ ์ด๋ ๋ฐฉํฅ์ ์ ํํ ๋ฐ๋๊ฐ ๋๋๋ก ์์ธ๋ฅผ ์ ์ ํ์์ต๋๋ค. ์ด๋ ๋ฌผ์ฒด๋ฅผ ๋ฐ์ณ์ ์ถฉ๊ฒฉ์ ํก์ํ๊ณ ํ๋ฆฌ์ง ์๊ธฐ ์ํ ๊ฒ์ผ๋ก, ์๋ฅผ ๋ค์ด ๊ณต์ด ๋ ์์ฌ ๋ ์๋ฐ๋ฅ์ด ๊ณต์ ์งํ ๋ฐฉํฅ์ ํฅํด ์์ด์ผ ํ๊ฒจ๋ด์ง ์๊ณ ํ์ ์ ์๋ ๊ฒ๊ณผ ๊ฐ์ ์๋ฆฌ์ ๋๋ค.
์์ ๊ฐ์ ์ ์ฐจ๋ฅผ ํตํ๋ฉด, ๋งค ์๋ก์ด ์ผ์ ๊ด์ธก ์์ ๋ง๋ค ๋ก๋ด ์์คํ ์ ํ์ฌ ์ถ์ ๋ ๋ฌผ์ฒด ์ํ๋ก๋ถํฐ ๋ฏธ๋์ ์ก๊ธฐ ์ง์ ๊ณผ ์๊ฐ์ ์ง์์ ์ผ๋ก ์ ๋ฐ์ดํธํ๊ฒ ๋ฉ๋๋ค. ๋ ผ๋ฌธ์์๋ ์ด ๊ณผ์ ์ Thread 1๋ก ๋ช ๋ช ํ์ฌ, ๋ฌผ์ฒด ๊ถค์ ์์ธก๊ณผ ์ต์ ์์ธ ๊ณ์ฐ์ด ๋ณ๋ ฌ ์ฐ๋ ๋๋ก ์์ ์คํ๋จ์ ์ค๋ช ํฉ๋๋ค. ์ด ์ฐ๋ ๋๋ ์๋ก์ด ์นด๋ฉ๋ผ ์ธก์ ์ด ๋ค์ด์ฌ ๋๋ง๋ค ๋ฌผ์ฒด์ ๋จ์ ๊ถค์ ์ ๋ค์ ์์ธกํ๊ณ , ์ต์ ์ catching ์์ /์์ธ๋ฅผ ๋ค์ ๊ณ์ฐํ์ฌ ๊ฐฑ์ ํฉ๋๋ค. ์ด๋ ๊ฒ ๊ณ์ฐ๋ ๋ชฉํ catching ์์ธ๋ Thread 2์ธ ๋ก๋ด ํ ์ ์ด๊ธฐ์ ์ค์๊ฐ์ผ๋ก ์ ๋ฌ๋์ด, ๋ก๋ด ํ์ด ๊ทธ ์ง์ ์ผ๋ก ์ด๋ํ๋๋ก ์ ๋๋ฉ๋๋ค. ๋ ์ฐ๋ ๋์ ์ํธ์์ฉ์ ๋ ผ๋ฌธ์ Fig. 2 ๋ธ๋ก ๋ค์ด์ด๊ทธ๋จ์ ์ ๋ํ๋ ์์ผ๋ฉฐ, ์ด๋ฌํ ๊ณ์์ ์ธ ์ฌ๊ณํ(replanning) ๋๋ถ์ ์ผ์ ์ง์ฐ์ด๋ ์์ธก ์ค์ฐจ๊ฐ ์กฐ๊ธ์ฉ ๋์ ๋๋๋ผ๋ ๋ก๋ด์ด ์ก๊ธฐ ์ง์ ๊น์ง ๊ถค์ ์ ์์ ํ์ฌ ์ ๋ฐํ ํฌํ์ด ๊ฐ๋ฅํด์ง๋๋ค. ๋ค๋ง, ์ค์ ์์คํ ์์๋ ๋ฌผ์ฒด๊ฐ ๋ก๋ด์ ๋๋ฌด ๊ฐ๊น์ด ์ ๊ทผํ ๋ง์ง๋ง 0.09์ด ์ ๋ ์ ๋ถํฐ๋ ๋ ์ด์ ๊ณํ์ ๋ณ๊ฒฝํ์ง ์๊ณ ์ต์ข ๋์์ ์ง์คํ๋๋ก ํ์์ต๋๋ค. ์ด๋ ๋ฌผ์ฒด๊ฐ ๋์์ ๊ทผ์ ํ์ ๋ ํ๋ฐฉ ์นด๋ฉ๋ผ ์์ผ์์ ๋ถ๋ถ์ ์ผ๋ก ์ฌ๋ผ์ ธ ์์น ์ถ์ ์ด ํ๋ค๋ฆด ์ ์๊ณ , ์๊ณ์๊ฐ ๋ด์ ์๋ก์ด ๊ณ์ฐ์ ๋ฐ์ํ๊ธฐ ์ด๋ ค์์ง ์ ์๊ธฐ ๋๋ฌธ์ ๋๋ค. ๋ฐ๋ผ์ ์ก๊ธฐ 90ms ์ ์ ์ต์ข ์ปคํธ์คํ๋ก ๋๊ณ , ๊ทธ ์ดํ์๋ ํ์ฌ ๊ณํ๋๋ก ์๊ฐ๋ฝ์ ๋ซ๋ ๋์๊น์ง ์ํํ๋๋ก ์ค๊ณ๋์์ต๋๋ค.
์์ฝํ๋ฉด, ์ ์๋ ๋ฐฉ๋ฒ์ ํ๋ฅ ์ ๋ชจ๋ธ๋ง์ ํตํด ๋ก๋ด์ ๊ฐ๋ฅํ ์์ธ ๊ณต๊ฐ๊ณผ ๋ฌผ์ฒด์ ์ก๊ธฐ ๊ฐ๋ฅํ ์์ธ๋ฅผ ํ๋๋ก ํตํฉํ ๋ค, ์ค์๊ฐ ๊ถค์ ์์ธก๊ณผ ๊ฒฐํฉํ์ฌ ๋ฐ๋ฆฌ์ด ๋จ์๋ก ์ต์ ์ธํฐ์ ํธ ์ง์ ์ ์ฐพ์๋ด๋ ์๊ณ ๋ฆฌ์ฆ์ ๋๋ค. ์ด๋ฌํ ์ ๊ทผ์ ๊ธฐ์กด์ ๊ธฐํํ์ /๊ฒฉ์ ๊ธฐ๋ฐ ๋ฐฉ๋ฒ์ ๋นํด ํจ์ฌ ๋งค๋๋ฝ๊ณ ์ฐ์์ ์ธ ํด๊ฒฐ์ฑ ์ ์ฃผ๋ฉฐ, ๊ณ์ฐ ๋น์ฉ๋ ๋ฎ์์ 2.7GHz CPU์์ 0.2๋ฐ๋ฆฌ์ด ๋ง์ ์ก๊ธฐ ์์ธ๋ฅผ ๊ฒฐ์ ํ ์ ์์๋ ๊ฒ์ผ๋ก ๋ณด๊ณ ๋ฉ๋๋ค. ์ด๋ ๋ก๋ด์ด ๊ณต์ค์ ๋ ์๋ ๋ฌผ์ฒด๋ฅผ ์ก๊ธฐ ์ํด ์ธ ์ ์๋ ์๊ฐ ์ฌ์ ๊ฐ ๋ง์ง ์์ ๋(๋ณดํต <0.5โ0.7์ด)์ ํฐ ๊ฐ์ ์ด ๋ฉ๋๋ค.
2.5 ๋ก๋ด ํ-์ ์ด๋ ๊ณํ๊ณผ ์ ์ด (Reactive Arm-Hand Control)
์ก๊ธฐ ์์ ๊ณผ ๋ชฉํ ์์ธ๊ฐ ์ ํด์ง๋ฉด, ์ด์ ๋ก๋ด์ ๊ทธ์ ๋ง์ถ์ด ํ์ ์์ง์ด๊ณ ์๊ฐ๋ฝ์ ์ ์ดํด์ผ ํฉ๋๋ค. ์ด ๋ ผ๋ฌธ์์๋ ๋ก๋ด ํ์ ๊ถค์ ์ ์์ฑํ๊ธฐ ์ํด ์์ ์ ์ธ ๋์ ์์คํ ๊ธฐ๋ฐ ์ ์ด๊ธฐ๋ฅผ ์ฌ์ฉํ์์ต๋๋ค. ์ด๋ ์ ์๋ค์ด ์ด์ ์ฐ๊ตฌ๋ค์์ ๊ฐ๋ฐํ ๊ธฐ๋ฒ์ผ๋ก, ์ฌ๋ฌ ์์ฐ ๊ถค์ ์ ์ผ๋ฐํํ์ฌ ์ข ๋ฃ ์์ (equilibrium stable)ํ ๋ฒกํฐ์ฅ ํํ๋ก ํ์ตํ๋ ์๊ฐ-๋ถ๋ณ DS ๊ธฐ์ ์ ๋๋ค. ๊ฐ๋จํ ๋งํด, ์ฌ๋์ด ๊ฐ๋ฅด์ณ์ค ๋ช ๊ฐ์ง ๊ฒฝ๋ก๋ฅผ ์์ ๋กญ๊ฒ ๋ค์์ด๋ ๋ชฉํ์ ์ ์๋ ดํ๋๋ก ๋ณด์ฅ๋๋ ์ฐ์ ํจ์ ํํ๋ก ๋ชจ๋ธ๋งํ๋ ๊ฒ์ผ๋ก, SEDS (Stable Estimator of Dynamical Systems) ๋ฑ์ ์๊ณ ๋ฆฌ์ฆ์ ์์ฉํ ๋ฐฉ๋ฒ์ ๋๋ค. ์ด DS ์ ์ด๊ธฐ์ ์ฅ์ ์ ํ์ฌ ์ํ๋ฅผ ์ ๋ ฅํ๋ฉด ๋ค์์ ์ด๋ ๋ฐฉํฅ์ผ๋ก ์์ง์ผ์ง ์ฆ๊ฐ ์ถ๋ ฅํด์ฃผ๋ ํํ์ด๋ฏ๋ก, ๋ก๋ด์ด ๋ชฉํ์ ๋๋ฌํ ๋๊น์ง ๋ซํ ํ์(closed-form)์ผ๋ก ์ญ ๋ฐ๋ผ๊ฐ๋ ์ฐ์ ๊ถค์ ์ ๋ง๋ค์ด์ค๋ค๋ ์ ์ ๋๋ค. ํนํ DS๋ ์๊ฐ ๋งค๊ฐ๋ณ์๊ฐ ์์ด ๋ชฉํ์ ๋ง ํฅํ๋๋ก ์ค๊ณ๋๋ฏ๋ก, ์์ธก๋๋ ๋ชฉํ ์์น๋ ํ์ ๊ฒฝ๋ก๊ฐ ์ค์๊ฐ์ผ๋ก ๋ฐ๋์ด๋ ๊ทธ๋๊ทธ๋ ์๋ก์ด ๋ฒกํฐ์ฅ์ ๋ฐ๋ผ๊ฐ๋ฉด ๋ฉ๋๋ค.
๋ ผ๋ฌธ์์๋ ์ด DS ๊ธฐ๋ฐ ํ ์ ์ด๊ธฐ๋ฅผ ํ์ตํ๊ธฐ ์ํด 20๊ฐ์ ํ ์์ง์ ์๋ฒ์ ์ฌ์ฉํ์ต๋๋ค. ์์ ๊ฐ์ฉ ๊ณต๊ฐ ๋ชจ๋ธ์ ์์งํ ๋์ ๋์ผํ ๋ฐฉ๋ฒ์ผ๋ก, ์ฐ๊ตฌ์๋ ๋ก๋ด ํ์ ์ด๊ธฐ์์ธ์์ ์์ํ์ฌ ์ฌ๋ฌ ๊ฐ์ง ์ก๊ธฐ ๋ชฉํ ์์ธ๊น์ง ์ด๋๋ ๋ฐ๋ชจ๋ค์ ์ํํ์ต๋๋ค. ๊ฐ ๋ฐ๋ชจ๋ ์์ (๋๊ธฐ์์ธ)๋ถํฐ ๋ (์ก๊ธฐ์์ธ)๊น์ง ํ์ ๊ถค์ ์ ์ ๊ณตํ๋ฉฐ, ์ด๋ ๊ฒ ๋ชจ์ธ ๋ค์์ ๊ฒฝ๋ก๋ฅผ Gaussian Mixture Model๋ก ํ์ตํ ํ Dynamical System์ผ๋ก ๋ณํํ์ฌ ํ ์์ง์์ ์์ฑํฉ๋๋ค. ๊ฒฐ๊ณผ์ ์ผ๋ก, ๋ก๋ด ํ์ ํ์ฌ ์์ ์ ์๋ ์์น๊ฐ ์ด๋์ ์๋ ์ง ๊ฐ์ DS๊ฐ ์ง์ํ๋ ๋ฐฉํฅ์ผ๋ก ์์ง์ด๋ฉด ์์ฐ์ค๋ฝ๊ฒ ๋ชฉํ ์ก๊ธฐ ์์ธ๋ก ์๋ ดํ๊ฒ ๋ฉ๋๋ค. ๋ํ ์ก๊ธฐ ๋ชฉํ ์์ฒด๊ฐ ์์ง์ด๋ ๊ฒฝ์ฐ(์: ์์ธก์ด ๋ณ๊ฒฝ๋ ๊ฒฝ์ฐ)์๋, DS๋ ์๋ก์ด ๋ชฉํ๋ฅผ ํฅํด ์ฐ์์ ์ผ๋ก ๋ฐฉํฅ์ ์์ ํด์ฃผ๋ฏ๋ก, ๋ง์น ๋ชฉํ๋ฅผ ์ถ์ ํ๋ ์ ๋์ฅ์น์ฒ๋ผ ํ์ ๋ชฐ๊ณ ๊ฐ๋ ํจ๊ณผ๋ฅผ ๋ ๋๋ค.
ํ์ง๋ง ๋ฌผ์ฒด ์ก๊ธฐ ๋์์์๋ โ์ธ์ ๋์ฐฉํ๋๊ฐโ ๋ํ ๋งค์ฐ ์ค์ํฉ๋๋ค. DS ๋จ๋ ์ผ๋ก๋ ์๊ฐ์ ๋ํ ๊ฐ๋ ์ด ์๊ธฐ ๋๋ฌธ์ ๋ชฉํ์ ์๋ ์๋ ดํ์ง๋ง ์ฃผ์ด์ง ์๊ฐ ๋ด ๋๋ฌ์ ๋ณด์ฅํ ์ ์์ต๋๋ค. ์ด๋ฅผ ์ํด ๋ ผ๋ฌธ์์๋ ํ์ด๋ฐ ์กฐ์ ๊ธฐ(timing controller)๋ฅผ ๋์ ํ์ต๋๋ค. ํ์ด๋ฐ ์กฐ์ ๊ธฐ๋ ํ์ฌ ๋จ์ ์๊ฐ๊ณผ ๊ฑฐ๋ฆฌ๋ฅผ ๋ฐํ์ผ๋ก DS ์ถ๋ ฅ์ ์ค์ผ์ผ๋งํ์ฌ, ๋ก๋ด์ด ์ ํํ ๋ฌผ์ฒด ๋์ฐฉ ์๊ฐ์ ๋ง์ถฐ ๋๋ฌํ๋๋ก ์๋๋ฅผ ์กฐ์ ํฉ๋๋ค. ์๋ฅผ ๋ค๋ฉด, ์ฒ์ ์์ธก์ผ๋ก๋ ์ก๊ธฐ ์์ ์ด 0.5์ด ๋ค๋ก ๊ณํ๋์๋ค๊ฐ ์ดํ ์์ธก์ด 0.6์ด๋ก ์์ ๋๋ฉด, DS์ ์งํ ์๋๋ฅผ 20% ๋ฆ์ถ์ด ํ์ด ์ฝ๊ฐ ์ฒ์ฒํ ์์ง์ด๋๋ก ๋ง๋๋ ์์ ๋๋ค. ๋ฐ๋๋ก ์๊ฐ์ด ์ด๋ฐํด์ง๋ฉด DS์ ์ค์ผ์ผ์ ํค์ ์ต๋ ์๋ ํ๊ณ๊น์ง ๋ ๋นจ๋ฆฌ ์์ง์ด๋๋ก ํฉ๋๋ค. ์ด ํ์ด๋ฐ ์กฐ์ ์ ์์๋ก ์๋ํ์ฌ, ์์ธก ์๊ฐ์ด ๋ฐ๋ ๋๋ง๋ค ๋ก๋ด์ด ๊ทธ ์๋ก์ด ์๊ฐ์ ๋ง์ถฐ ๋๋ฌํ๋๋ก ํด์ค๋๋ค. ๋จ, ๋ก๋ด์ ๋ฌผ๋ฆฌ์ ํ๊ณ๋ฅผ ๋์ด์๊น์ง ๋ณด์ํ ์๋ ์๊ธฐ ๋๋ฌธ์, ๋ง์ฝ ๋ชฉํ ์ก๊ธฐ ์์ธ์ ๋๋ฌํ๋ ค๋ฉด ์ฒ์ ์์ธ์์ ๋๋ฌด ํฌ๊ฒ ์์ง์ฌ์ผ ํ๋ ๊ฒฝ์ฐ(์: ๋ฐ๋ํธ์ ๋์ ธ์ก๋๋ฐ ๋ก๋ด์ด ๋์๊ฐ์ผ ํ๋ค๊ฑฐ๋)์๋ ์ต๋ ์๋๋ก๋ ์๊ฐ ๋ด ๋๋ฌ์ด ๋ถ๊ฐ๋ฅํ ์ ์์ต๋๋ค. ๊ทธ๋ฐ ์ํฉ์ ์คํจ ์๋๋ก ๊ฐ์ฃผ๋๋ฉฐ, ๋ ผ๋ฌธ์์๋ ์คํจ ์ฌ๋ก์ ์ฝ 12๊ฑด์ด ์ด๋ฌํ ๋์ญํ์ ์ผ๋ก ๋ถ๊ฐ๋ฅํ ๋ชฉํ ๋๋ฌธ์ด์๋ค๊ณ ๋ณด๊ณ ํ๊ณ ์์ต๋๋ค.
์ด์ ์๊ฐ๋ฝ ์ ์ด๋ฅผ ์ดํด๋ณด๊ฒ ์ต๋๋ค. ์์ ๊ฐ์กฐํ๋ฏ, ๋ณธ ์ฐ๊ตฌ๋ ํ(์๋ชฉ)๊ณผ ์๊ฐ๋ฝ์ ์์ง์์ ๋ฐ์ ํ ์ฐ๋์์ผฐ์ต๋๋ค. ์ด๋ฅผ ์ํด ํ ๋์์ ๋ด๋นํ๋ DS๋ฅผ ๋ง์คํฐ(master) DS, ์๊ฐ๋ฝ ์ชฝ์ ๋ด๋นํ๋ DS๋ฅผ ์ฌ๋ ์ด๋ธ(slave) DS๋ก ์ค์ ํ ์ฐํฉ Dynamical System (CDS) ๊ตฌ์กฐ๋ฅผ ์ฌ์ฉํ์ต๋๋ค. ํ์ end-effector ์ํ (์์น \xi_h \in \mathbb{R}^3, ์๋ชฉ ์์ธ๋ ๋ณ๋ \xi_o \in \mathbb{R}^3 ์ถ๊ฐ(axis-angle) ํํ)์ ์๊ฐ๋ฝ ๋ฒ์ด์ง ์ ๋ (\xi_f \in \mathbb{R}, ์ด๋ฅผ ์ฌ๋ฌ ์๊ฐ๋ฝ ์กฐ์ธํธ๋ก ๋งคํ) ๋ฑ์ ๋ชจ๋ ์ํ๋ก ํฌํจํ๋ ๊ฒฐํฉ ์์คํ ์ ๊ตฌ์ฑํ ๊ฒ์ ๋๋ค. ๋ง์คํฐ DS๋ ํ์ ๊ถค์ ์ ์์ฑํ๊ณ , ์ฌ๋ ์ด๋ธ DS๋ ์๊ฐ๋ฝ์ ๊ถค์ (๋ฒ๋ฆฌ๊ณ ์ฅ๋ ๋์)์ ์์ฑํ๋, ์ฌ๋ ์ด๋ธ๋ ๋ง์คํฐ์ ์งํ ์ํฉ์ ๋ฐ๋ผ ๊ฒฐ์ ๋๋๋ก ์ค๊ณ๋์์ต๋๋ค. ์ฝ๊ฒ ๋งํด, ํ์ด ๋ชฉํ์ ๊ฐ๊น์์ง์ ๋ฐ๋ผ ์๊ฐ๋ฝ์ด ๋ซํ๋ ์๋๊ฐ ๋นจ๋ผ์ง๊ฑฐ๋, ํ์ ์๋๊ฐ ๋๋ ค์ง๋ฉด ์๊ฐ๋ฝ ๋์๋ ์ง์ฐ๋๋ ์์ผ๋ก ์ํธ ๊ฒฐํฉ(coupling)๋ ๊ฒ์ ๋๋ค. ์ด ๋ชจ๋ธ์ ํ์ต์ํค๊ธฐ ์ํด, ์ฐ๊ตฌ์ง์ ๋ณ๋์ ๋ฐ๋ชจ ์คํ๋ ์ํํ์ต๋๋ค. ์ฌ๋์๊ฒ ์ผ์๋ฅผ ์ฅ์ฐฉํ์ฌ ์ง์ ๋ฌผ์ฒด๋ฅผ ์ก๊ฒ ํ๊ณ , ์ด ๋ ์์ ๊ถค์ ๊ณผ ์๊ฐ๋ฝ ๊ตฝํ ๊ฐ๋ ๋ณํ๋ฅผ ๊ธฐ๋กํ์ฌ ํ-์ ์ฐ๋ ๋์์ ์์๋ก ์ผ์์ต๋๋ค. ๊ตฌ์ฒด์ ์ผ๋ก, 5DT ๋ฐ์ดํฐ ๊ธ๋ฌ๋ธ๋ก ์ฌ๋ ์๊ฐ๋ฝ ๊ด์ ๊ฐ์ ์ธก์ ํ๊ณ , ๋ชจ์ ์บก์ณ๋ก ๋ฌผ์ฒด์ ์์ ์์น๋ฅผ ์ถ์ ํ๋ฉด์, ์ฌ๋์ด ๊ณต์ค์ ๋์ ธ์ง ๋ฌผ์ฒด๋ฅผ ํ ์์ผ๋ก ์ก๋ ๋์์ ์ฌ๋ฌ ์ฐจ๋ก ์ํํ์ต๋๋ค. ์ด ๋ฐ์ดํฐ๋ฅผ ํตํด โํ์ด ์ด๋งํผ ์์ง์์ ๋ ์๊ฐ๋ฝ์ ์ผ๋ง๋ ๋ซํ์ผ ํ๋๊ฐโ์ ๊ด๊ณ๋ฅผ ํ์ตํ๊ณ , CDS์ ๋ง์คํฐ-์ฌ๋ ์ด๋ธ DS ๊ฐ ๊ฒฐํฉ ํจ์๋ฅผ ๊ตฌํ์ต๋๋ค. ๋ ผ๋ฌธ์์๋ ์๊ฐ๋ฝ ๋์์ ํ ๋์์ ํน์ ์งํ(distance)์ ๋ฐ๋ผ ํธ๋ฆฌ๊ฑฐํ๋ ๋์ , ์ด๋ฌํ ๋ฐ์ดํฐ ๊ธฐ๋ฐ ๊ฒฐํฉ ๋ชจ๋ธ์ ์ฌ์ฉํจ์ผ๋ก์จ ๋ณ๋์ ํ๋ ์์ด๋ ์๊ฐ๋ฝ์ด ์ ํํ ํ์ด๋ฐ์ ๋ซํ๋๋ก ๋ง๋ค์๋ค๊ณ ๊ฐ์กฐํฉ๋๋ค. Fig. 15์๋ Barrett Hand๋ฅผ ์ฌ์ฉํ ํ-์ CDS ์ ์ด ๊ตฌ์ฑ์์๋ค์ด ์ ์๋์ด ์๊ณ , Fig. 16์๋ ์ค์ ์ก๊ธฐ ๋์ ์ ๋ก๋ด ํ์ ๊ถค์ ์ด ์์ธก ๊ถค์ ์ ๊ณ์ ์ถ์ข ํ๋ฉด์ ์๊ฐ์ ๋ง์ถฐ ๋๋ฌํ๋ ๋ชจ์ต์ด ๊ทธ๋ ค์ ธ ์์ต๋๋ค.
์ต์ข ์ ์ผ๋ก, ๋ก๋ด ์ ์ด ์์คํ ์ Thread 2 (Arm Controller)๋ก ๊ตฌํ๋์ด 500 Hz ์ฃผ๊ธฐ๋ก ๋์ํฉ๋๋ค. ์ด ์ ์ด ์ค๋ ๋๋ ๋งค ์ฃผ๊ธฐ๋ง๋ค ํ์ฌ ๋ก๋ด ํ์ ์ํ์ Thread 1์ด ์ ๋ฐ์ดํธํ ์ต์ ๋ชฉํ(์ก๊ธฐ ์์น, ๋๋ฌ ์๊ฐ)๋ฅผ ๋ฐ์์, CDS ์ปจํธ๋กค๋ฌ๋ฅผ ํตํด ๋ค์ ์๊ฐ์ ํ-์์๋ ๋ช ๋ น์ ๊ณ์ฐํฉ๋๋ค. ๊ณ์ฐ๋ ๋ก๋ด ์๋์ ๋ชฉํ ๋ณํ(์ ์๋, ๊ฐ์๋)๋ ๋ค์ ์ญ๊ธฐ๊ตฌํ(IK) ๋ชจ๋์ ๊ฑฐ์ณ 7๊ฐ ๊ด์ ์ ๋ชฉํ ํ์ ๊ฐ์ผ๋ก ๋ณํ๋๋ฉฐ, ์๊ณ ๊ฐ์ ํํฐ(critically damped filter)๋ก ์ ํธ๋ฅผ ๋ถ๋๋ฝ๊ฒ ํ ๋ค ๋ก๋ด์ ์ ์ก๋ฉ๋๋ค. KUKA LWR 4+ ๋ก๋ดํ์ ์์ฒด ๋ด์ฅ ์ ์ด๊ธฐ๋ก 500Hz์ ์์น ์ ์ด๊ฐ ๊ฐ๋ฅํ๋ฏ๋ก, ํธ์คํธ ์ปดํจํฐ์์ ๋ณด๋ธ ๊ด์ ๊ฐ ๋ช ๋ น์ ์ค์๊ฐ์ผ๋ก ์ถ์ข ํ๊ฒ ๋ฉ๋๋ค. ์ด์ฒ๋ผ ์์ธก-๊ณํ ์ฐ๋ ๋์ ์ ์ด๊ธฐ ์ฐ๋ ๋๊ฐ ๋์์ ๋์๊ฐ๋ฉด์, ๋ก๋ด์ ๋ฌผ์ฒด๋ฅผ ํฅํด ํ์ ๋ป๊ณ ์๊ฐ๋ฝ์ ๋ฒ๋ฆฐ ์ฑ ์ ๊ทผํ๋ค๊ฐ, ์ ์ ํ ์๊ฐ์ ์๊ฐ๋ฝ์ ์ค๋ฏ๋ ค ๋ฌผ์ฒด๋ฅผ ๋ถ์ก๊ฒ ๋ฉ๋๋ค.
2.6 ์คํ ๊ฒฐ๊ณผ ๋ฐ ๋ถ์
๋ ผ๋ฌธ์์๋ ์ ์๋ ์์คํ ์ ์๋ฎฌ๋ ์ดํฐ์ ์ค์ ๋ก๋ด ์์ชฝ์์ ๊ฒ์ฆํ์์ต๋๋ค. ์๋ฎฌ๋ ์ด์ ์คํ์ iCub ํด๋จธ๋ ธ์ด๋ ๋ก๋ด์ ์๋ฐ์ ๋ชจ๋ธ์ ์ฌ์ฉํ๊ณ , ์ค์ ์คํ์ KUKA LWR 4+ (7-์์ ๋ ๋ก๋ดํ)์ SimLab Allegro Hand (4์ง ๋ก๋ด ์)๋ฅผ ์ฅ์ฐฉํ ๊ตฌ์ฑ์ผ๋ก ์งํ๋์์ต๋๋ค. ๋ฌผ์ฒด ์ธ์ ๋ฐ ์ถ์ ์ ์ํด OptiTrack ๋ค์ค ์นด๋ฉ๋ผ ๋ชจ์ ์บก์ณ ์์คํ ์ด ์ด์ฉ๋์์ผ๋ฉฐ, ๋ฌผ์ฒด๋ง๋ค ํ๋ฉด์ ๋ฐ์ฌ ๋ง์ปค 3๊ฐ๋ฅผ ๋ถ์ฐฉํ์ฌ 240 Hz๋ก 6DOF ์์ธ๋ฅผ ์ธก์ ํ์ต๋๋ค. ์ฃผ์ ์คํ ์๋๋ฆฌ์ค๋ ์ฌ๋์ด ๋ฌผ์ฒด๋ฅผ ๋ก๋ด์ ํฅํด ๋์ง๋ฉด ๋ก๋ด์ด ์ด๋ฅผ ๋ฐ์์ก๋ ํํ๋ก, ๋์ง๋ ์ด๊ธฐ ์กฐ๊ฑด(์์น, ์๋, ๊ฐ์๋)์ ์คํ๋ง๋ค ๋ฌด์์๋ก ์กฐ๊ธ์ฉ ๋ฌ๋ฆฌํ์ฌ ๋ค์ํ ์ํฉ์ ์ํํ์ต๋๋ค. ํนํ ๋ฌผ์ฒด๋ก๋ ๋ง์น, ํ ๋์ค ๋ผ์ผ, ๋น ํ๋ผ์คํฑ ๋ณ, ์ ๋ฐ๊ฐ๋ ๋ฌผ์ด ๋ ๋ณ, ์์ ๋ฐ์ค ๋ฑ์ ์ฌ์ฉํ์ฌ, ๋ฌผ์ฒด์ ์ง๋ ๋ถํฌ์ ๊ณต๊ธฐ์ญํ์ ํน์ฑ์ด ํฌ๊ฒ ๋ค๋ฅด๋๋ก ๊ตฌ์ฑํ์ต๋๋ค. ์ด๋ค์ ๋ก๋ด์๊ฒ ๋งค์ฐ ๋ค์ํ ๋์ ์ํฉ์ ์ ๊ณตํ๋๋ฐ, ์์ปจ๋ ๋ผ์ผ์ด๋ ๋ง์น๋ ์ก์์ผ ํ ๋ถ๋ถ(์์ก์ด)์ด ๋ฌด๊ฒ์ค์ฌ๊ณผ ๋จ์ด์ ธ ์๊ณ , ํนํ ๋ถ๋ถ ์ฑ์ด ๋ฌผ๋ณ์ ๋นํ ์ค์ ๋ด๋ถ ์ ์ฒด ์ด๋์ผ๋ก ๋ฌด๊ฒ์ค์ฌ์ด ๊ณ์ ๋ณํ๋ ๋ฑ ๋ํดํ ์์ง์์ ๋ณด์ ๋๋ค. ๊ทธ๋ผ์๋ ๋ถ๊ตฌํ๊ณ , ๋ก๋ด์ ์ด๋ฌํ ๋ฌผ์ฒด๋ค์ ์ ํํ ์ถ์ ํ์ฌ ๋๋ถ๋ถ์ ๊ฒฝ์ฐ ๊ณต์ค์์ ๋ถ์ก๋ ๋ฐ ์ฑ๊ณตํ์์ต๋๋ค.
์๋ฎฌ๋ ์ด์ ๊ฒฐ๊ณผ๋ ์์ ์ธ๊ธํ ๋๋ก iCub ๋ก๋ด์ ํตํด ํ์ธ๋์์ผ๋ฉฐ, 50ํ์ ๋ฌด์์ ๋์ง๊ธฐ ์ค reachable space์ ๋ค์ด์จ ์ฝ 47ํ์ ์ํฉ์์ 100% ์ก๊ธฐ ์ฑ๊ณต๋ฅ ์ ๋ณด์์ต๋๋ค. ์๋ฎฌ๋ ์ดํฐ์์๋ ๋ฌผ์ฒด ์์ง์์ ๋ชจ๋ธ๋ง ์ค์ฐจ๋ ์ธ๋์ด ์์ผ๋ฏ๋ก ์์ธก์ด ์๋ฒฝ์ ๊ฐ๊น๊ฒ ๋ง์๋จ์ด์ก๊ณ , DS ์ ์ด๊ธฐ์ ์ด์์ ๋์์ผ๋ก ๋ก๋ดํ์ด ์ ์ํ ๋ชฉํ์ ๋๋ฌํ์ฌ ์คํจ ์ฌ๋ก๊ฐ ์ ํ ์์์ต๋๋ค. ์ด์ ๋ฐํด ์ค์ ๋ก๋ด ์คํ์์๋ ์ํํธ์จ์ด์ /๊ธฐ๊ณ์ ํ๊ณ์ ์ผ์ ๋ถํ์ค์ฑ์ด ์กด์ฌํ๊ธฐ ๋๋ฌธ์ ์ผ๋ถ ์คํจ๊ฐ ๋ฐ์ํ์ง๋ง, ๊ทธ๋ผ์๋ ๋ถ๊ตฌํ๊ณ ๋งค์ฐ ๋์ ์ฑ๊ณต๋ฅ ์ ๋ฌ์ฑํ์ต๋๋ค. ๋ ผ๋ฌธ์ ๋ฐ๋ฅด๋ฉด, ๋น ๋ณ, ์ ๋ฐ ์ฑ์ด ๋ณ, ๋ผ์ผ, ๋ฐ์ค์ 4๊ฐ์ง ๋ฌผ์ฒด์ ๋ํด ๊ฐ๊ฐ 20ํ์ฉ (์ด 80ํ) ๋์ ธ ์คํํ ๊ฒฐ๊ณผ, ๋ก๋ด ์์ ๊ณต๊ฐ์ ๋ค์ด์ค์ง ์์ 9ํ๋ฅผ ์ ์ธํ 71ํ์ ์๋ ์ค 52ํ ์ฑ๊ณตํ์ฌ 73.2%์ ์ ์ฒด ์ฑ๊ณต๋ฅ ์ ๊ธฐ๋กํ์ต๋๋ค. ์ด๋ ํ ๋ฒ ๋์ ธ์ง ๋ฌผ์ฒด์ ํ๊ท ๋นํ์๊ฐ์ ์ฝ 0.5์ด์ ๋ถ๊ณผํ์ผ๋ฉฐ, 3.5m ๊ฑฐ๋ฆฌ์์ ๋์ง ๋ฌผ์ฒด๋ฅผ ๊ทธ ์งง์ ์๊ฐ ์์ ์ก์๋ธ ๊ฒ์ ๋๋ค.
์ฑ๊ณต๋ฅ 73%๋ผ๋ ์์น๋ ์ธ๋ป ์๋ฒฝํด ๋ณด์ด์ง ์์ ์ ์์ผ๋, ์๋์ ์ผ๋ก ์ธ๊ฐ์ ์ฑ๋ฅ๊ณผ ๋น๊ตํ๋ฉด ์ด ๋ก๋ด ์์คํ ์ ์ฐ์์ฑ์ด ๋๋๋ฌ์ง๋๋ค. ์ ์๋ค์ ๋์ผํ ์คํ ์กฐ๊ฑด์์ ์ฌ๋ 10๋ช ์๊ฒ ๋งจ์์ผ๋ก ๋ฌผ์ฒด ์ก๊ธฐ๋ฅผ ์๋ํ๋๋ก ํ์ฌ ๊ฒฐ๊ณผ๋ฅผ ๋น๊ตํ๋๋ฐ, ํผํ์๋ค์ 100ํ์ ๋น ๋ณ ๋์ง๊ธฐ ์ค ํ๊ท 38ํ๋ฐ์ ์ก์ง ๋ชปํ๊ณ , ์ ํ๋ ์ฌ๋๋ ์ฑ๊ณต๋ฅ 70% ์์ค์ ๊ทธ์ณค๋ค๊ณ ํฉ๋๋ค. ํนํ ๊ฒฝํ์ด ์ ์ ์ฌ๋์ ๊ฒฝ์ฐ ์ฑ๊ณต๋ฅ ์ด ๊ฒจ์ฐ 10%๋์ ๋ถ๊ณผํ์ฌ, ๊ณต์ค์ ๋ณ์น์ ์ธ ๋ฌผ์ฒด๋ฅผ ํ ์์ผ๋ก ์ก๋ ์ผ์ด ์ผ๋ง๋ ์ด๋ ค์ด์ง ๋ณด์ฌ์ฃผ์์ต๋๋ค. ์ด์ ๋นํ๋ฉด, ๋ก๋ด์ ์ผ๊ด๋๊ณ ๋์ ์ฑ๊ณต๋ฅ (73%)์ ๋ณด์ด๋ฉฐ ์๋ จ ์ธ๊ฐ ์์ค์ ๊ฐ๊น์ด ์ฑ๋ฅ์ ๋ฐํํ ๊ฒ์ ๋๋ค. ์ด๋ ๋ณธ ๋ ผ๋ฌธ์ ์ ๊ทผ๋ฒ์ด ์ค์ ํ์ค ์ํฉ์์๋ ํจ๊ณผ์ ์ผ๋ก ์๋ํ๋ค๋ ๊ฐ๋ ฅํ ์ฆ๊ฑฐ๋ผ ํ ์ ์์ต๋๋ค.
๋ฌผ๋ก ์คํ์์ ๊ด์ฐฐ๋ ์คํจ ์ฌ๋ก๋ค์ ํฅํ ๊ฐ์ ์ ์ ์์ฌํฉ๋๋ค. ๋ ผ๋ฌธ์์๋ ์ด 19ํ์ ์คํจ ์์ธ์ ๋ถ์ํ์๋๋ฐ, 12๊ฑด(๊ณผ๋ฐ์)์ ์ก๊ธฐ ๋ชฉํ๊ฐ ๋ก๋ด์ ์ด๊ธฐ์์ธ๋ก๋ถํฐ ๋๋ฌด ๋ฉ๋ฆฌ ๋จ์ด์ ธ ๊ด์ ์๋ ํ๊ณ๋ฅผ ๋์ ๊ฒฝ์ฐ์์ต๋๋ค. ์ด๋๋ ๋ก๋ด์ด ์ต๋๋ก ํ์ ๋ป์ด๋ ์๊ฐ ๋ด ๋๋ฌํ์ง ๋ชปํด ๋ฌผ์ฒด๋ฅผ ๋์น๊ฒ ๋ฉ๋๋ค. 4๊ฑด์ ์ก๋ ์๊ฐ์ ์๊ฐ๋ฝ ์ผ๋ถ๊ฐ ๋ฌผ์ฒด๋ฅผ ์๋ชป ์ณ์ ๋ฌผ์ฒด๊ฐ ํ๊ฒจ๋๊ฐ ๊ฒฝ์ฐ์์ต๋๋ค. ์ด๋ฌํ ๊ฒฝ์ฐ๋ ๋๋ฌผ๊ฒ ๋ฐ์ํ์ผ๋ฉฐ, ์๋ง๋ ๋ฌผ์ฒด์ ์ ๊ทผ ๊ฐ๋๊ฐ ์์๋ณด๋ค ๋ฏธ๋ฌํ๊ฒ ๋ฌ๋ผ ์๊ฐ๋ฝ์ด ์ถฉ๋ํ ๊ฒ์ผ๋ก ๋ณด์ ๋๋ค. ๋จ์ 3๊ฑด์ ๋ก๋ด ๊ด์ ์ ๋ถํ๊ฐ ๊ธ๊ฒฉํ ๊ฑธ๋ ค ํ ํฌ ์ ํ์ ๊ฑธ๋ฆฌ๋ฉฐ ๋ก๋ด์ด ์์ ์ ์งํ ๊ฒฝ์ฐ์์ต๋๋ค. ์ ์ฒด์ ์ผ๋ก ๋ณด๋ฉด ์คํจ๋ ์ฃผ๋ก ํ๋์จ์ด์ ํ๊ณ ์ํฉ์์ ๋ฐ์ํ์ผ๋ฉฐ, ์ ์ด ์๊ณ ๋ฆฌ์ฆ ์์ฒด์ ๋ฌธ์ ๋ก ์ธํ ์คํจ๋ ๋งค์ฐ ์ ์์ต๋๋ค. ํนํ ์ผ์์ ์ก์์ด๋ ์์ธก ์ค์ฐจ ๋๋ฌธ์ ์๋ฑํ ๊ณณ์ผ๋ก ํ์ด ๊ฐ ๊ฒฝ์ฐ๋ ์์๋ค๋ ์ ์์, ์ ์๋ ํ๋ฅ ์ ์์ธก+๊ณํ ํตํฉ ์๊ณ ๋ฆฌ์ฆ์ ๊ฒฌ๊ณ ํจ์ ํ์ธํ ์ ์์ต๋๋ค.
๋ง์ง๋ง์ผ๋ก, ๋ ผ๋ฌธ์ ์คํ ๊ฒฐ๊ณผ์๋ ์ ์๋ ๋ฐฉ๋ฒ์ ํ์ต ํจ์จ๊ณผ ๋ฒ์ฉ์ฑ์ ๋ํ ์ธ๊ธ๋ ์์ต๋๋ค. ๋ฌผ์ฒด ๋์ญํ ๋ชจ๋ธ ํ์ต์ ์ฝ 20๊ฐ ์ ๋์ ๋์ง๊ธฐ ๊ถค์ ์ ์ฌ์ฉํ๊ณ , ํ DS ๋ฐ ํ์ง ๋ชจ๋ธ ํ์ต์๋ 10~20๊ฐ ์ํ์ ์์ฐ์ ์ฌ์ฉํ ์ ๋๋ก, ๋น๊ต์ ์ ์ ๋ฐ์ดํฐ๋ก ์๋นํ ๋ณต์กํ ๊ณผ์ ๋ฅผ ๋ฌ์ฑํ ๊ฒ์ด ์ธ์์ ์ ๋๋ค. ๋ํ ์ด ํ๋ ์์ํฌ๋ฅผ ์๋ก ๋ค๋ฅธ ๋ ๋ก๋ด ํ๋ซํผ(iCub๊ณผ KUKA)์์ ๋ชจ๋ ๊ตฌํํด๋ณด์๊ณ , ์ฌ๋ฌ ํํ์ ๋ฌผ์ฒด์ ๋ํด์๋ ์ ์ฌํ ์ฑ๋ฅ์ ๋ณด์๋ค๋ ์ ์์, ์ ์ ๊ธฐ๋ฒ์ ์ผ๋ฐํ ๊ฐ๋ฅ์ฑ์ ๋ณด์ฌ์ค๋๋ค. ์ด๋ ํต์ฌ ์์ด๋์ด๋ค์ด ๊ตฌ์ฒด์ ์ธ ๋ก๋ด ํ๋ผ๋ฏธํฐ๋ ๋ฌผ์ฒด ์์ฑ์ ๊ฐํ๊ฒ ์์กดํ์ง ์๊ณ , ํ์ต์ผ๋ก๋ถํฐ ์๋์ ์ผ๋ก ์ ๋๋๊ธฐ ๋๋ฌธ์ผ๋ก ํ๋จ๋ฉ๋๋ค. ์ค์ ๋ก ์ ์๋ค์ โ๋ณธ ๋ ผ๋ฌธ์ด ๋ถํ์ค์ฑ ํ์์ ์ด๊ณ ์ ์ ์ด์ ํ ์๋ฅผ ์ ์ํ์์ผ๋ฉฐ, ๊ณผ๊ฑฐ ์ฐ๊ตฌ๋ค์ด ์ฃผ๋ก ๋จ์ ๊ณต ๋ชจ์ ๋ฌผ์ฒด๋ ์ฒ์ฒํ ํ์ ํ๋ ๋ฌผ์ฒด์ ๊ตญํ๋์๋ ๋ฐ ๋นํด ์ฐ๋ฆฌ์ ์ฐ๊ตฌ๋ ๊ทธ ๋ฒ์๋ฅผ ํฌ๊ฒ ๋ํ๋คโ๋ผ๊ณ ๊ฐ์กฐํ๊ณ ์์ต๋๋ค.
2.7 ๊ฒฐ๋ก
โCatching Objects in Flightโ ๋ ผ๋ฌธ์ ๋ก๋ด์ด ๊ณต์ค์์ ๋ณต์กํ ๋ฌผ์ฒด๋ฅผ ์ก๋ ๋ฌธ์ ์ ๋ํด ํ์ต ๊ธฐ๋ฐ์ ์ข ํฉ์ ํด๊ฒฐ์ฑ ์ ์ ์ํ ๋ฐ์ด๋ ์ฐ๊ตฌ์ ๋๋ค. ๋ฌผ์ฒด ๊ถค์ ์์ธก๋ถํฐ ์ก๊ธฐ ์์ธ ๊ฒฐ์ , ํ-์ ์ ์ด์ ์ด๋ฅด๋ ์ ๊ณผ์ ์ ํตํฉํ์๊ณ , ๊ฐ๊ฐ์ ๋จ๊ณ์์ ๊ธฐ์กด ๋ฐฉ์์ ํ๊ณ๋ฅผ ๊ทน๋ณตํ๋ ๋ ์ฐฝ์ ์ธ ์ ๊ทผ์ ๋ณด์ฌ์ฃผ์์ต๋๋ค. ํ๋ก๊ทธ๋๋ฐ-๋ฐ์ด-๋ฐ๋ชฌ์คํธ๋ ์ด์ ๊ธฐ๋ฒ์ผ๋ก ๋ฌผ์ฒด์ ๋นํ ๋์ญํ๊ณผ ๋ก๋ด์ ๋์ ํจํด์ ํ๋ํ๊ณ , ์ด๋ฅผ ํ๋ฅ ์ ๋ชจ๋ธ๊ณผ ๋์ ์์คํ ์ ์ด๊ธฐ๋ก ๊ตฌํํจ์ผ๋ก์จ, ๋ก๋ด์ด ๋ฐ๋ฆฌ์ด ๋จ์์ ๋ฐ์์๋์ ๋์ ์ ์์ฑ์ ๊ฐ์ถ๊ฒ ํ์ต๋๋ค. ํนํ ์ก๊ธฐ ๋์์ด ๋ถ๊ท์นํ ๋ชจ์์ด๊ณ ๋นํ ์๊ฐ์ด ๋งค์ฐ ์งง์ ์ฌ๋์กฐ์ฐจ ์ก๊ธฐ ์ด๋ ค์ด ์ํฉ์์, ์ ์๋ ์์คํ ์ด ์ธ๊ฐ์ ํ์ ํ๋ ์์ค์ ์ฑ๋ฅ(์ฑ๊ณต๋ฅ ~73%)์ ๋ณด์ธ ์ ์ ์ฃผ๋ชฉํ ๋งํฉ๋๋ค. ์ด๋ ๋ก๋ด์ด ๋จ์ ๋ฐ๋ณต ์์ ์ ๋์ด ๋์ ์ธ ์ค์ ํ๊ฒฝ์ ๋์ํ ์ ์์์ ๋ณด์ฌ์ค ์ฌ๋ก๋ก, ํฅํ ์ฐ์ฃผ ์ฐ๋ ๊ธฐ ํฌ์ง์ด๋ ๊ณ ์ ๋ฌผ์ฒด ์กฐ์ ๋ฑ ๋ค์ํ ์์ฉ์ ํ์ฉ๋ ์ ์์ ๊ฒ์ผ๋ก ๊ธฐ๋๋ฉ๋๋ค. ๋ฌผ๋ก ํ์ฌ ํ๋ ์์ํฌ๋ ๊ณ ์ ๋ ์์น์ ๋ชจ์ ์บก์ณ ์นด๋ฉ๋ผ์ ํฌ๊ฒ ์์กดํ๊ณ ์๊ณ , ๋ก๋ด์ ๋ฌผ๋ฆฌ์ ์คํ ํ๊ณ๋ก ์ธํ ์ ์ฝ๋ ์กด์ฌํฉ๋๋ค. ๋ฐ๋ผ์ ์ด๋ ๋ก๋ด ํ๋ซํผ์ด๋ ์จ๋ณด๋ ์ผ์๋ก ํ์ฅํ๊ณ , ๋ณด๋ค ๋น ๋ฅด๊ณ ๊ฐ์ธํ ๋ก๋ด ํ๋์จ์ด์ ๊ฒฐํฉํ๋ค๋ฉด, ๊ณต์ค์์ ๋ฌผ์ฒด๋ฅผ ์ก๋ ๋ก๋ด์ ํ์ฉ ๋ฒ์๋ ๋์ฑ ๋์ด์ง ๊ฒ์ ๋๋ค. ์ ์ฒด์ ์ผ๋ก ์ด ๋ ผ๋ฌธ์ ๋ก๋ด ํ์ต๊ณผ ์ค์๊ฐ ์ ์ด๋ฅผ ์ ๋ชฉํ์ฌ ๋์ ๋ฅผ ํด๊ฒฐํ ํ๋ฅญํ ์ฌ๋ก๋ก์, ์ถํ ๋๋ถ์ผ ์ฐ๊ตฌ์๋ค์๊ฒ๋ ๋ง์ ์๊ฐ์ ์ ๊ณตํ๊ณ ์์ต๋๋ค.
์ฐธ๊ณ ์๋ฃ: ๋ณธ ๋ฆฌ๋ทฐ์์๋ ๋ ผ๋ฌธ์ ๋ด์ฉ๊ณผ ์คํ ๊ฒฐ๊ณผ๋ฅผ ๊ธฐ๋ฐ์ผ๋ก ํต์ฌ์ ์ธ ์ฌํญ๋ค์ ์ ๋ฆฌํ์์ต๋๋ค. ์์ธํ ๊ธฐ์ ๊ตฌํ์ด๋ ์ถ๊ฐ ์คํ ์ ๋ณด๋ ์๋ฌธ์ ์ฐธ๊ณ ํ์๊ธฐ ๋ฐ๋๋๋ค. ๋ํ ๊ด๋ จ ๋ถ์ผ์ ๋ฐ์ ๋ ์ฐ๊ตฌ๋ก, ๋ฌผ์ฒด ํฌํ์ ์ํ ๊ถค์ ์ต์ ํ ๊ธฐ๋ฒ์ด๋ ๋ฅ๋ฌ๋ ๊ธฐ๋ฐ ์ ๊ทผ๋ฒ ๋ฑ์ด ์์ผ๋, ํด๋น ๋ ผ๋ฌธ์ ๋ฒ์๋ฅผ ๋ฒ์ด๋๋ฏ๋ก ๋ณธ ๋ฆฌ๋ทฐ์์๋ ๋ค๋ฃจ์ง ์์์ต๋๋ค. ์ด ๋ ผ๋ฌธ์ ์ ๊ทผ๋ฒ์ ๋ก๋ด์ ์ธ์ง-๊ณํ-์ ์ด ์ ๊ณผ์ ์ ์์ฐ๋ฅด๋ ํตํฉ ์ค๊ณ๋ฅผ ๋ณด์ฌ์ฃผ๋ฉฐ, ํฅํ ๋์ฑ ๋ณต์กํ ๋์ ํ์ต๊ณผ ๊ณ ์ ์ ์ด ์ฐ๊ตฌ์ ๋ฐ๊ฑฐ๋ฆ์ด ๋ ๊ฒ์ผ๋ก ํ๊ฐ๋ฉ๋๋ค.