MECH 2025 โ COLREGs ์ค์ TC-CBF ํด์ ์ถฉ๋ ํํผ
C. Lee, J. Park, J. Kim, 2025 (arXiv:2504.19247). TC-CBF๋ฅผ ๊ตญ์ ํด์ ์ถฉ๋ ์๋ฐฉ ๊ท์น(COLREGs)๊น์ง ํ์ฅํ ํ์ ์ฐ๊ตฌ.
๋ชฉ์ฐจ
- COLREGs๋?
- ์กฐ์ฐ ์ํฉ์ 3๋ถ๋ฅ
- ๊ธฐ์กด ๋ฐฉ๋ฒ์ ํ๊ณ
- ํต์ฌ ์์ด๋์ด โ ํ์ ์ ์ ํ ๊ท์น
- TC-CBF์ COLREGs ํ์ฅ ์์
- MPC ํตํฉ
- ์๋ฎฌ๋ ์ด์ ๊ฒฐ๊ณผ
- ๊ฐ์ ์ฐ๊ฒฐ ์์ฝ
1. COLREGs โ ํด์์ ๊ตํต ๋ฒ๊ท
COLREGs(International Regulations for Preventing Collisions at Sea, 1972)๋ ๋ฐ๋ค์์ ์ ๋ฐ์ด ์๋ก ์ถฉ๋ํ์ง ์๊ธฐ ์ํด ์ง์ผ์ผ ํ ๊ตญ์ ๊ท์ ์ ๋๋ค. ์๋์ฐจ์ ๋๋ก๊ตํต๋ฒ๊ณผ ๋น์ทํ ๊ฐ๋ ์ผ๋ก, ํนํ "๋๊ฐ ์ด๋ป๊ฒ ํผํด์ผ ํ๋๊ฐ"๋ฅผ ๋ช ์ํฉ๋๋ค. ์์จ ์ ๋ฐ์ด ์ค์ ๋ฐ๋ค์ ๋๊ฐ๋ ค๋ฉด ์ด ๊ท์ ์ ๋ฐ๋์ ๋ฐ๋ผ์ผ ํฉ๋๋ค โ ๋จ์ํ ํผํ๊ธฐ๋ง ํด์๋ ๋ค๋ฅธ ์ ์ฅ์ด ์์ธกํ ์ ์์ด ํผ๋๊ณผ ์ฌ๊ณ ๋ฅผ ์ด๋ํฉ๋๋ค.
ํต์ฌ ๊ท์น์ Rule 13~17์ ์ ์๋ ์ธ ๊ฐ์ง ์กฐ์ฐ ์ํฉ๋ณ ์๋ฌด์ ๋๋ค:
2. ์กฐ์ฐ ์ํฉ์ 3๋ถ๋ฅ
| ๊ท์น | ์ํฉ | ๋์ ์๋ฌด |
|---|---|---|
| Rule 14 ์ ๋ฉด ์กฐ์ฐ (Head-on) | ๋ ๋ฐฐ๊ฐ ์๋ก ๋ง์ฃผ๋ณด๊ณ ์ ๊ทผ | ์๋ก ์ฐํ(์ค๋ฅธ์ชฝ)์ผ๋ก ๋ณ์นจํด ์ขํ๋ผ๋ฆฌ ํต๊ณผ |
| Rule 15 ํก๋จ (Crossing) | ํ ๋ฐฐ๊ฐ ๋ค๋ฅธ ๋ฐฐ์ ์ฐํ ์ชฝ์์ ์ ๊ทผ | ์ฐํ์์ ์ค๋ ๋ฐฐ๊ฐ ํผ๊ธ ์๋ฌด(give-way), ํต์ ์ฐํ ๋ณ์นจ |
| Rule 13 ์ถ์ (Overtaking) | ๋ค์์ ๋ ๋น ๋ฅธ ๋ฐฐ๊ฐ ๋ฐ๋ผ์ก์ | ์ถ์ํ๋ ๋ฐฐ๊ฐ ํผ๊ธ ์๋ฌด, ์ข์ฐ ์ด๋ ์ชฝ์ด๋ ๊ฐ๋ฅ |
์ฆ ์ผ๋ฐ์ ์ผ๋ก๋ "์ฐํ์ผ๋ก ํผํด๋ผ"๊ฐ ๋์์น์ด์ง๋ง, ์ถ์ ๊ฐ์ ์์ธ๋ ์์ต๋๋ค. ์์จ ์์คํ ์ ์๋ ์ ๋ฐ๊ณผ์ ์๋ ์์นยท๋ฐฉ์๊ฐยท์๋๋ฅผ ๋ณด๊ณ ์์ ์ด ์ด๋ค ์ํฉ์ ๋์๋์ง ๋จผ์ ํ๋จํ ๋ค, ํด๋น ๊ท์น์ด ์๊ตฌํ๋ ๋ฐฉํฅ์ผ๋ก ํํผํด์ผ ํฉ๋๋ค.
3. ๊ธฐ์กด ๋ฐฉ๋ฒ์ ํ๊ณ
์ด์ ์ฐ๊ตฌ๋ค์ ์ฃผ๋ก Velocity Obstacle (VO)์ด๋ ์ ํด๋ฆฌ๋ CBF๋ฅผ COLREGs์ ํฉ์น๋ ค ํ์ต๋๋ค. ๊ทธ๋ฌ๋ ๋ ์ ๊ทผ ๋ชจ๋ ๋ค์ ๋ฌธ์ ๋ฅผ ๊ฐ์ต๋๋ค:
- VO: ์๋ ๊ณต๊ฐ์์ "์ถฉ๋์ ์ผ์ผํค๋ ์๋ ์งํฉ"์ ์ ์ํ๊ณ ๊ทธ ๋ฐ์ผ๋ก ๋๊ฐ๋๋ก ํจ. COLREGs๋ฅผ "๊ธ์ง ์์ญ ์ถ๊ฐ"๋ก ๊ฐ๋จํ ๋ถ์ผ ์ ์์ง๋ง, ์๋ ๊ณต๊ฐ ๊ธฐ๋ฐ์ด๋ผ ํ์ ํ๊ณ๋ฅผ ๋ฐ์ํ์ง ๋ชปํจ. ๊ฒฐ๊ณผ์ ์ผ๋ก ์คํ ๋ถ๊ฐ๋ฅํ ๋ช ๋ น.
- ์ ํด๋ฆฌ๋ CBF: ๋นํ๋ก๋ ธ๋ฏน ํ๊ณ๋ฅผ ๊ณ ๋ ค ๋ชปํจ (TCST2์์ ์ด๋ฏธ ๋ค๋ฃฌ ๋ฌธ์ ). ๊ฒ๋ค๊ฐ ํํผ ๋ฐฉํฅ์ ๋ช ์์ ์ผ๋ก ์ ์ดํ์ง ๋ชปํด COLREGs๋ฅผ ๋ฐ๋ผ๊ฐ๊ธฐ ์ด๋ ค์.
4. ํต์ฌ ์์ด๋์ด โ ํ์ ์ ์ ํ ๊ท์น
๋ณธ ๋ ผ๋ฌธ์ ํต์ฐฐ์ ๊ฐ๋จํฉ๋๋ค: TC-CBF๋ ์ด๋ฏธ ๋ ๊ฐ์ ํ์ ์(์ผ์ชฝ/์ค๋ฅธ์ชฝ)์ ์ฌ์ฉํด "์ด๋ ๋ฐฉํฅ์ผ๋ก ํํผํ ์ง"๋ฅผ ์์ฐ์ค๋ฝ๊ฒ ๋ด์ฅํฉ๋๋ค. ์ฌ๊ธฐ์ COLREGs ์๋ฌด๋ฅผ ๋ฐ์ํ๋ ค๋ฉด ๋จ์ํ ๋ ์ ์ค ์ด๋ ๊ฒ์ ์ด๋ฆด์ง๋ฅผ ๊ท์น์ ๋ฐ๋ผ ์ ํํ๋ฉด ๋ฉ๋๋ค:
- ์ ๋ฉด/ํก๋จ โ ์ฐํ(์ค๋ฅธ์ชฝ) ํํผ โ ์ค๋ฅธ์ชฝ ํ์ ์๋ง ์ฌ์ฉ
- ์ถ์ โ ์์ชฝ ํ์ ์ ๋ชจ๋ ์ฌ์ฉ (์๋ TC-CBF์ ๋์ผ)
์ด ์ ํ์ ๋จ์ํ ๋ ผ๋ฆฌ ์กฐ๊ฑด์ผ๋ก ๊ตฌํ๋ฉ๋๋ค โ ์ถ๊ฐ ๊ณ์ฐ ๋ถ๋ด์ด ๊ฑฐ์ ์์ด ์๋ TC-CBF์ ํจ์จ์ฑ์ ๊ทธ๋๋ก ์ ์งํฉ๋๋ค.
๐ฎ ์ธํฐ๋ํฐ๋ธ: ์กฐ์ฐ ์ํฉ๋ณ ์๋ฌด ํํผ ๋ฐฉํฅ
์๋ ์ ๋ฐ(๋นจ๊ฐ)์ ์ ๊ทผ ๊ฐ๋๋ฅผ ์ฌ๋ผ์ด๋๋ก ๋ฐ๊พธ๋ฉด, ๊ทธ ๊ฐ๋์์ COLREGs๊ฐ ๋ถ๋ฅํ๋ ์ํฉ(์ ๋ฉด/ํก๋จ/์ถ์)๊ณผ TC-CBF๊ฐ ์ ํํ ํ์ ์์ด ์๋์ผ๋ก ๋ฐ๋๋๋ค.
5. TC-CBF์ COLREGs ํ์ฅ ์์
์ผ๋ฐ TC-CBF๋ ์ผ์ชฝยท์ค๋ฅธ์ชฝ ํ์ ์ ๋ชจ๋ ๊ณ ๋ ค:
$$ h_\text{TC}(x) = \max\bigl(h_L(x),\; h_R(x)\bigr) $$COLREGs ํ์ฅ์์๋ ์ํฉ์ ๋ฐ๋ผ ํ์ชฝ์ "๊ฐ์ ๋นํ์ฑํ"ํฉ๋๋ค:
$$ h_\text{COLREGs}(x) = \begin{cases} h_R(x) & \text{์ ๋ฉดยทํก๋จ (์ฐํ ๋ณ์นจ ์๋ฌด)}\\ h_L(x) & \text{์ขํ ๋ณ์นจ ๊ท์น ์์ธ}\\ \max(h_L, h_R) & \text{์ถ์ยทstand-on} \end{cases} $$์ด๋ ๊ฒ ํ๋ฉด "๊ฐ๋ฅํ ํํผ ์ค ๊ท์น์ ๋ง๋ ๊ฒ๋ง ์ ํ"์ด ์์ฐ์ค๋ฝ๊ฒ ๊ฐ์ ๋ฉ๋๋ค.
6. MPC ํตํฉ
MPC ์ ์ํ๋ TC-CBF์ ๊ฑฐ์ ๋์ผํ๋, CBF๋ง ์ $h_\text{COLREGs}$๋ก ๊ต์ฒดํฉ๋๋ค:
$$ \min \sum_{k=0}^{N-1} \|x_k - x_k^\text{ref}\|_Q^2 + \|u_k\|_R^2 $$ $$ \text{s.t.}\;\; x_{k+1} = f(x_k, u_k),\;\; u_k \in \mathcal{U},\;\; h_\text{COLREGs}(x_{k+1}) \ge (1-\gamma)\,h_\text{COLREGs}(x_k) $$์๋ ์ ๋ฐ์ ๊ด์ธก๋ ์๋๋ก ์์ ์๋ ์์ธก์ด ์ฌ์ฉ๋๋ฉฐ, ๋งค ์ํ ์์ ์ ๋ค์ ์ ๋ฐ์ดํธ๋ฉ๋๋ค. ์ด ๋ถ๋ถ์ L4 ์นผ๋ง ํํฐ์์ ๋ค๋ฃฌ ์ํ ์ถ์ ๊ณผ ๋ฐ๋ก ์ฐ๊ฒฐ๋ฉ๋๋ค.
7. ์๋ฎฌ๋ ์ด์ ๊ฒฐ๊ณผ
- ์ ๋ฉด ์กฐ์ฐ์์ ๊ธฐ์กด ED-CBF๋ ์์ชฝ ์ด๋ ๋ฐฉํฅ์ผ๋ก๋ ํผํจ(๊ท์น ์๋ฐ ๊ฐ๋ฅ). ์ ์ ๋ฐฉ๋ฒ์ ํญ์ ์ฐํ์ผ๋ก ํผํจ(๊ท์น ์ค์).
- ํก๋จ ์ํฉ์์ ED-CBF๋ ๊ณผ๋ํ ์๋ ๊ฐ์ ๋ฐ์. TC-CBF ๊ธฐ๋ฐ ์ ์ ๋ฐฉ๋ฒ์ ์๋ ์ ์ง์จ 80%.
- ๋ค์ ์ ๋ฐ(3์ฒ) ๋์ ์กฐ์ฐ์์๋ ๊ฐ ์๋์ ๋ํ ๊ฐ๋ณ CBF ์ ์ฝ์ผ๋ก ํ์ฅ ๊ฐ๋ฅ.
- ๊ณ์ฐ ์๊ฐ์ ์๋ TC-CBF ๋๋น 1.02๋ฐฐ (๊ท์น ํ์ ์ ๋๋ ์ถ๊ฐ ๋น์ฉ์ด ๊ทน๋ฏธํจ).
8. ๊ฐ์ ์ฐ๊ฒฐ ์์ฝ
| ๋ ผ๋ฌธ ํํธ | ๊ด๋ จ ๊ฐ์ |
|---|---|
| ์ ๋ฐ ์ด๋ํ๊ณผ ํ์ ์ | L2 ๋์ญํ |
| ์๋ ์ ๋ฐ ์ํ ์์ธก | L4 ์นผ๋ง ํํฐ |
| ์ ์ญ/์ง์ญ ๊ฒฝ๋ก์ ์ญํ | L6 ๊ฒฝ๋ก ๊ณํ |
| CBF forward invariance | L8 ์ ๋ & CBF |
| TC-CBF (์ด์ ๋ ผ๋ฌธ) | TC-CBF 2025 |
| MPC+CBF ๊ฒฐํฉ | L12 ยง12 MPC+CBF |
๐ ์๋ฌธ๊ณผ ๊ด๋ จ ์๋ฃ
- C. Lee, J. Park, J. Kim, "Efficient COLREGs-Compliant Collision Avoidance using Turning Circle-based Control Barrier Function", 2025, arXiv:2504.19247.
- IMO, "Convention on the International Regulations for Preventing Collisions at Sea (COLREGs)", 1972 (๊ฐ์ 2009) โ ์ ๊ท์ ๋ฌธ์.
- Fiorini & Shiller, "Motion planning in dynamic environments using velocity obstacles", Int. J. Robotics Research, 1998 โ Velocity Obstacle์ ์๋ ผ๋ฌธ.
- Kuwata et al., "Safe Maritime Autonomous Navigation With COLREGS, Using Velocity Obstacles", IEEE J. Oceanic Engineering, 2014 โ COLREGs+VO์ ๋ํ ์ ํ ์ฐ๊ตฌ.
- ๋ณธ ์ฐ๊ตฌ์ค TC-CBF 2025 โ ๋ณธ ๋ ผ๋ฌธ์ ์ง์ ์ ์ธ ๊ธฐ๋ฐ.