โ† ์—ฐ๊ตฌ ์†Œ๊ฐœ

MECH 2025 โ€” COLREGs ์ค€์ˆ˜ TC-CBF ํ•ด์ƒ ์ถฉ๋Œ ํšŒํ”ผ

C. Lee, J. Park, J. Kim, 2025 (arXiv:2504.19247). TC-CBF๋ฅผ ๊ตญ์ œ ํ•ด์ƒ ์ถฉ๋Œ ์˜ˆ๋ฐฉ ๊ทœ์น™(COLREGs)๊นŒ์ง€ ํ™•์žฅํ•œ ํ›„์† ์—ฐ๊ตฌ.

ํ•œ ์ค„ ์š”์•ฝ โ€” ์ž์œจ ์„ ๋ฐ•์ด ๋‹ค๋ฅธ ๋ฐฐ์™€ ์กฐ์šฐํ•  ๋•Œ๋Š” ๋‹จ์ˆœํžˆ ๋ถ€๋”ชํžˆ์ง€ ์•Š๋Š” ๊ฒƒ๋งŒ์œผ๋ก  ๋ถ€์กฑํ•ฉ๋‹ˆ๋‹ค. ์„ ์›๋“ค ์‚ฌ์ด์— ์•ฝ์†๋œ ํšŒํ”ผ ๋ฐฉํ–ฅ(COLREGs ๊ทœ์น™)์„ ๋”ฐ๋ผ์•ผ ํ•ฉ๋‹ˆ๋‹ค. ๋ณธ ๋…ผ๋ฌธ์€ TC-CBF์— COLREGs ์˜๋ฌด ๋ฐฉํ–ฅ์„ ์ž๋™์œผ๋กœ ๋ฐ˜์˜ํ•ด, ๊ทœ์น™์„ ์ง€ํ‚ค๋ฉด์„œ๋„ ์—ฌ์ „ํžˆ ๊ณ„์‚ฐ ํšจ์œจ์ด ๋†’์€ ํ•ด์ƒ์šฉ CBF๋ฅผ ์ œ์•ˆํ•ฉ๋‹ˆ๋‹ค.

๋ชฉ์ฐจ

  1. COLREGs๋ž€?
  2. ์กฐ์šฐ ์ƒํ™ฉ์˜ 3๋ถ„๋ฅ˜
  3. ๊ธฐ์กด ๋ฐฉ๋ฒ•์˜ ํ•œ๊ณ„
  4. ํ•ต์‹ฌ ์•„์ด๋””์–ด โ€” ํšŒ์ „ ์› ์„ ํƒ ๊ทœ์น™
  5. TC-CBF์˜ COLREGs ํ™•์žฅ ์ˆ˜์‹
  6. MPC ํ†ตํ•ฉ
  7. ์‹œ๋ฎฌ๋ ˆ์ด์…˜ ๊ฒฐ๊ณผ
  8. ๊ฐ•์˜ ์—ฐ๊ฒฐ ์š”์•ฝ

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)๋’ค์—์„œ ๋” ๋น ๋ฅธ ๋ฐฐ๊ฐ€ ๋”ฐ๋ผ์žก์Œ์ถ”์›”ํ•˜๋Š” ๋ฐฐ๊ฐ€ ํ”ผ๊ธ‰ ์˜๋ฌด, ์ขŒ์šฐ ์–ด๋А ์ชฝ์ด๋“  ๊ฐ€๋Šฅ

์ฆ‰ ์ผ๋ฐ˜์ ์œผ๋กœ๋Š” "์šฐํ˜„์œผ๋กœ ํ”ผํ•ด๋ผ"๊ฐ€ ๋Œ€์›์น™์ด์ง€๋งŒ, ์ถ”์›” ๊ฐ™์€ ์˜ˆ์™ธ๋„ ์žˆ์Šต๋‹ˆ๋‹ค. ์ž์œจ ์‹œ์Šคํ…œ์€ ์ƒ๋Œ€ ์„ ๋ฐ•๊ณผ์˜ ์ƒ๋Œ€ ์œ„์น˜ยท๋ฐฉ์œ„๊ฐยท์†๋„๋ฅผ ๋ณด๊ณ  ์ž์‹ ์ด ์–ด๋–ค ์ƒํ™ฉ์— ๋†“์˜€๋Š”์ง€ ๋จผ์ € ํŒ๋‹จํ•œ ๋’ค, ํ•ด๋‹น ๊ทœ์น™์ด ์š”๊ตฌํ•˜๋Š” ๋ฐฉํ–ฅ์œผ๋กœ ํšŒํ”ผํ•ด์•ผ ํ•ฉ๋‹ˆ๋‹ค.

Rule 14 ์ •๋ฉด โ†’ ์šฐํ˜„(์˜ค๋ฅธ์ชฝ)์œผ๋กœ ํ”ผํ•จ Rule 15 ํšก๋‹จ โ†’ ์šฐํ˜„์œผ๋กœ ํ”ผํ•จ (give-way) Rule 13 ์ถ”์›” โ†’ ์ขŒ์šฐ ์„ ํƒ ๊ฐ€๋Šฅ
๊ทธ๋ฆผ. COLREGs 3๋Œ€ ์กฐ์šฐ ์ƒํ™ฉ. ํŒŒ๋ž€์ƒ‰์ด ๋‚˜์˜ ์„ ๋ฐ•, ๋นจ๊ฐ„์ƒ‰์ด ์ƒ๋Œ€. ์ดˆ๋ก ํ™”์‚ดํ‘œ๊ฐ€ ๋‚ด๊ฐ€ ๊ฐ€์•ผ ํ•  ๋ฐฉํ–ฅ.

3. ๊ธฐ์กด ๋ฐฉ๋ฒ•์˜ ํ•œ๊ณ„

์ด์ „ ์—ฐ๊ตฌ๋“ค์€ ์ฃผ๋กœ Velocity Obstacle (VO)์ด๋‚˜ ์œ ํด๋ฆฌ๋“œ CBF๋ฅผ COLREGs์™€ ํ•ฉ์น˜๋ ค ํ–ˆ์Šต๋‹ˆ๋‹ค. ๊ทธ๋Ÿฌ๋‚˜ ๋‘ ์ ‘๊ทผ ๋ชจ๋‘ ๋‹ค์Œ ๋ฌธ์ œ๋ฅผ ๊ฐ–์Šต๋‹ˆ๋‹ค:

4. ํ•ต์‹ฌ ์•„์ด๋””์–ด โ€” ํšŒ์ „ ์› ์„ ํƒ ๊ทœ์น™

๋ณธ ๋…ผ๋ฌธ์˜ ํ†ต์ฐฐ์€ ๊ฐ„๋‹จํ•ฉ๋‹ˆ๋‹ค: TC-CBF๋Š” ์ด๋ฏธ ๋‘ ๊ฐœ์˜ ํšŒ์ „ ์›(์™ผ์ชฝ/์˜ค๋ฅธ์ชฝ)์„ ์‚ฌ์šฉํ•ด "์–ด๋А ๋ฐฉํ–ฅ์œผ๋กœ ํšŒํ”ผํ• ์ง€"๋ฅผ ์ž์—ฐ์Šค๋Ÿฝ๊ฒŒ ๋‚ด์žฅํ•ฉ๋‹ˆ๋‹ค. ์—ฌ๊ธฐ์— COLREGs ์˜๋ฌด๋ฅผ ๋ฐ˜์˜ํ•˜๋ ค๋ฉด ๋‹จ์ˆœํžˆ ๋‘ ์› ์ค‘ ์–ด๋А ๊ฒƒ์„ ์‚ด๋ฆด์ง€๋ฅผ ๊ทœ์น™์— ๋”ฐ๋ผ ์„ ํƒํ•˜๋ฉด ๋ฉ๋‹ˆ๋‹ค:

์ด ์„ ํƒ์€ ๋‹จ์ˆœํ•œ ๋…ผ๋ฆฌ ์กฐ๊ฑด์œผ๋กœ ๊ตฌํ˜„๋ฉ๋‹ˆ๋‹ค โ€” ์ถ”๊ฐ€ ๊ณ„์‚ฐ ๋ถ€๋‹ด์ด ๊ฑฐ์˜ ์—†์–ด ์›๋ž˜ 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. ์‹œ๋ฎฌ๋ ˆ์ด์…˜ ๊ฒฐ๊ณผ

8. ๊ฐ•์˜ ์—ฐ๊ฒฐ ์š”์•ฝ

๋…ผ๋ฌธ ํŒŒํŠธ๊ด€๋ จ ๊ฐ•์˜
์„ ๋ฐ• ์šด๋™ํ•™๊ณผ ํšŒ์ „ ์›L2 ๋™์—ญํ•™
์ƒ๋Œ€ ์„ ๋ฐ• ์ƒํƒœ ์˜ˆ์ธกL4 ์นผ๋งŒ ํ•„ํ„ฐ
์ „์—ญ/์ง€์—ญ ๊ฒฝ๋กœ์˜ ์—ญํ• L6 ๊ฒฝ๋กœ ๊ณ„ํš
CBF forward invarianceL8 ์œ ๋„ & CBF
TC-CBF (์ด์ „ ๋…ผ๋ฌธ)TC-CBF 2025
MPC+CBF ๊ฒฐํ•ฉL12 ยง12 MPC+CBF

๐Ÿ“– ์›๋ฌธ๊ณผ ๊ด€๋ จ ์ž๋ฃŒ