TC-CBF 2025 — 비홀로노믹 차량을 위한 회전원 기반 제어 장벽 함수
C. Lee, K. Park, J. Kim, 2025 (arXiv:2503.20280). 유니사이클과 자율 수상선(ASV)에서 실제 실험으로 검증.
목차
- 문제 제기 — 비홀로노믹 차량과 CBF의 불협화음
- 배경: CBF 복습 (L8과 연결)
- 기존 ED-CBF의 한계
- 핵심 아이디어 — 회전 원까지의 거리
- TC-CBF의 수식
- MPC와의 결합
- 실험 결과
- 강의 연결 요약
1. 문제 제기
유니사이클·자동차·선박 같은 차량은 비홀로노믹 제약이 있습니다. 즉, 어느 방향이든 즉시 움직일 수 있는 게 아니라 "현재 바라보는 방향"으로만 진행하고, 방향을 바꾸려면 유한한 회전 반경이 필요합니다. 이 때문에 "장애물이 10 m 앞에 있다"와 "장애물이 옆에 붙어 있다"는 동일한 거리라도 완전히 다른 회피 난이도를 가집니다.
하지만 표준 CBF는 이 차이를 모릅니다. 그래서 기존 연구들은 "안전 마진을 넉넉히 두고, 회피를 급하게 시키면 된다"로 넘어갔는데, 이는 다음 문제를 만듭니다:
- 필요 이상으로 속도를 줄임 (효율 저하)
- 비현실적 회전율 요구 → 포화(saturation) → 실현불가능(infeasibility)
- 해양 환경처럼 관성이 큰 시스템은 아예 대응 불가
2. 배경 — CBF 복습 (L8과 연결)
CBF는 "안전한 상태 집합" $\mathcal{S} = \{x : h(x) \ge 0\}$을 정의하고, 그 집합을 벗어나지 않는 제어 입력만 허용하는 필터입니다. 핵심 조건(연속시간):
$$ \dot h(x, u) + \alpha(h(x)) \ge 0 $$여기서 $\alpha$는 class-K 함수 (가장 흔한 선택: $\alpha(h) = \gamma h$). 이 조건을 만족하면 forward invariance가 성립 — 초기에 안전하면 영원히 안전.
이 조건은 MPC에 녹일 수 있고, 매 스텝 QP/NLP로 처리됩니다. 자세한 내용은 L8 유도 & CBF와 L12 §12 MPC+CBF에서 다뤘습니다.
3. 기존 ED-CBF의 한계
가장 많이 쓰이는 CBF 형태는 유클리드 거리 기반(Euclidean Distance CBF, ED-CBF)입니다:
$$ h_\text{ED}(x) = \|p - p_\text{obs}\|^2 - (r_\text{safe})^2 $$여기서 $p$는 차량 위치, $p_\text{obs}$는 장애물 중심. 문제는 이 $h$의 그래디언트가 "장애물에서 직선으로 멀어지는 방향"을 가리키지만, 비홀로노믹 차량은 그 방향으로 즉시 움직일 수 없다는 것입니다. 따라서 CBF가 요구하는 $\dot h$를 달성하려면 매우 빠른 회전이 필요하고, 결국 모터 포화 또는 해 없음.
🎮 인터랙티브: ED-CBF가 비홀로노믹 차량에 주는 과도한 요구
차량(파랑)이 전진하면서 장애물(빨강) 근처를 지나갑니다. 회전율 한계를 작게 설정할수록, ED-CBF는 실현 불가능한 회피를 요구해 차량이 "갇혀" 멈추는 현상을 볼 수 있습니다.
4. 핵심 아이디어 — 회전 원까지의 거리
본 논문의 통찰은 "차량이 장애물을 피하려면 결국 회전 원(turning circle)을 돌아서 나가야 한다"는 기하학적 관찰입니다. 회전 원이란 주어진 속도 $v$와 최대 회전율 $r_\text{max}$로 정상회전했을 때 차량이 그리는 원으로, 반경은 $R = v/r_\text{max}$. 왼쪽 회전과 오른쪽 회전 각각 하나씩이므로 총 두 개의 원.
따라서 "회피가 실현 가능한가?"의 진짜 기준은 "장애물이 두 회전 원 중 적어도 하나의 바깥에 있는가?"입니다. 이 관찰을 그대로 CBF의 $h$로 사용합니다:
$$ h_\text{TC}(x) = \max\bigl(d_L(x)^2 - (R+r)^2,\; d_R(x)^2 - (R+r)^2\bigr) $$여기서 $d_L, d_R$은 장애물에서 왼쪽·오른쪽 회전 원 중심까지 거리, $R$은 회전 반경, $r$은 장애물 반경 + 안전 여유.
🎮 인터랙티브: 회전 원과 장애물의 관계
차량(파랑) 왼쪽·오른쪽에 회전 원 두 개가 그려집니다. 장애물(빨강) 위치를 마우스로 옮겨, 언제 "왼쪽으로 회피 가능", "오른쪽으로 회피 가능", "둘 다 불가능"이 되는지 보세요.
5. TC-CBF의 이산시간 MPC 제약 형태
MPC에 넣기 위해 이산시간으로 변환하면:
$$ h_\text{TC}(x_{k+1}) - (1 - \gamma)\,h_\text{TC}(x_k) \ge 0, \quad \gamma \in (0, 1] $$이 부등식이 MPC의 각 스텝 $k = 0, \dots, N-1$에 제약으로 추가됩니다. $\gamma$가 작을수록 보수적(일찍 회피), 크면 공격적(늦게 회피). 기존 ED-CBF와 달리, 회전 반경을 이미 고려했기 때문에 $\gamma$를 크게 해도 실현가능성이 유지됩니다.
6. MPC와의 결합
논문이 사용한 MPC는 단순한 이차 비용 + TC-CBF 제약:
$$ \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), \quad u_k \in \mathcal{U}, \quad h_\text{TC}(x_{k+1}) \ge (1-\gamma) h_\text{TC}(x_k) $$이 구조는 L12 §12 MPC+CBF에서 일반적 틀로 다루었던 결합과 정확히 같습니다. 유일한 차이는 $h$의 정의.
7. 실험 결과
- 유니사이클 시뮬레이션: ED-CBF는 정해진 궤적에서 장애물을 돌지 못하고 멈춤. TC-CBF는 자연스럽게 돌아 진행. 평균 속도 유지율 ED-CBF 40% vs TC-CBF 85%.
- ASV 실험: 실제 자율 수상선으로 정적·동적 장애물 회피 테스트. TC-CBF가 궤적 길이에서 22% 짧고, 제어 입력 진동이 현저히 적음.
- MPC 계산 시간: ED-CBF와 거의 동일(제약 개수만 2배). 실시간 10 Hz로 충분히 동작.
8. 강의 연결 요약
| 논문 파트 | 관련 강의 |
|---|---|
| 비홀로노믹 운동학, 회전 반경 | L2 동역학 |
| Dubins 곡선 (회전+직선 최단경로) | L6 §7 Dubins |
| CBF forward invariance | L8 CBF |
| 이산 CBF와 MPC 결합 | L12 §12 MPC+CBF |
| 비선형 MPC 풀이 | L11 MPC |
📖 원문과 관련 자료
- C. Lee, K. Park, J. Kim, "Turning Circle-based Control Barrier Function for Efficient Collision Avoidance of Nonholonomic Vehicles", 2025, arXiv:2503.20280.
- Ames, Xu, Grizzle, Tabuada, "Control Barrier Function Based Quadratic Programs for Safety Critical Systems", IEEE TAC, 2017 — CBF의 표준 정식화.
- Zeng, Zhang, Sreenath, "Safety-critical Model Predictive Control with Discrete-time Control Barrier Function", ACC, 2021 — 이산 CBF와 MPC 결합 원논문.
- Dubins, L. E., "On curves of minimal length with a constraint on average curvature", Amer. J. Math., 1957 — 회전 원 개념의 원점.