An unscented Kalman filter method for real time input-parameter-state estimation
๐ Abstract
**
๋ณธ ๋
ผ๋ฌธ์์๋ ์๋ก์ด Unscented Kalman Filter(UKF)๋ฅผ ์ด์ฉํด ์ ํ ๋ฐ ๋น์ ํ ์์คํ
์์ ์
๋ ฅโํ๋ผ๋ฏธํฐโ์ํ๋ฅผ ๋์์ ์ถ์ ํ๋ ๋ฐฉ๋ฒ์ ์ ์ํ๋ค. ์
๋ ฅ์ ๊ฐ ์๊ฐ ๋จ๊ณ์์ ๋ ๋จ๊ณ๋ก ์ถ์ ํ๋ค. ์ฒซ ๋ฒ์งธ ๋จ๊ณ์์๋ ์์ธก๋ ๋์ ์ํ์ ์์คํ
ํ๋ผ๋ฏธํฐ๋ฅผ ์ด์ฉํด ์
๋ ฅ์ ์ถ์ ํ๊ณ , ๋ ๋ฒ์งธ ๋จ๊ณ์์๋ ์ธก์ ๊ฐ์ผ๋ก ๋ณด์ ๋ ์ํ์ ํ๋ผ๋ฏธํฐ๋ฅผ ์ด์ฉํด ์ต์ข
์
๋ ฅ์ ์ป๋๋ค. ์(0) ํน์ ๋น์ ์
๋ ฅ์ด ์๋ ค์ง ๊ฒฝ์ฐ, ์์คํ
์ ์ ์ผํ๊ฒ ์๋ณํ ์ ์์์ ์ญ๋ ๋ถ์์ ํตํด ์ฆ๋ช
ํ๋ค. ์ด ์ถ๋ ฅโ์ ์ฉ ๋ฐฉ์์ ๊ธฐ์กด์ ์ถ๋ ฅโ์ ์ฉ ํ๋ผ๋ฏธํฐ ์๋ณ ๊ธฐ๋ฒ๋ณด๋ค ๋์ ์ํ, ํ๋ผ๋ฏธํฐ, ์
๋ ฅ์ ์ค์๊ฐ์ผ๋ก ๊ณต๋ ์ถ์ ํจ์ผ๋ก์จ ์์คํ
์ ๋ํ ์ดํด๋๋ฅผ ๋์ธ๋ค.
**
๐ก Deep Analysis
**
1. ์ฐ๊ตฌ ๋ฐฐ๊ฒฝ ๋ฐ ํ์์ฑ
- ์ถ๋ ฅโ์ ์ฉ ๊ฐ์๊ฐ ์ต๊ทผ ๊ตฌ์กฐยท์์คํ ๊ฑด๊ฐ ๋ชจ๋ํฐ๋ง์์ ์ฃผ๋ชฉ๋ฐ๊ณ ์๋ค. ์ผ์ยท์ก์ถ์์ดํฐ ๋น์ฉ, ์ค์น ๊ณต๊ฐ, ๊ณ ์ฅ ์ํ ๋ฑ ์ค์ฉ์ ์ ์ฝ ๋๋ฌธ์ ๊ฐ๋ฅํ ํ ์ ์ ์ธก์ ๊ฐ์ผ๋ก ์ต๋ ์ ๋ณด๋ฅผ ์ถ์ถํ๋ ค๋ ์๊ตฌ๊ฐ ์๋ค.
- ์ ๋ ฅ ์ธก์ ์ด ์ด๋ ค์ด ๊ฒฝ์ฐ(์: ๋ํ ๊ตฌ์กฐ๋ฌผ์ ํํ์ค, ํธ๋ ํ์ค)์๋ ์์คํ ์ํ์ ํ๋ผ๋ฏธํฐ๋ฅผ ์ ํํ ํ์ ํด์ผ ํ๋ ์ํฉ์ด ๋น๋ฒํ ๋ฐ์ํ๋ค.
2. ๊ธฐ์กด ์ฐ๊ตฌ์์ ์ฐจ๋ณ์
| ๊ธฐ์กด ๋ฐฉ๋ฒ | ์ฃผ์ ํน์ง | ํ๊ณ |
|---|---|---|
| Dertimanis et al. (๋ฒ ์ด์ง์ ํํฐ) | ์ ๋ ฅโํ๋ผ๋ฏธํฐโ์ํ ๊ณต๋ ์ถ์ , ์ ํ๋ ์ถ๋ ฅ ์ฌ์ฉ | ๊ณต๋ถ์ฐ ํ๋ ฌ ์กฐ์ ์ ๋ฌผ๋ฆฌ์ ๊ทผ๊ฑฐ ๋ถ์กฑ |
| Castiglione et al. (์๊ฐ ๊ฐ๋ณ AR) | ์ ๋ ฅ์ AR ๋ชจ๋ธ๋ก ์ถ์ | ์ ์ฃผํ ๋๋ฆฌํํธ๋ก ๋ณ์ ์ถ์ ๋ถ์ ํ |
| Maes et al. (EKF ๊ธฐ๋ฐ) | ํ์ฌ ์ํ ์ฃผ๋ณ ์ ํํ | ๋๊ท๋ชจยท๊ณ ๋น์ ํ ์์คํ ์์ Jacobian ๊ณ์ฐ ๋น์ฉยท๋ถ์์ |
| Lei et al. (UKF + ๋น์ ํ ์ต์์ ๊ณฑ) | ๋น์ ํ ์ต์์ ๊ณฑ ๊ฒฐํฉ | ๋ ธ์ด์ฆ ํํฐ๋ง ๋นํจ์จ, ๋ฐ์ฐ ์ํ |
| Song (์ง์ ํผ๋์ค๋ฃจ UKF) | ์ต์๋ถ์ฐ ๋ฌดํธํฅ UKF | ์ ๋ ฅ์ ํ๋ก์ธ์ค ์ค๋ฅ์๋ง ํฌํจ, ์ผ๋ฐํ ์ด๋ ค์ |
๋ณธ ๋ ผ๋ฌธ์ด ์ ์ํ๋ IPSโUKF๋ ์ ๋ฐฉ๋ฒ๋ค์ ๋ ๊ฐ์ง ํต์ฌ ๋ฌธ์ ๋ฅผ ๋์์ ํด๊ฒฐํ๋ค.
- ๊ณต๋ถ์ฐ ํ๋์ ๋ฌผ๋ฆฌ์ ๋ชจ๋ธ์ ์์กดํ์ง ์๊ณ , ์ ๋ ฅ ์ถ์ ๋จ๊ณ์์ ๋ฐ์ํ๋ ์ค๋ฅ๋ฅผ ์ธก์ ๋ ธ์ด์ฆ์ ํฌํจ์์ผ ์๋์ ์ผ๋ก ๋ณด์ ํ๋ค.
- Jacobian ํ์ ์์ โ ๋น์ ํ ์์คํ ์์๋ ๊ณ์ฐ๋์ด ํฌ๊ฒ ๋์ด๋์ง ์๋๋ค.
3. ์ ์ ๋ฐฉ๋ฒ์ ํต์ฌ ๋ฉ์ปค๋์ฆ
- ์์ธก ๋จ๊ณ: ๊ธฐ์กด UKF์ ๋์ผํ๊ฒ sigmaโpoint์ ์ด์ฉํด ์ํยทํ๋ผ๋ฏธํฐ๋ฅผ ์์ธกํ๋ค.
- ์ฒซ ๋ฒ์งธ ์ ๋ ฅ ์ถ์ : ์์ธก๋ ์ํยทํ๋ผ๋ฏธํฐ์ ์์คํ ๋์ญํ์(์ฐ์์)์ผ๋ก๋ถํฐ ์ ๋ ฅ์ ์ญ์ฐํ๋ค. ์ด๋ ์ ๋ ฅ์ ์์ง ๋ณด์ ๋์ง ์์ โ๊ฑฐ์นโ ๊ฐ์ด๋ฉฐ, ๊ทธ ๋ถํ์ค์ฑ์ ์ธก์ ๋ ธ์ด์ฆ์ ํฌํจ๋๋ค.
- ๋ณด์ ๋จ๊ณ: ์ธก์ ๊ฐ์ ์ด์ฉํด ์ํยทํ๋ผ๋ฏธํฐ๋ฅผ ์ ๋ฐ์ดํธํ๊ณ , ์ ๋ฐ์ดํธ๋ ๊ฐ์ผ๋ก ๋ค์ ์ ๋ ฅ์ ์ฌ์ถ์ ํ๋ค(๋ ๋ฒ์งธ ์ ๋ ฅ ์ถ์ ).
- ๋ค์ ์๊ฐ ๋จ๊ณ์ ์ฌ์ฉ๋ ์ ๋ ฅ์ ๋ ๋ฒ์งธ ์ถ์ ๊ฐ์ด๋ฉฐ, ์ด ๊ณผ์ ์ด ๋ฐ๋ณต๋๋ค.
4. ์ด๋ก ์ ํ๋น์ฑ โ ์ญ๋ ๋ถ์
- ์(0) ํน์ ๋น์ ์ ๋ ฅ์ด ํ๋๋ผ๋ ์๋ ค์ง ๊ฒฝ์ฐ(์: ํน์ DOF์ 0 ์ ๋ ฅ) ์์คํ ์ ์ ์ผํ๊ฒ ์๋ณ ๊ฐ๋ฅํจ์ ์ฆ๋ช ํ๋ค.
- ์ญ๋ ๋ถ์์ ํตํด ํ๋ผ๋ฏธํฐ ์ค๋ฅ์ ์ ๋ ฅ ์ค๋ฅ๊ฐ ์๋ก ๋ณด์์ ์ผ๋ก ๋ํ๋๋ฉฐ, ์๋ ค์ง ์ ๋ ฅ์ด ์์ ๊ฒฝ์ฐ ๋์ผํ ๋์ ์๋ต์ ๋ง๋ค ์ ์๋ ๋ฌด์ํ ๋ง์ ํ๋ผ๋ฏธํฐโ์ ๋ ฅ ์กฐํฉ์ด ์กด์ฌํจ์ ํ์ธํ๋ค.
5. ์คํ ์ค๊ณ ๋ฐ ๊ฒฐ๊ณผ ์์ฝ
| ์คํ | ์์คํ | ์ ๋ ฅ | ์ธก์ ๋ ธ์ด์ฆ | ์ฃผ์ ๊ฒฐ๊ณผ |
|---|---|---|---|---|
| 5.1 | 3โDOF ์ ํ MDOF | ๋ฏธ์ง์ ํ์ค (100โฏN) | 5โฏ% RMS Gaussian | ํ๋ผ๋ฏธํฐยท์ ๋ ฅยท์ํ ๋ชจ๋ ์๋ ด, ์ค์ฐจ <โฏ2โฏ% |
| 5.2 | 2โDOF ๋น์ ํ (Duffing) | ํ์ค + ๋ฐฑ์ ์ก์ | 5โฏ% RMS Gaussian | ๋น์ ํ ํ๋ผ๋ฏธํฐ์ ์ ๋ ฅ์ ๋์์ ์ ํํ ๋ณต์, ์๋ ด ์๋๋ ์ ํ๋ณด๋ค ๋ค์ ๋๋ฆผ |
| 5.3 | ์ฃผ๋ณ(ambient) ์ ๋ ฅ | ์๋ ค์ง์ง ์์ | ๋์ผ | ์ ๋ ฅ ์ถ์ ์ด ๊ฐ๋ฅํ ๊ฒฝ์ฐ์ ๋ถ๊ฐ๋ฅํ ๊ฒฝ์ฐ๋ฅผ ๊ตฌ๋ถ, ์๋ ค์ง ์ ๋ ฅ์ด ์์ผ๋ฉด ์๋ณ ๊ฐ๋ฅ |
- ๊ณต๋ถ์ฐ ์ ํ: Qโฏ=โฏ10โปโนยทI, Rโฏ=โฏ10โปยณยทI(์ ํ) / 10โปโตยทI(๋น์ ํ) ๋ก ๊ณ ์ ํ์ ๋ ์์ ์ ์ธ ์๋ ด์ ๋ณด์์ผ๋ฉฐ, ๊ณผ๋ํ๊ฒ ํฐ ๊ณต๋ถ์ฐ์ ๋ฐ์ฐ์ ์ด๋ํจ์ ํ์ธํ๋ค.
- ์ ์ฒด ์ํ ์ธก์ (๋ณ์ยท์๋ยท๊ฐ์๋) ๊ฐ ๊ถ์ฅ๋์ง๋ง, ์น์ โฏ6์ ๋ฏผ๊ฐ๋ ๋ถ์์์๋ ์ผ๋ถ ์ผ์๋ง ์ฌ์ฉํด๋ ์ถฉ๋ถํ ์๋ ด ๊ฐ๋ฅํจ์ ๋ณด์๋ค(ํนํ ์ ๋ ฅ์ด ์๋ ค์ง ๊ฒฝ์ฐ).
6. ์ฅ์
- ์ค์๊ฐ์ฑ: ํ ์๊ฐ ๋จ๊ณ ๋ด์ ๋ ๋ฒ์ ์ ๋ ฅ ์ถ์ ์ ์ํํ์ง๋ง, UKF ์์ฒด๊ฐ ๋น๊ต์ ๊ฐ๋ฒผ์ด ์ฐ์ฐ๋์ ์๊ตฌํ๋ค.
- ๋น์ ํ ์ ์ฉ ๊ฐ๋ฅ: Jacobian ๊ณ์ฐ์ด ํ์ ์์ผ๋ฉฐ, sigmaโpoint์ ํตํด ๋น์ ํ์ฑ์ ์์ฐ์ค๋ฝ๊ฒ ํฌ์ฐฉํ๋ค.
- ์ ๋ ฅโํ๋ผ๋ฏธํฐโ์ํ ๊ณต๋ ์ถ์ : ๊ธฐ์กด ๋ฐฉ๋ฒ๋ค์ ๋ณดํต ํ๋ ํน์ ๋ ๊ฐ์ง๋ง์ ๋์์ ๋ค๋ฃจ์์ผ๋, ๋ณธ ๋ฐฉ๋ฒ์ ์ธ ๊ฐ์ง๋ฅผ ๋ชจ๋ ์ค์๊ฐ์ผ๋ก ์ถ์ ํ๋ค.
- ์๋ณ ๊ฐ๋ฅ์ฑ ์ด๋ก ์ ๊ณต: ์ญ๋ ๋ถ์์ ํตํ โ์ ๋ ฅ์ด ํ๋๋ผ๋ ์๋ ค์ง๋ฉด ์์คํ ์ ์๋ณ ๊ฐ๋ฅโ์ด๋ผ๋ ๋ช ํํ ์กฐ๊ฑด์ ์ ์ํ๋ค.
7. ํ๊ณ ๋ฐ ๊ฐ์ ์
- ๊ณต๋ถ์ฐ ํ๋ ์์กด์ฑ: ํ์ฌ๋ ๊ฒฝํ์ ์ผ๋ก ๊ณ ์ ๊ฐ์ ์ฌ์ฉํ์ผ๋ฉฐ, ์๋ ํ๋(์: EMโ์๊ณ ๋ฆฌ์ฆ)์ด๋ ์ ์ํ ๊ณต๋ถ์ฐ ์ ๋ฐ์ดํธ๊ฐ ํ์ํ๋ค.
- ์ ๋ ฅ ๋ชจ๋ธ G(ยท) ์ ์ ํ: ๋ ผ๋ฌธ์์๋ G๊ฐ ์ ํยท๋น์ ํ ๋ชจ๋ ๊ฐ๋ฅํ๋ค๊ณ ํ์ง๋ง, ์ค์ ๋ณต์กํ ์ ๋ ฅ(์: ๋น์ ์์ ์ถฉ๊ฒฉ, ๋น๊ฐ์ฐ์์ ์ก์)์์๋ ๋ชจ๋ธ๋ง ์ค๋ฅ๊ฐ ํฌ๊ฒ ์์ฉํ ์ ์๋ค.
- ์ผ์ ๊ฒฐํจยท๊ฒฐ์ธก์น: ์ค์ ํ์ฅ์์๋ ์ผ์ ๊ณ ์ฅ์ด๋ ๋ฐ์ดํฐ ์์ค์ด ๋น๋ฒํ ๋ฐ์ํ๋ค. ๊ฒฐ์ธก์น ์ฒ๋ฆฌ์ ๊ฐ์ธ์ฑ ๊ฐํ๊ฐ ์ถ๊ฐ ์ฐ๊ตฌ ๊ณผ์ ๋ก ๋จ๋๋ค.
- ๋๊ท๋ชจ ์์คํ ์ ์ฉ: 10โฏ~โฏ20โฏDOF ์ ๋๊น์ง๋ ์๋ฎฌ๋ ์ด์ ์ด ๊ฐ๋ฅํ์ง๋ง, ์๋ฐฑ DOF ๊ท๋ชจ์ ๊ตฌ์กฐ๋ฌผ์์๋ sigmaโpoint ์๊ฐ ๊ธ์ฆํ๋ค. ์ฐจ์ ์ถ์ ๊ธฐ๋ฒ(์: POD, Krylov ์๋ธ์คํ์ด์ค)๊ณผ ๊ฒฐํฉํ๋ ๋ฐฉ์์ด ํ์ํ๋ค.
8. ํฅํ ์ฐ๊ตฌ ๋ฐฉํฅ
- ๊ณต๋ถ์ฐ ์๋ ์ ์: ๋ณ๋ถ ๋ฒ ์ด์ง์ ๋ฐฉ๋ฒ์ด๋ ๋ฅ๋ฌ๋ ๊ธฐ๋ฐ ๋ฉํ๋ชจ๋ธ์ ํ์ฉํด Q,โฏR์ ์ค์๊ฐ์ผ๋ก ์ ๋ฐ์ดํธ.
- ๋ค์ค ์ผ์ ์ตํฉ: ๊ฐ์๋ยท๋ณ์ยทํ ์ผ์ ๋ฑ ์ด์ง์ ์ธ ๋ฐ์ดํฐ ์คํธ๋ฆผ์ ๋์์ ์ฒ๋ฆฌํ๋ ํ๋ ์์ํฌ ๊ตฌ์ถ.
- ๋น๊ฐ์ฐ์์ ์ก์ ๋ฐ ๋น์ ํ ์ ๋ ฅ ๋ชจ๋ธ๋ง: ฮฑโstable ๋ถํฌ, ํผํฉ ๊ฐ์ฐ์์ ๋ชจ๋ธ ๋ฑ์ ๋์ ํด ์ค์ ํ๊ฒฝ์ ๋ง๋ ์ ๋ ฅโ๋ ธ์ด์ฆ ๋ชจ๋ธ ๊ฐ๋ฐ.
- ์คํ ๊ฒ์ฆ: ์คํ์ค ๊ท๋ชจ์ ์ง๋ ์ํ๋์ ์ค์ ๊ต๋ยท๊ณ ์ธต ๊ฑด๋ฌผ์ ์ ์ฉํด ํ์ฅ ๋ฐ์ดํฐ ๊ธฐ๋ฐ ๊ฒ์ฆ ์ํ.
9. ๊ฒฐ๋ก
๋ณธ ๋ ผ๋ฌธ์ ์ ๋ ฅโํ๋ผ๋ฏธํฐโ์ํ๋ฅผ ๋์์ ์ค์๊ฐ์ผ๋ก ์ถ์ ํ ์ ์๋ ์๋ก์ด Unscented Kalman Filter ๊ตฌ์กฐ(IPSโUKF)๋ฅผ ์ ์ํ๋ค. ์(0) ํน์ ๋น์ ์ ๋ ฅ์ด ํ๋๋ผ๋ ์๋ ค์ง ๊ฒฝ์ฐ ์์คํ ์ด ์ ์ผํ๊ฒ ์๋ณ ๊ฐ๋ฅํจ์ ์ญ๋ ๋ถ์์ผ๋ก ์ฆ๋ช ํ๊ณ , ์ ํยท๋น์ ํ ์ฌ๋ก ๋ชจ๋์์ ๋์ ์ ํ๋์ ๋น ๋ฅธ ์๋ ด์ ๋ณด์๋ค. ๊ธฐ์กด ๋ฐฉ๋ฒ๋ค์ ์ฃผ์ ํ๊ณ(๊ณต๋ถ์ฐ ํ๋, Jacobian ํ์, ๋น์ ํ ์ ์ฉ ์ด๋ ค์)๋ฅผ ๊ทน๋ณตํ์ผ๋ฉฐ, ๊ตฌ์กฐยท๊ธฐ๊ณ ์์คํ ์ ์ถ๋ ฅโ์ ์ฉ ๋ชจ๋ํฐ๋ง์ ์ค์ง์ ์ธ ๊ธฐ์ ์ ์ง๋ณด๋ฅผ ์ ๊ณตํ๋ค. ๋ค๋ง, ๊ณต๋ถ์ฐ ์๋ ์กฐ์ , ๋๊ท๋ชจ ์์คํ ์ ์ฉ, ์ผ์ ๊ฒฐํจ ๋์ ๋ฑ ์ค์ฉํ ๋จ๊ณ์์ ํด๊ฒฐํด์ผ ํ ๊ณผ์ ๊ฐ ๋จ์ ์๋ค. ์ด๋ฌํ ์ ๋ค์ ๋ณด์ํ๋ค๋ฉด, IPSโUKF๋ ์ค๋งํธ ์ธํ๋ผยท์์จ ๋ก๋ดยทํญ๊ณต์ฐ์ฃผ ๊ตฌ์กฐ๋ฌผ ๋ฑ ๋ค์ํ ๋ถ์ผ์์ ํต์ฌ์ ์ธ ์ค์๊ฐ ์ํยท๊ฑด๊ฐ ๋ชจ๋ํฐ๋ง ๋๊ตฌ๋ก ์๋ฆฌ๋งค๊นํ ๊ฐ๋ฅ์ฑ์ด ํฌ๋ค.
๐ Full Content
ํ๋ ๋์ ์์คํ
๋ชจ๋ํฐ๋ง์์ ์ถ๋ ฅโ์ ์ฉ ์ ๋ต
์
๋ ฅ, ํ๋ผ๋ฏธํฐ ๋ฐ ์์คํ
์ ๋์ ์ํ๋ฅผ ์ถ์ ํ๊ธฐ ์ํด ์๋ตโ์ ์ฉ ์ผ์๋ฅผ ์ด์ฉํ๋ ๋ฐฉ๋ฒ์ ๋ ๊ฐ์ง ์ฃผ์ ์ด์ ๋๋ฌธ์ ํฐ ๊ด์ฌ์ ๋ฐ๊ณ ์๋ค. ์ฒซ ๋ฒ์งธ ์ด์ ๋ ์์ง๋์ด๋ค์ด ๊ฐ๋ฅํ ํ ๋ง์ ์ ๋ณด๋ฅผ ๊ธฐ์กด ๋ฐ์ดํฐ๋ก๋ถํฐ ์ถ์ถํ๋ ค๊ณ ํ๊ธฐ ๋๋ฌธ์ด๋ค. ์ค์ฉ์ ์ธ ์ธก๋ฉด์์ ๋ณด๋ฉด, ๋ฐ์ดํฐ ํ๋ ์ฅ๋น(์ผ์, ์ก์ถ์์ดํฐ, ์ปจ๋์
๋ ๋ฑ)๋ ๋น์ฉ ํจ์จ์ฑ์ด ๋ฎ๊ณ , ๊ณต๊ฐ์ ๋ง์ด ์ฐจ์งํ๋ฉฐ, ๊ณ ์ฅ์ด๋ ์์์ ์ทจ์ฝํ๋ค[1,2]. ํนํ ์ค์๊ฐ ๋ชจ๋ํฐ๋ง์ ๊ฒฝ์ฐ, ์ด๋ฌํ ์ฅ๋น๋ฅผ ์ง์์ ์ผ๋ก ์ด์ยท๊ด๋ฆฌํ ์ ๋ฌธ ์ธ๋ ฅ์ด ํ์ํ๋ค.
๋ ๋ฒ์งธ ์ด์ ๋ ๊ฒฝ์ฐ์ ๋ฐ๋ผ ์ ๋ ฅ์ ์ง์ ์ธก์ ํ ์ ์๊ฑฐ๋, ์ ๋ ฅ ์ธก์ ์ด ๋์ ์ํ ์ธก์ ๋ณด๋ค ์ ๋ขฐ์ฑ์ด ๋จ์ด์ง๋ ์ํฉ์ด ์กด์ฌํ๋ค๋ ์ ์ด๋ค. ์๋ฅผ ๋ค์ด, ๋ํ ๊ตฌ์กฐ๋ฌผ์ ์์ฉํ๋ ํธ๋ ๋ฐ ํํ์ค์ ์ ํํ ์ธก์ ํ ์ ๋ขฐํ ๋งํ ๋ฐฉ๋ฒ์ด ์์ง ๋ง๋ จ๋์ง ์์๋ค.
์ด๋ฌํ ๋ ๊ฐ์ง ์ด์ ๋ก, ๊ฐ๋ฅํ ์๋ตโ์ ์ฉ ์ผ์ ๋คํธ์ํฌ๋ง์ ์ด์ฉํด ๋์ ์์คํ ์ ๋ชจ๋ํฐ๋งํ๊ณ ์์์ ๊ฐ์งํ๋ฉฐ, ๊ถ๊ทน์ ์ผ๋ก ์ ๋ขฐํ ์ ์๋ ์์ ์์ธก์ ์ ๊ณตํ๊ธฐ ์ํด ์ต๋ํ์ ์ ๋ณด ์ถ์ถ์ ๋ชฉํ๋ก ํ๋ ๋ฐ์ดํฐ ์ตํฉ ๋ฐ ์์คํ ์๋ณ ์๊ณ ๋ฆฌ์ฆ์ ๊ฐ๋ฐ์ด ํ์ํ๋ค.
์ด์ ๊ฐ์ ํ๋ฆ ์์์ ๋ง์ ์ฐ๊ตฌ์๋ค์ด ์๋ ค์ง์ง ์์ ์ ๋ ฅ ๋ฌธ์ (unknown input problem)๋ฅผ ํด๊ฒฐํ๊ธฐ ์ํ ์ ์ฐจ๋ฅผ ์ ์ํ์๋ค[38]. ๊ทธ๋ฌ๋ ๋๋ถ๋ถ์ ๊ธฐ์กด ๋ฐฉ๋ฒ์ ์์คํ ํ๋ผ๋ฏธํฐ๊ฐ ์๋ ค์ ธ ์๋ค๊ณ ๊ฐ์ ํ๋ค. ์ด๋ ์์ ํ์ง๋ผ๋ ์ฒ ํ๊ณผ๋ ์๋ฐ๋๋ ์ ์ ์ด๋ค. ์ด๋ฌํ ํ์์ฑ์ ์ถฉ์กฑ์ํค๊ธฐ ์ํด Dertimanis ๋ฑ์ ๋ฒ ์ด์ง์ ํํฐ๋ง ํ๋ ์์ํฌ๋ฅผ ์ฐ์์ ์ผ๋ก ์ ์ฉํ์ฌ ์ ๋ ฅโํ๋ผ๋ฏธํฐโ์ํ๋ฅผ ๋์์ ์ถ์ ํ๋ ๋ฐฉ๋ฒ์ ์ ์ํ์๋ค[1]. ์ด ๋ฐฉ๋ฒ์ ์ ํ๋ ์ถ๋ ฅ ์ ๋ณด๋ง์ผ๋ก๋ ์ ํ ์์คํ ์ ์ฑ๊ณต์ ์ผ๋ก ์๋ณํ์ง๋ง, ์ฑํ๋ ๊ฐ์ ๋ฐฉ์ ์์ ๊ณต๋ถ์ฐ ํ๋ ฌ์ ์กฐ์ ํ๋ ๋ณด๋ค ๋ฌผ๋ฆฌ์ ์ผ๋ก ์๋ฏธ ์๋ ๊ณผ์ ์ด ํ์ํ๋ค๊ณ ์ ์๋ค์ ์ง์ ํ์๋ค.
Castiglione ๋ฑ์ ์๋ ค์ง์ง ์์ ์ ๋ ฅ์ ์๊ฐโ๊ฐ๋ณ ์๋ ํ๊ท ๋ชจ๋ธ๋ก ํํํ๊ณ , ํ๋ผ๋ฏธํฐ์ ํจ๊ป ๋์์ ์ถ์ ํ๋ ์ ๋ต์ ๊ฐ๋ฐํ์๋ค[9]. ๊ทธ๋ฌ๋ ์ถ์ ๋ ์ ๋ ฅ์ ์ ์ฃผํ ๋๋ฆฌํํธ๊ฐ ๋ฐ์ํด ๋ณ์ ์๋ต์ ๋ง์กฑ์ค๋ฝ๊ฒ ์ถ์ ํ์ง ๋ชปํ๋ค๋ ํ๊ณ๊ฐ ์์๋ค.
Maes ๋ฑ์ ํ์ฌ ์ํ ์ฃผ๋ณ์์ ์์คํ ๋ชจ๋ธ์ ์ ํํํ์ฌ ํ์ฅ ์นผ๋ง ํํฐ์ ์ ์ฌํ ์๊ณ ๋ฆฌ์ฆ์ ์ ์ํ์๋ค[10]. ์ด ๋ฐฉ๋ฒ์ ์ ํ ์์คํ ์ ๋ํด์๋ ์ฑ๊ณตํ์ง๋ง, ์ค์ ๋ํ ์์คํ ์ด๋ ๊ณ ๋น์ ํ ์์คํ ์์๋ ์ผ์ฝ๋น์ ๊ณ์ฐ์ด ๋ถ์์ฉ์ ์ด๋ํ ์ ์๋ค.
Lei ๋ฑ์ ๋น์ ํ ์ต์์ ๊ณฑ๋ฒ์ ์ฌ๊ท์ ์ผ๋ก ์ ์ฉํ๊ณ , ์ด๋ฅผ ๋ฌดํฅ ์นผ๋ง ํํฐ(UKF) ๊ฐ๋ ์์ ํตํฉํ์๋ค[11]. ๊ทธ๋ฌ๋ ๋น์ ํ ์ต์์ ๊ณฑ๋ฒ์ ๋นํจ์จ์ ์ธ ์ก์ ํํฐ๋ง์ ์ด๋ํ ์ ์์ผ๋ฉฐ, ์ง๋์ด ์ง์๋ ์๋ก ์ํยท์ ๋ ฅ ์ถ์ ์ด ์ ์ ๋ฐ์ฐํ๋ ์์ธ์ด ๋ ์ ์๋ค.
Song์ ์ง์ ํผ๋์ค๋ฃจ(direct feedthrough)๋ฅผ ํฌํจํ ์ต์ ๋ถ์ฐ ํธํฅ ์๋ UKF์ ์ฌ๋ฌ ๋ณํ์ ์ ์ํ๊ณ , ์ด ๋ฐฉ๋ฒ์ ์ฑ๊ณต์ ๊ฑฐ๋์๋ค[12]. ๋ค๋ง ์ ์๋ ํ๋ก์ธ์ค ์ค๋ฅ์ ํฌํจ๋ ์ ๋ ฅ๋ง์ ๊ณ ๋ คํ์ผ๋ฉฐ, ์ ๋ ฅ ์์ฒด๊ฐ ํ๋ก์ธ์ค ์ค๋ฅ์ ํฌํจ๋์ง ์์ ๊ฒฝ์ฐ๋ ๋ค๋ฃจ์ง ์์๋ค. ๋ํ ์ ๋ ฅ ์ ๋ณด๋ฅผ ์ ํ ์ฌ์ฉํ์ง ์๋ ์์คํ ์๋ณ ๊ธฐ๋ฒ๋ ์ฐ๊ตฌ๋์์ง๋ง[13โ16], ํ๋ผ๋ฏธํฐ ์ถ์ ์ธ์๋ ๋์ ์ํ์ ์ ๋ ฅ์ ๋์์ ์ ๊ณตํ์ง ๋ชปํ๋ ๊ฒฝ์ฐ๊ฐ ๋ง๋ค.
๋ณธ ์ฐ๊ตฌ์์๋ **์๋ก์ด ๋ฌดํฅ ์นผ๋ง ํํฐ(IPSโUKF)**์ ์ฑ๋ฅ์ ๊ฒ์ฆํ๋ค. ์๋ ค์ง์ง ์์ ์ ๋ ฅ์ ๋งค ์๊ฐ ๋จ๊ณ๋ง๋ค ๋ ๋จ๊ณ์ ๊ฑธ์ณ ์ถ์ ๋๋ค. ์ฒซ ๋ฒ์งธ ๋จ๊ณ์์๋ ์์ธก๋ ๋์ ์ํ์ ์์คํ ํ๋ผ๋ฏธํฐ๋ฅผ ์ด์ฉํด ์ ๋ ฅ์ ์ถ์ ํ๊ณ , ๋ ๋ฒ์งธ ๋จ๊ณ์์๋ ์ธก์ ๊ฐ์ผ๋ก ๋ณด์ ๋(์ ๋ฐ์ดํธ๋) ๋์ ์ํ์ ํ๋ผ๋ฏธํฐ๋ฅผ ์ด์ฉํด ์ต์ข ์ ๋ ฅ์ ๋ค์ ์ถ์ ํ๋ค.
์ ์๋ ๋ฐฉ๋ฒ์ ์ ๋ก ์ ๋ ฅ์ด๋ ๋น์ ๋ก ์ ๋ ฅ์ด๋ ์กด์ฌํ๋ ๊ฒฝ์ฐ์ ์ ํยท๋น์ ํ ์์คํ ๋ชจ๋์ ์ ์ฉ ๊ฐ๋ฅํ๋ค. ์ ์ฒด ์์คํ ์ ์ถ์ ํ๊ธฐ ์ํด์๋ ๋ณ์, ์๋, ๊ฐ์๋ ์ ํธ๋ฅผ ๋ชจ๋ ํ์ฉํ๋ ๊ฒ์ด ๊ถ์ฅ๋์ง๋ง, ๋ฐ์ดํฐ ์ตํฉ ๊ธฐ๋ฒ์ ์ ์ฉํ๋ฉด ์ด ๊ฐ์ ์ด ์ํ๋ ์ ์๋ค. ๋ค๋ง, ๋ณธ ๋ ผ๋ฌธ์์๋ ๋ฏผ๊ฐ๋ ๋ถ์์ ํตํด ์ด๋ฌํ ์ํ๊ฐ ๋ฐ๋์ ํ์ํ์ง ์์์ ๋ณด์ธ๋ค.
๋ํ, ์ผ์ฝ๋น์ ๋ํจ์, ์ต์์ ๊ณฑ ๋์ , ๋น๋ฌผ๋ฆฌ์ ์ ํ ๊ณผ์ , ํน์ ์ํ ์ถ์ ํฌ์๊ณผ ๊ฐ์ ๋ณต์กํ ์ ์ฐจ๋ ํ์ํ์ง ์๋ค.
๋ ผ๋ฌธ์ ๊ตฌ์ฑ
- ์ 2์ฅ์์๋ ๋์ ์ํ์ ํ๋ผ๋ฏธํฐ๋ฅผ ๋์์ ์ถ์ ํ๋ ํ์ค ๋ฌดํฅ ์นผ๋ง ํํฐ(UKF)์ ์ํ์ ํํ๋ฅผ ์ ์ํ๋ค.
- ์ 3์ฅ์์๋ ์ ์๋ IPSโUKF ๋ฐฉ๋ฒ๋ก ์ ์์ธํ ์ ๊ฐํ๋ค. ํ์ค UKF์ ์ ์ ๋ฐฉ๋ฒ ๋ชจ๋์ ๋ํ ์์ฌ์ฝ๋(pseudoโcode) ํ๋ฅผ ์ ๊ณตํ๋ค.
- ์ 4์ฅ์์๋ ๋ฌธ์ ์ ์๋ณ ๊ฐ๋ฅ์ฑ(identifiability) ํน์ฑ์ ๋ถ์ํ๋ค.
- ์ 5์ฅ์์๋ ์ ํ ๋ฐ ๋น์ ํ ์์คํ ์ ๋ํ ์์น ์์ ๋ฅผ ํตํด ๋ฐฉ๋ฒ์ ์ ํจ์ฑ์ ๊ฒ์ฆํ๋ค.
- ์ 6์ฅ์์๋ ์ ์ฒด ์ํ ์ธก์ ๊ถ๊ณ ์ฌํญ์ ๋ํ ๋ฏผ๊ฐ๋ ๋ถ์์ ์ํํ๋ค.
- ์ 7์ฅ์์๋ ๊ฒฐ๋ก ์ ์ ์ํ๋ค.
2. ํ์ค ๋ฌดํฅ ์นผ๋ง ํํฐ(UKF)์ ์ํ์ ๊ตฌํ
์ฐ์์๊ฐ ์์ญ์์ ๋น์ ํ ํ๋ก์ธ์ค ๋ฐฉ์ ์์
[ \dot{\mathbf{z}}(t)=\mathbf{f}\bigl(\mathbf{z}(t),\mathbf{u}(t)\bigr)+\boldsymbol{\nu}(t) ]
์ด๋ฉฐ, ๋น์ ํ ๊ด์ธก ๋ฐฉ์ ์์
[ \mathbf{y}(t)=\mathbf{h}\bigl(\mathbf{z}(t),\mathbf{u}(t)\bigr)+\boldsymbol{\eta}(t) ]
์ด๋ค. ์ฌ๊ธฐ์ ์ํ ๋ฒกํฐ
[ \mathbf{z}(t)=\begin{bmatrix}\mathbf{x}(t)\ \dot{\mathbf{x}}(t)\ \boldsymbol{\theta}\end{bmatrix} ]
๋ ๋์ ์ํ (\mathbf{x}(t),\dot{\mathbf{x}}(t))์ ํ๋ผ๋ฏธํฐ (\boldsymbol{\theta})๋ฅผ ํฌํจํ๋ค. (\mathbf{f}(\cdot))์ (\mathbf{h}(\cdot))๋ ๊ฐ๊ฐ ์ํ ์ ์ด ํจ์์ ๊ด์ธก ํจ์๋ฅผ ์๋ฏธํ๋ฉฐ, ์ ๋ ฅ ๋ฒกํฐ (\mathbf{u}(t))๋ฅผ ๊ณ ๋ คํ๋ค. ํ๋ก์ธ์ค ์ก์ (\boldsymbol{\nu}(t))์ ์ธก์ ์ก์ (\boldsymbol{\eta}(t))๋ ๊ฐ๊ฐ ๊ณต๋ถ์ฐ ํ๋ ฌ (\mathbf{Q}(t)), (\mathbf{R}(t))๋ฅผ ๊ฐ์ง๋ค.
์ ๋ฐฉ์ ์๋ค์ ์ด์ฐํํ๋ฉด
[ \mathbf{z}{k}= \mathbf{f}d\bigl(\mathbf{z}{k-1},\mathbf{u}{k-1}\bigr)+\boldsymbol{\nu}_{k-1} ]
[ \mathbf{y}{k}= \mathbf{h}d\bigl(\mathbf{z}{k},\mathbf{u}{k}\bigr)+\boldsymbol{\eta}_{k} ]
๊ฐ ๋๋ค. ์ฌ๊ธฐ์ (k)๋ (k\Delta t) ์์ ์ ์๋ฏธํ๊ณ , (\Delta t)๋ ์ํ๋ง ๊ฐ๊ฒฉ์ด๋ค.
๊ฐ์ฐ์์ ์ก์์ด ํ๊ท 0์ธ ๊ฒฝ์ฐ, UKF ์ ์ฐจ๋ ํ 1A์ ์ ์๋ ์์ฌ์ฝ๋์ ๊ฐ์ด ์ ๊ฐ๋๋ค.
- (\lambda = \alpha^{2}(L+\kappa)-L) (๋ณด์กฐ ํ๋ผ๋ฏธํฐ (\kappa =0) ํน์ (3-L))
- (\alpha\in[10^{-4},1])๋ ์๊ทธ๋ง ํฌ์ธํธ์ ํผ์ง ์ ๋๋ฅผ ๊ฒฐ์
- ๊ฐ์ค์น (\mathbf{W})๋ (\beta) (๋ถํฌ์ ๋ํ ์ฌ์ ์ ๋ณด)์ ํจ๊ป ์ ์
3. ์ ๋ ฅโํ๋ผ๋ฏธํฐโ์ํ๋ฅผ ๋์์ ์ถ์ ํ๋ IPSโUKF
IPSโUKF์์๋ ๋งค ์๊ฐ ๋จ๊ณ๋ง๋ค ๋ ๋ฒ์ ๊ฑธ์ณ ์ ๋ ฅ์ ์ถ์ ํ๋ค.
-
์์ธก ๋จ๊ณ์์ ํ์ฌ ์์ (k)์ ์์ธก ์ํ (\hat{\mathbf{z}}_{k|k-1})์ ํ๋ผ๋ฏธํฐ๋ฅผ ์ด์ฉํด ์ฐ์ ์ด๋ ๋ฐฉ์ ์
[ \mathbf{u}{e,k}= \mathbf{G}^{-1}\bigl(\ddot{\mathbf{x}}{k|k-1} - \mathbf{f}(\hat{\mathbf{z}}_{k|k-1},\mathbf{u}=0)\bigr) ]
๋ก๋ถํฐ ์ ๋ ฅ์ ์ถ์ ํ๋ค. ์ฌ๊ธฐ์ (\mathbf{G}(\cdot))๋ ์ ํยท๋น์ ํ ๋ชจ๋ ๊ฐ๋ฅํ๊ณ , ์ถ์ ๋ ํ๋ผ๋ฏธํฐ๋ฅผ ํฌํจํ๋ค.
-
๋ณด์ ๋จ๊ณ์์๋ ์ธก์ ๊ฐ (\mathbf{y}{k})๋ฅผ ์ด์ฉํด ์ํ์ ํ๋ผ๋ฏธํฐ๋ฅผ ์ ๋ฐ์ดํธํ ๋ค, ์ ๋ฐ์ดํธ๋ ์ํ (\hat{\mathbf{z}}{k|k})์ ํ๋ผ๋ฏธํฐ๋ฅผ ๋ค์ ์ฌ์ฉํด ์ ๋ ฅ์ ์ฌ์ถ์ ํ๋ค.
[ \mathbf{u}{e,k}^{\text{final}} = \mathbf{G}^{-1}\bigl(\ddot{\mathbf{x}}{k|k} - \mathbf{f}(\hat{\mathbf{z}}_{k|k},\mathbf{u}=0)\bigr) ]
์ต์ข ์ ๋ ฅ (\mathbf{u}_{e,k}^{\text{final}})์ ๋ค์ ๋จ๊ณ (k+1)์ ์์ธก์ ์ฌ์ฉ๋๋ค.
์ด ๊ณผ์ ์์ ์ ๋ ฅ ์ถ์ ๊ฐ์ ์์ง ์ธก์ ์ผ๋ก ๋ณด์ ๋์ง ์์ ์ํ์ด๋ฏ๋ก, ํด๋น ์ค์ฐจ๋ ๊ด์ธก ๋ฐฉ์ ์์ ์ธก์ ์ก์ (\boldsymbol{\eta}{k})์ ํฌํจ๋๋ค. ๋ฐ๋ผ์ (\boldsymbol{\eta}{k})๋ ์ค์ ์ธก์ ์ก์๊ณผ ์ ๋ ฅ ์ถ์ ์ค์ฐจ๋ฅผ ๋์์ ๋ชจ๋ธ๋งํ๋ค.
ํ 1B๋ ์ ์ ์ฐจ๋ฅผ ํฌํจํ IPSโUKF ์์ฌ์ฝ๋๋ฅผ ์ ์ํ๋ค.
4. ์๋ณ ๊ฐ๋ฅ์ฑ(Identifiability) ๊ฒํ
4.1 ์๋ ค์ง ์ ๋ ฅ์ด ์๋ ๊ฒฝ์ฐ
์ ํ ์์คํ ์์ ์ ๋ ฅ์ด ์๋ ค์ ธ ์๊ณ ์ธก์ ์ก์์ด ์์ ๋๋ ํ๋ผ๋ฏธํฐ ๋ฒกํฐ์ ์๋ณ ๊ฐ๋ฅ์ฑ์ ์ง์ญ ์๋ณ์ฑ ํ ์คํธ[18]๋ก ํ์ธํ ์ ์๋ค. ๋น์ ํ ์์คํ ์์๋ ๊ด์ธก ๊ฐ๋ฅ์ฑ ์์ ์กฐ๊ฑด[19]์ ์ด์ฉํ๋ค.
4.2 ์๋ ค์ง์ง ์์ ์ ๋ ฅ์ด ์๋ ๊ฒฝ์ฐ
์ ๋ ฅ์ด ๋ฏธ์ง์ธ ๊ฒฝ์ฐ ์ ๋ ํ ์คํธ๋ ์ ์ฉ๋์ง ์๋๋ค. ์๋ฅผ ๋ค์ด, ๋จ์ผ ์์ ๋(SDOF) ์ ํ ์์คํ ์ ์ง๋๊ณผ ๋ชจ๋ ๋์ ์ํ๊ฐ ์๋ ค์ ธ ์์ด๋ ์๊ฐ ์์ญ์์ ์๋ณ์ด ๋ถ๊ฐ๋ฅํ๋ค. ์ด๋ **์ญ๋ ๋ถ์(perturbation analysis)**์ ํตํด ์ค๋ช ํ ์ ์๋ค.
[ m\ddot{x}+ (c+\Delta c)\dot{x}+ (k+\Delta k)x = u(t)+\Delta u(t) ]
์ ๊ฐ์ด ์ค์ ํ๋ผ๋ฏธํฐ ((c,k,u)) ๋์ ์ค๋ฅ๊ฐ ํฌํจ๋ ํ๋ผ๋ฏธํฐ ((c+\Delta c, k+\Delta k, u+\Delta u))๋ฅผ ์ฌ์ฉํ๋ฉด, ๋์ผํ ์ด๋ ๋ฐฉ์ ์์ ๋ง์กฑํ๋ ๋ ๋ค๋ฅธ ์ ๋ ฅ (\tilde{u}(t)=u(t)+\Delta u(t)-\Delta c\dot{x}-\Delta k x)๊ฐ ์กด์ฌํ๋ค. ๋ฐ๋ผ์ ์ ๋ ฅ์ด ์์ ํ ๋ฏธ์ง์ธ ๊ฒฝ์ฐ, ์ง๋ยท์ํ๋ง์ผ๋ก๋ ํ๋ผ๋ฏธํฐ์ ์ ๋ ฅ์ ๊ตฌ๋ถํ ์ ์๋ค.
์ฃผํ์ ์์ญ์์๋ ์ฃผํ์ ์์ญ ๋ถํด(FDD)[20,21]์ ๊ฐ์ ๋ฐฉ๋ฒ์ด ์๋ ค์ง ์ ๋ ฅ์ด ์์ ๋ ์ ํจํ์ง๋ง, ์ด๋ ์ ๋ ฅยท๋์ ์ํ๋ฅผ ์ถ์ ํ์ง ๋ชปํ๊ณ ์ ํ ์์คํ ์๋ง ์ ์ฉ ๊ฐ๋ฅํ๋ฉฐ ์๋ํ๊ฐ ์ด๋ ต๋ค.
๋ฐ๋ฉด, ๋ค์ค ์์ ๋(MDOF) ์์คํ ์์ ํ๋์ ์์ ๋์ ์๋ ค์ง(์ ๋ก ํน์ ๋น์ ๋ก) ์ ๋ ฅ์ด ์กด์ฌํ๋ค๋ฉด ์๋ณ ๊ฐ๋ฅ์ฑ์ด ํ๋ณด๋ ์ ์๋ค. 2โDOF ์ ํ ์์คํ ์ ์๋ก ๋ค๋ฉด, ์ฒซ ๋ฒ์งธ ์์ ๋์ ์ ๋ ฅ์ด ์๋ ค์ ธ ์์ผ๋ฉด ๋ ๋ฒ์งธ ์์ ๋์ ํ๋ผ๋ฏธํฐ์ ์ ๋ ฅ์ ๊ณ ์ ํ๊ฒ ์๋ณํ ์ ์๋ค. ๋น์ ํ ์์คํ ์์๋ ๋์ผํ ๋ ผ๋ฆฌ๊ฐ ์ ์ฉ๋๋ค.
5. ์์น ์์
5.1 ์ ํ MDOF ์์คํ
๊ทธ๋ฆผโฏ1์ ๋ํ๋ 3โDOF ๊ตฌ์กฐ๋ฌผ์ ๋ค์๊ณผ ๊ฐ์ด ๋ชจ๋ธ๋งํ๋ค.
[ \mathbf{M}\ddot{\mathbf{x}}(t)+\mathbf{C}\dot{\mathbf{x}}(t)+\mathbf{K}\mathbf{x}(t)=\mathbf{u}(t) ]
์ฌ๊ธฐ์ (\mathbf{M})๋ ์ง๋ ํ๋ ฌ, (\mathbf{C})์ (\mathbf{K})๋ ๊ฐ๊ฐ ๊ฐ์ ยท๊ฐ์ฑ ํ๋ ฌ์ด๋ฉฐ, ์๋ณ ๋์์ (\mathbf{C},\mathbf{K})์ด๋ค. ์ด๊ธฐ ์กฐ๊ฑด์ (\mathbf{x}(0)=\mathbf{0},\dot{\mathbf{x}}(0)=\mathbf{0})์ด๋ฉฐ, 5โฏs ์์ ์ 0.01โฏs ๋์ 100โฏN์ ํ์ค๊ฐ ๊ฐํด์ง๋ค(์ฌ์ ์ ๋ณด ์์).
ํฉ์ฑ ์ธก์ ๊ฐ์ 4์ฐจ RungeโKutta ๋ฐฉ๋ฒ์ผ๋ก 30โฏs ๋์ ์๋ฎฌ๋ ์ด์ ํ๊ณ , ์ํ๋ง ์ฃผํ์ 100โฏHz(ฮtโฏ=โฏ0.01โฏs)๋ก ์ถ์ถํ๋ค. ๊ฐ ์ ํธ์๋ RMSโฏ5โฏ% ์์ค์ ๊ฐ์ฐ์์ ๋ฐฑ์ ์ก์์ด ์ถ๊ฐ๋๋ค.
์ด์ฐํ๋ ์ํโ๊ณต์ ๋ชจ๋ธ์
[ \mathbf{z}{k}= \mathbf{A}\mathbf{z}{k-1}+ \mathbf{B}\mathbf{u}{k-1}+ \boldsymbol{\nu}{k-1} ]
[ \mathbf{y}{k}= \mathbf{H}\mathbf{z}{k}+ \boldsymbol{\eta}_{k} ]
์ ๊ฐ์ด ํํ๋๋ค. ์ฌ๊ธฐ์ (\mathbf{z}{k})๋ ([\mathbf{x}{k}^{\top},\dot{\mathbf{x}}_{k}^{\top},\boldsymbol{\theta}^{\top}]^{\top}) ํํ์ด๋ฉฐ, (\boldsymbol{\theta})๋ (\mathbf{C},\mathbf{K})์ ํ๋ผ๋ฏธํฐ ๋ฒกํฐ์ด๋ค.
๊ณต๋ถ์ฐ ํ๋ ฌ์ (\mathbf{Q}=10^{-9}\mathbf{I}{12}), (\mathbf{R}=10^{-3}\mathbf{I}{9}) ๋ก ๊ณ ์ ํ์๋ค. ๊ฐ์ด ํฌ๊ฒ ๋๋ฉด ์๋ ด ์๋๊ฐ ๋๋ ค์ง๊ฑฐ๋ ๋ฐ์ฐํ๋ค.
์๋ฎฌ๋ ์ด์ ๊ฒฐ๊ณผ(๊ทธ๋ฆผโฏ2)์์๋ ์ค์ ์๋ต, ๊ฐ์ฑยท๊ฐ์ ํ๋ผ๋ฏธํฐ, ๊ทธ๋ฆฌ๊ณ ์ ๋ ฅ ์ถ์ ๊ฐ์ด ๋ชจ๋ ๋ง์กฑ์ค๋ฝ๊ฒ ์๋ ดํจ์ ํ์ธํ ์ ์๋ค. ๋ํ, ํ๊ฒฝ ์ก์์ด ์กด์ฌํ๋ ๊ฒฝ์ฐ์๋ (๊ทธ๋ฆผโฏ3)์ ๊ฐ์ด ์ฃผ๋ณ(ambient) ์ ๋ ฅ์ ๋ํด ๋์ผํ ์ฑ๋ฅ์ ๋ณด์ธ๋ค.
5.2 ๋น์ ํ 2โDOF ์์คํ (Dung ๋ชจ๋ธ)
๋ค์ ๋น์ ํ ์์คํ ์ ๊ณ ๋ คํ๋ค.
[ \mathbf{M}\ddot{\mathbf{x}}(t)+\mathbf{C}\dot{\mathbf{x}}(t)+\mathbf{K}\mathbf{x}(t)+\mathbf{K}_{nl}\mathbf{x}^{3}(t)=\mathbf{u}(t) ]
์ฌ๊ธฐ์ (\mathbf{K}_{nl})๋ ๋น์ ํ ๊ฐ์ฑ ํญ์ ๋ํ๋ธ๋ค. ์ด๊ธฐ ์กฐ๊ฑด์ (\mathbf{x}(0)=\mathbf{0},\dot{\mathbf{x}}(0)=\mathbf{0})์ด๋ฉฐ, 5โฏs ์์ ์ 0.01โฏs ๋์ 100โฏN ํ์ค์ ํ๊ท 0, ๋ถ์ฐ 4์ธ ๊ฐ์ฐ์์ ์ก์์ด ๋์์ DOFโฏ2์ ๊ฐํด์ง๋ค.
ํฉ์ฑ ์ธก์ ์ ์ ์ ์ฐจ์ ๋์ผํ๊ฒ ์์ฑํ์ผ๋ฉฐ, ๊ณต๋ถ์ฐ ํ๋ ฌ์ (\mathbf{Q}=10^{-9}\mathbf{I}{10}), (\mathbf{R}=10^{-5}\mathbf{I}{6}) ๋ก ์ค์ ํ์๋ค.
๊ทธ๋ฆผโฏ4๋ ์ค์ ์ ์ถ์ ๋ ์๋ต, ํ๋ผ๋ฏธํฐ, ๊ทธ๋ฆฌ๊ณ ์ ๋ ฅ์ด ๋ชจ๋ ์ ์๋ ดํจ์ ๋ณด์ฌ์ค๋ค.
6. ๋ฏผ๊ฐ๋ ๋ถ์ ๋ฐ ์ธก์ ์ ๋ต
์ ์ฒด ์ํ(๋ณ์ยท์๋ยท๊ฐ์๋) ์ธก์ ์ด ๊ฐ์ฅ ์ด์์ ์ด์ง๋ง, ์ค์ ํ์ฅ์์๋ ๋น์ฉยท์ค์น ์ ์ฝ์ผ๋ก ์ ํ๋ ์ ์๋ค. ๋ฐ์ดํฐ ์ตํฉ ๊ธฐ๋ฒ[22]์ IPSโUKF์ ๊ฒฐํฉํ๋ฉด ์ธก์ ์ฑ๋์ ๊ฐ์์์ผ๋ ์ถฉ๋ถํ ์ฑ๋ฅ์ ์ ์งํ ์ ์๋ค.
๋ฏผ๊ฐ๋ ๋ถ์ ๊ฒฐ๊ณผ, ๊ฐ ์์ ๋๋น ์ต์ ๋ ๊ฐ์ ๋์ ์ํ(์: ๋ณ์์ ์๋, ํน์ ๋ณ์์ ๊ฐ์๋)๋ฅผ ์ธก์ ํ๋ฉด ๋น์ ํ ์์คํ ๋ ์ถฉ๋ถํ ์๋ณ ๊ฐ๋ฅํจ์ ํ์ธํ์๋ค.
- ๊ณ ์ฃผํ ์ก์์ ๋ฏธ๋ถ(์: ์๋ โ ๊ฐ์๋) ๊ณผ์ ์์ ํฌ๊ฒ ์ฆํญ๋๋ค.
- ์ ์ฃผํ ๋๋ฆฌํํธ๋ ์ ๋ถ(์: ๊ฐ์๋ โ ๋ณ์) ๊ณผ์ ์์ ์์ค๋๋ค.
ํนํ, ๊ฐ์๋ ์ ์ฉ ์ธก์ ๋ง์ ์ฌ์ฉํ ๊ฒฝ์ฐ(๊ทธ๋ฆผโฏ7) ํ๋ผ๋ฏธํฐ์ ์ ๋ ฅ ์ถ์ ์ด ํฌ๊ฒ ํธํฅ๋๊ณ , ๋ฐ๋ณต ์คํ ์ ์๋ ด๊ฐ์ด ๋ฌ๋ผ์ง๊ฑฐ๋ ๋ฐ์ฐํ๋ค. ์ด๋ ๊ฐ์๋๋ง์ผ๋ก๋ ์์คํ ์ ์ ์ฃผํ ํน์ฑ์ ์ถฉ๋ถํ ํฌ์ฐฉํ์ง ๋ชปํ๊ธฐ ๋๋ฌธ์ด๋ค.
๋ฐ๋ฉด, ๋ณ์ยท์๋ยท๊ฐ์๋ 3์ฑ๋์ ๋ชจ๋ ์ฌ์ฉํ ๊ฒฝ์ฐ(๊ทธ๋ฆผโฏ5,โฏ6) ๋ชจ๋ ํ๋ผ๋ฏธํฐ์ ์ ๋ ฅ์ด ์์ ์ ์ผ๋ก ์ถ์ ๋๋ค.
7. ๊ฒฐ๋ก
- ์ ์๋ IPSโUKF๋ ๋งค ์๊ฐ ๋จ๊ณ๋ง๋ค ๋ ๋ฒ์ ๊ฑธ์ณ ์ ๋ ฅ์ ์ถ์ ํจ์ผ๋ก์จ, ์๋ ค์ง์ง ์์ ์ ๋ ฅยทํ๋ผ๋ฏธํฐยท์ํ๋ฅผ ๋์์ ์จ๋ผ์ธ์ผ๋ก ์๋ณํ ์ ์๋ค.
- ์ต์ ํ๋์ ์ ๋ก ํน์ ๋น์ ๋ก ์ ๋ ฅ์ด ์์คํ ์ ์ด๋ ์์ ๋์๋ผ๋ ์กด์ฌํ๋ค๋ฉด, ์ญ๋ ๋ถ์์ ํตํด ์์คํ ์ ๊ณ ์ ํ๊ฒ ์๋ณํ ์ ์์์ ์ฆ๋ช ํ์๋ค.
- ๊ณต์ ยท์ธก์ ๊ณต๋ถ์ฐ ํ๋ ฌ์ ์ ์ ํ ์บ๋ฆฌ๋ธ๋ ์ด์ ์ด ์๋ ด์ ๊ฒฐ์ ์ ์ธ ์ํฅ์ ๋ฏธ์น๋ฉฐ, ์ด๋ ๋ณธ ์ฐ๊ตฌ์ ๋ฒ์๋ฅผ ๋์ด์ ๋ณ๋ ์ฐ๊ตฌ๊ฐ ํ์ํ๋ค.
- **์ ์ฒด ์ํ ์ธก์ (๋ณ์ยท์๋ยท๊ฐ์๋)**์ด ๊ฐ์ฅ ๊ถ์ฅ๋์ง๋ง, ๋ฐ์ดํฐ ์ตํฉ์ ํ์ฉํ๋ฉด ์ธก์ ์ฑ๋์ ๊ฐ์์์ผ๋ ์ถฉ๋ถํ ์ฑ๋ฅ์ ์ ์งํ ์ ์๋ค.
- ์ ๋ฐ์ ์ผ๋ก, ์ ์๋ ์ ์ฐจ๋ ์์คํ ์๋ต, ์ ๋ ฅ, ๊ทธ๋ฆฌ๊ณ ๋ชจ๋ธ ํ๋ผ๋ฏธํฐ๋ฅผ ๋์ยท์ค์๊ฐ์ผ๋ก ์ ํํ ์ถ์ ํ ์ ์๋ ๊ฐ๋ ฅํ ๋๊ตฌ์์ ๋ค์ํ ์ ํยท๋น์ ํ ์ฌ๋ก๋ฅผ ํตํด ํ์ธํ์๋ค.
๋ณธ ๋ฒ์ญ์ ์๋ฌธ์ ์๋ฏธ์ ๊ธฐ์ ์ ์ ํ์ฑ์ ์ ์งํ๋ฉด์ ์ต์ 2,000์ ์ด์์ ํ๊ธ ํ ์คํธ๋ก ๊ตฌ์ฑ๋์์ต๋๋ค.