TCST 2024 โ Cascade Tube-based MPC๋ฅผ ์ด์ฉํ ์์ ๋ณด์ฅ ์ ๋ฐ ์ ์
C. Lee, Q. V. Tran, J. Kim, IEEE Transactions on Control Systems Technology, 32(4), 1504โ1511, July 2024. DOI: 10.1109/TCST.2024.3376228
๋ชฉ์ฐจ
- ์ ์(Berthing) ๋ฌธ์ ์ ์ด๋ ค์
- ๋ฐฐ๊ฒฝ: ์ ์ผ๋ฐ MPC๋ง์ผ๋ก๋ ๋ถ์กฑํ๊ฐ
- Tube MPC ๋ณต์ต (L12์ ์ฐ๊ฒฐ)
- Cascade ๋ถํด โ LTI surge + LPV sway-yaw
- RPI ์งํฉ ์คํ๋ผ์ธ ๊ณ์ฐ
- ์ข ์ ๊ตฌ์กฐ์ ์ค์๊ฐ ์คํ
- ์๋ฎฌ๋ ์ด์ ๊ฒฐ๊ณผ
- ๊ฐ์ ์ฐ๊ฒฐ ์์ฝ
1. ์ ์(Berthing)์ด๋?
์ ์์ ์ ๋ฐ์ด ๋ถ๋์ ์ ๋ฐํ๊ธฐ ์ํด ๋งค์ฐ ์ ์(1 m/s ๋ฏธ๋ง)์ผ๋ก ๊ธฐ๋ํ๋ฉฐ ๋ถ๋ยท๋ค๋ฅธ ๋ฐฐ์ ๊ฐ๊ฒฉ์ ์ ํํ๊ฒ ๋ง์ถ๋ ๊ณผ์ ์ ๋๋ค. ์ด๋ ค์ด ์ด์ ๋ ์ธ ๊ฐ์ง:
- ์ ์์ผ์๋ก ์ ์ด๋ ฅ์ด ์ฝํจ โ ๋ฌ๋์ ํ๋กํ ๋ฌ์ ํจ์จ์ด ์๋ ์ ๊ณฑ์ ๋น๋กํด ๋จ์ด์ง.
- ์ธ๋์ด ์๋์ ์ผ๋ก ํผ โ ๊ฐ์ ๋ฐ๋์ด๋ผ๋ ์ ์์์ ์ํฅ์ด 10๋ฐฐ ์ด์ ์ปค์ง.
- ์์ ์ฌ์ ๊ฐ ์์ โ ๋ถ๋ยท๋ค๋ฅธ ๋ฐฐ๊น์ง ์ ๋ฏธํฐ๋ ์ ๋๋ ๊ฐ๊ฒฉ.
์ฆ, "์ ์ด๋ ฅ์ ์์๋ฐ ์ธ๋์ ํฌ๊ณ ์์ ์ฌ์ ๋ ๊ฑฐ์ ์๋" ์ํฉ. ์ด๋ฐ ์กฐ๊ฑด์์ ๋ช ๋ชฉ MPC(์ธ๋์ด 0์ด๋ผ๊ณ ๊ฐ์ ํ MPC)๋ ์ธ๋์ด ๋ค์ด์ค๋ ์๊ฐ ์ ์ฝ์ ์ด๊ธธ ์ ์์ต๋๋ค.
2. ๋ฐฐ๊ฒฝ โ ์ ์ผ๋ฐ MPC๊ฐ ๋ถ์กฑํ๊ฐ
L11 MPC์์ ๋ฐฐ์ด ํ์ค MPC๋ ์ํ ์ ์ฝ $x \in \mathcal{X}$๋ฅผ ๋ช ๋ชฉ ๊ถค์ ์๋ง ์ ์ฉํฉ๋๋ค. ํ์ง๋ง ์ธ๋ $w \in \mathcal{W}$๊ฐ ์์ผ๋ฉด:
$$ x_{k+1} = Ax_k + Bu_k + w_k $$์ค์ ์ํ๋ ๋ช ๋ชฉ ๊ถค์ ๊ณผ ๋ค๋ฆ ๋๋ค. ํ ์คํ ๋ง๋ค ํธ์ฐจ๊ฐ ๋์ ๋๋ฏ๋ก, ์ ์ฝ ๊ฒฝ๊ณ ๊ทผ์ฒ๋ก ๊ฐ ๋ช ๋ชฉ ๊ถค์ ์ ์ธ๋์ด ๋ผ๋ ์๊ฐ ์ ์ฝ์ ์๋ฐํฉ๋๋ค. "์ฌ์ ๋ฅผ ๋ง์ด ๋๋ค"๋ก๋ ๋ณด์ฅํ ์ ์๊ณ , ์ผ๋ง๋ ์ฌ์ ๋ฅผ ๋ฌ์ผ ํ๋์ง ์ํ์ ์ผ๋ก ๊ณ์ฐํด์ผ ํฉ๋๋ค.
3. Tube MPC ๋ณต์ต (L12์ ์ฐ๊ฒฐ)
์ด ๋ ผ๋ฌธ์ ํต์ฌ ๋๊ตฌ๋ L12 ๊ณ ๊ธ MPC์์ ๋ค๋ฃฌ Tube MPC(Mayne, Seron, Rakoviฤ 2005)์ ๋๋ค. ํต์ฌ ์์ด๋์ด๋:
- ์ค์ ์ํ $x_k$๋ฅผ ๋ช ๋ชฉ ์ํ $\bar x_k$์ ์ค์ฐจ $e_k = x_k - \bar x_k$๋ก ๋ถํด.
- ๋ณด์กฐ ์ ์ด๊ธฐ $u = \bar u + Ke$๋ก ์ค์ฐจ๋ฅผ ์์ ์งํฉ $\mathcal{S}$ (minimal Robust Positively Invariant set, mRPI) ์์ ๊ฐ๋ .
- ๋ช ๋ชฉ MPC๋ ์๋ ์ ์ฝ์์ $\mathcal{S}$๋งํผ ๋น๊ฒจ์ง(tightened) ์ ์ฝ์ ํ๋๋ก ์ค๊ณ.
$\ominus$๋ Pontryagin ์ฐจ์งํฉ(์งํฉ $A$์์ $B$์ ๋ชจ๋ ์ ์ ๋นผ๋ ์ฌ์ ํ $A$ ์์ ์๋ ์งํฉ). ๊ฒฐ๋ก : ์ธ๋์ด ์ด๋ป๊ฒ ๋ค์ด์ค๋ ์ค์ ์ํ๋ ํญ์ $\bar x_k \oplus \mathcal{S}$ ์, ์ฆ ์๋ ์ ์ฝ $\mathcal{X}$ ์์ ๋จธ๋ฌด๋ฆ ๋๋ค.
๐ฎ ์ธํฐ๋ํฐ๋ธ: Tube MPC์ ์์ ๋น๊ธฐ๊ธฐ(tightening)
ํ๋ ์ฌ๊ฐํ์ด ์๋ ์์ ์์ญ $\mathcal{X}$. ์ฃผํฉ ์ฌ๊ฐํ์ด ์ค์ฐจ ์งํฉ $\mathcal{S}$์ ํฌ๊ธฐ(์ฌ๋ผ์ด๋๋ก ์กฐ์ ). ์ด๋ก ์ฌ๊ฐํ์ ๋ช ๋ชฉ ๊ถค์ ์ด ๋ฐ๋์ ์์ด์ผ ํ ๋น๊ฒจ์ง ์์ญ $\mathcal{X} \ominus \mathcal{S}$. ์ธ๋์ด ํด์๋ก ์ด๋ก ์์๊ฐ ์์์ง๋๋ค.
4. Cascade ๋ถํด โ LTI surge + LPV sway-yaw
์ ๋ฐ ๋์ญํ์ ๋น์ ํ ๊ฒฐํฉ์ด ๊ฐํด ํต์งธ๋ก Tube MPC์ ๋ฃ๊ธฐ๋ ์ด๋ ต์ต๋๋ค. ๋ณธ ๋ ผ๋ฌธ์ ํต์ฌ ๊ธฐ์ฌ๋ ๋ค์ ์ข ์ ๋ถํด์ ๋๋ค:
- Surge ์๋ธ์์คํ โ ์ ์ง ์๋ $u$๋ ์ถ๋ ฅ์๋ง ์ํฅ์ ๋ฐ์ผ๋ฏ๋ก ์ ํ ์๋ถ๋ณ(LTI) ๋ชจ๋ธ๋ก ๊ทผ์ฌ ๊ฐ๋ฅ: $$ \dot u = a_u u + b_u \tau_u + w_u $$ $w_u$๋ ์ ํ ๋ฐฉํฅ ์ธ๋(์ ์ฒด ์ ํญ ์ค์ฐจ).
- Sway-yaw ์๋ธ์์คํ โ ํก์ $v$์ ์์ฐ์จ $r$์ ์ ์ง ์๋ $u$์ ๊ฐํ๊ฒ ์์กดํ๋ฏ๋ก ์ ํ ํ๋ผ๋ฏธํฐ ๋ณํ(LPV) ๋ชจ๋ธ๋ก ํํ: $$ \begin{bmatrix}\dot v\\\dot r\end{bmatrix} = A(u)\begin{bmatrix}v\\r\end{bmatrix} + B(u)\tau_r + w_{vr} $$ ์ฌ๊ธฐ์ $u$๋ ์ค์ผ์ค๋ง ํ๋ผ๋ฏธํฐ๋ก ์ทจ๊ธํฉ๋๋ค. ์ฆ "ํ์ฌ ์ ์ง ์๋ $u$"๋ฅผ ์๋ฉด LPV๋ ์๊ฐ์ ์ผ๋ก ์ ํ ์์คํ ๊ณผ ๊ฐ์ด ๋ค๋ฃฐ ์ ์์ต๋๋ค.
์ด ๋ถํด ๋๋ถ์ ๋ ๊ฐ์ ์์ ์ ํ Tube MPC๊ฐ ์ข ์ ๊ตฌ์กฐ(cascade)๋ก ์ฐ๊ฒฐ๋ฉ๋๋ค: ๋จผ์ surge Tube MPC๊ฐ $u$๋ฅผ ๊ฒฐ์ โ ์ด $u$๊ฐ sway-yaw LPV์ ํ๋ผ๋ฏธํฐ๋ก ์ ๋ฌ โ sway-yaw Tube MPC๊ฐ ๋ฌ๋ ์ ๋ ฅ์ ๊ฒฐ์ .
5. RPI ์งํฉ ์คํ๋ผ์ธ ๊ณ์ฐ
๊ฐ ์๋ธ์์คํ ๋ง๋ค ์ค์ฐจ ๋์ญํ $e_{k+1} = (A - BK)e_k + w_k$์ด ์ ์๋๊ณ , ์ฌ๊ธฐ์์ mRPI ์งํฉ์ ์คํ๋ผ์ธ์ผ๋ก ๊ณ์ฐํฉ๋๋ค. ๊ตฌ์ฒด์ ์ ์ฐจ:
- ์ธ๋ ์งํฉ $\mathcal{W}$๋ฅผ ๋ฐ์ค๋ก ์ ์ (๋ฐ๋ยท์กฐ๋ฅ ์ต๋ ํฌ๊ธฐ).
- LQR ๋ฑ์ผ๋ก feedback gain $K$ ์ค๊ณ (์ค์ฐจ ๋์ญํ์ด ์์ ํ๋๋ก).
- $\mathcal{S}_{k+1} = (A-BK)\mathcal{S}_k \oplus \mathcal{W}$๋ฅผ ๋ฐ๋ณต ๊ณ์ฐํด ์๋ ดํ ๋๊น์ง Minkowski ํฉ.
- ์๋ ดํ ์งํฉ $\mathcal{S}_\infty$๊ฐ ๊ณง mRPI.
LPV ์๋ธ์์คํ ์์๋ $A(u), B(u)$๊ฐ $u$์ ๋ฐ๋ผ ๋ณํ๋ฏ๋ก, ์ ์๋ค์ $u$๊ฐ ๊ฐ์ง ์ ์๋ ๋ชจ๋ ๋ฒ์๋ฅผ ์ด์ฐํํด ๊ฐ ๊ฒฝ์ฐ๋ง๋ค ๋ณ๋ RPI๋ฅผ ๊ณ์ฐํ๊ณ ์ต์ ์ ๊ฒฝ์ฐ๋ฅผ ๋ฎ๋ ์ธํฌ ํ๋ธ๋ฅผ ๋ง๋ญ๋๋ค. ์ด ๋ถ๋ถ์ด LPV-Tube MPC์ ๊ธฐ์ ์ ๋์ ์ด์ ๊ธฐ์ฌ.
6. ์ค์๊ฐ ์คํ๊ณผ ์์ ์์ญ
๋ฐํ์์๋ ๋งค ์ํ ์์ ์ ๋ ๊ฐ์ QP๊ฐ ์์ฐจ๋ก ํ๋ฆฝ๋๋ค:
- surge QP: ํ์ฌ $u$๋ฅผ ์ธก์ โ ๋ชฉํ ์๋ ํ๋กํ์ผ๋ก ์๋ ด์ํค๋ $\tau_u$ ๊ณ์ฐ.
- sway-yaw QP: ๋ฐฉ๊ธ ๊ฒฐ์ ๋ $u$๋ก LPV๋ฅผ ๊ณ ์ โ ๋ถ๋๊น์ง ์ ๊ทผํ๋ฉด์ ์์นยท๋ฐฉ์ ์ ์ฝ์ ๋ง์กฑํ๋ $\tau_r$ ๊ณ์ฐ.
์ ์๋ค์ ์ ๋ฐ ์ฃผ๋ณ์ ์ฌ์ ์ ์๋ ๋ถ๋ฆฌ ์์ญ(separation area)์ ๋๊ณ , mRPI๋ฅผ ํฌํจํ ํ์ฅ๋ ์์ ์์ญ์ ๋น๊ฒจ์ง ์ ์ฝ์ผ๋ก ์ฌ์ฉํฉ๋๋ค. ์ด๋ ๊ฒ ํ๋ฉด ์ค์ ์ ๋ฐ ๋ชธ์ฒด๊ฐ ๋ถ๋ฆฌ ์์ญ์ ์ ๋ ์นจ๋ฒํ์ง ์์์ ์ฌ๊ท ์คํ๊ฐ๋ฅ์ฑ๊ณผ ํจ๊ป ์ํ์ ์ผ๋ก ์ฆ๋ช ํ ์ ์์ต๋๋ค.
๐ฎ ์ธํฐ๋ํฐ๋ธ: ์ ์ ์ ๊ทผ ์๋ฎฌ๋ ์ด์
์ ๋ฐ(ํ๋)์ด ๋ถ๋(์ฃผํฉ ์ฌ๊ฐํ) ์์ผ๋ก ์ ๊ทผํฉ๋๋ค. ์ธ๋ ํฌ๊ธฐ๋ฅผ ํค์ฐ๋ฉด ์์ ์ฌ์ (์ด๋ก ๋ง)๊ฐ ์๋์ผ๋ก ์ปค์ง๋ ๋ชจ์ต์ ํ์ธํ์ธ์. ๋ฆฌ์ ์ผ๋ก ๋ค์ ์์ํฉ๋๋ค.
7. ์๋ฎฌ๋ ์ด์ ๊ฒฐ๊ณผ
์ ์๋ค์ ์ธ๋์ด ์๋ ๊ฒฝ์ฐ(๋ช ๋ชฉ MPC)์ ์ธ๋์ด ์๋ ๊ฒฝ์ฐ(Tube MPC)๋ฅผ ๋น๊ตํ์ต๋๋ค. ์ฃผ์ ๊ฒฐ๊ณผ:
- ๋ช ๋ชฉ MPC๋ ์ธ๋์ด ์ฃผ์ด์ง ์๊ฐ ๋ถ๋ฆฌ ์์ญ์ ์นจ๋ฒ (์ต๋ 0.8 m ์นจ๋ฒ).
- Cascade Tube MPC๋ ์ธ๋ ํฌ๊ธฐ์ ์๊ด์์ด ํ ๋ฒ๋ ๋ถ๋ฆฌ ์์ญ์ ์นจ๋ฒํ์ง ์์.
- ์ ์ ์ฑ๊ณต๋ฅ : ๋ช ๋ชฉ 40%, Tube 100%.
- ๊ณ์ฐ ์๊ฐ: ๋ QP๋ฅผ ํฉ์ณ ์ฝ 15 ms (10 Hz ์ค์๊ฐ ๊ฐ๋ฅ).
8. ๊ฐ์ ์ฐ๊ฒฐ ์์ฝ
| ๋ ผ๋ฌธ ํํธ | ๊ด๋ จ ๊ฐ์ |
|---|---|
| ์ ๋ฐ ๋์ญํ, LTI/LPV ๋ถํด | L2 ๋์ญํ ยท L3 ์ํ๊ณต๊ฐ |
| LQR ์ค์ฐจ ํผ๋๋ฐฑ ์ค๊ณ | L11 ยง11 LQR |
| ๋ช ๋ชฉ MPC ์ ์ํ์ ํ๊ณ | L11 MPC |
| Tube MPC, mRPI, ๋น๊ฒจ์ง ์ ์ฝ | L12 Tube MPC |
| ์ฌ๊ท ์คํ๊ฐ๋ฅ์ฑ ์ฆ๋ช ํ | L12 ยง1โ2 ์์ ์ฑ |
๐ ์๋ฌธ๊ณผ ๊ด๋ จ ์๋ฃ
- C. Lee, Q. V. Tran, J. Kim, "Safety-Guaranteed Ship Berthing Using Cascade Tube-Based Model Predictive Control", IEEE Trans. Control Systems Technology, vol. 32, no. 4, pp. 1504โ1511, Jul 2024. DOI
- Mayne, Seron, Rakoviฤ, "Robust model predictive control of constrained linear systems with bounded disturbances", Automatica, 2005 โ Tube MPC ์๋ ผ๋ฌธ.
- Rakoviฤ, Kerrigan, Kouramas, Mayne, "Invariant approximations of the minimal robust positively invariant set", IEEE TAC, 2005 โ mRPI ์์น ๊ณ์ฐ ๋ฐฉ๋ฒ.
- Hu & Ding, "Tube-based robust MPC for linear parameter varying systems with bounded disturbances", IEEE TAC, 2015 โ LPV Tube MPC์ ์ด๋ก ๊ธฐ๋ฐ.