안전 제어Safe Control
제어장벽함수와 도달가능성 해석으로 궤적이 충돌 영역에 들어가지 않도록 보장
- TCST 2026Turning-circle CBF
- Mechatronics 2026COLREGs avoidance
- IFAC 2023Reachability-based berthing
안전 자율·지능연구실연구소개
무인 이동체의 안전 경로계획·제어를 연구합니다.

이론적으로 안전성을 증명할 수 있는 제어기와, 실제 로봇에서 동작하는 시스템을 함께 만듭니다.
안전 제어제어장벽함수와 도달가능성 해석으로 궤적이 충돌 영역에 들어가지 않도록 보장
모델예측제어미래 거동을 예측하는 모델예측제어로 외란 속에서도 제약을 지키며 경로 추종
이동체 자율성
선박·무인수상정과 모바일 로봇으로 운하·연안·보행자 공간에서 실험 검증



일부 자동화 및
의사결정 지원 선박
선원 승선
원격제어 선박
선원 비승선 원격제어 선박
선박 장애 예측/진단 기능
완전 무인
자율운항
좁은 수로 좌초
선박 간 충돌
항만 접안 사고안전을 보장하는 자율운항 알고리즘
Research 01 · 02
Research 03
Research 04 · 05 · 06제약을 지키면서 성능을 내는 궤적 계획·제어
좁은 수로 → 접안 → 충돌회피로 시나리오를 넓히며 제어 기법을 단계적으로 발전

NMPC with Obstacle Avoidance Constraints

Navigable Area Detection & Perception-guided MPC

Cascade Tube-based MPC for Ship Berthing

Turning Circle-based CBF (TC-CBF)

COLREGs-Compliant Avoidance with TC-CBF

Multimodal MPC-TCCBF + Imitation Learning
평균 폭 15 m 포항 운하에서 운하 벽을 선분 기반 회피 제약으로 표현하고,
현장 데이터로 식별한 선박 모델 기반 NMPC로 크루즈 보트 자율운항 실증


4321
1
2
3
4포항 운하 · 평균 폭 15 m · 길이 1 km · 드론 항공사진 ①–④
폭 ~15 m 수로 안에서 벽 · 교량 · 계류시설과 안전거리 유지
최대 조타각 · 최소/최대 RPM 한계와 비선형 동역학 → MPC
Cruise Boat · 실선 실험 플랫폼
다양한 속도의 지그재그 · 선회 기동과
가속 · 감속 데이터 수집 (드론 촬영)
검출된 직선(흰색 면)을 운하 벽으로 간주 → 선분 목록이 곧 MPC 안전 제약
카메라·LiDAR로 인지한 가항 영역을 MPC 제약으로 직접 사용하여,
GPS와 사전 웨이포인트 경로 의존도를 낮춘 좁은 수로 자율운항
카메라·LiDAR로 검출한 가항 영역과 식별된 선박 동역학을 MPC에 통합하여 안전 궤적 생성
GPS 신뢰도가 낮고, 항상 미리 정의된 웨이포인트 경로가 필요
DeepLabV3 수면 분할 → 호모그래피로 선박 좌표계 투영
3차원 점군에서 수로 벽면을 검출해 가항 영역 구성
실험 데이터로 동역학 모델 식별 → MPC 예측 모델
안전 궤적
운하 실선 실험 · 카메라·LiDAR 가항 영역을 제약으로 MPC 궤적 계획 (영상 3배속)
Baseline: LiDAR 기반 검출 + 수동 조종 주행으로 기록한 사전 웨이포인트를 추종하는 MPC
안전 제약 위반 영역 (< 7 m)
안전 제약 위반: 최근접 거리가 목표 이격 거리 7 m보다 작은 상태 · 그 시간을 전 구간에서 누적
사전 경로 없이 인지한 가항 영역을 따라 수로 경계와의 이격을 더 잘 유지
속도가 크게 변하는 접안 기동에서도 바람 외란 속 안전 제약을 보장하는
Cascade Tube MPC — surge 속도 예측으로 sway-yaw tube를 계산
입력 \(u=\bar u+K(x-\bar x)\) → 오차 \(e=x-\bar x\)를 RPI 집합 \(\mathcal Z\) 안에 유지
명목 궤적 계획에 쓰일 RPI 집합을 비선형 ASV 모델에 대해 직접 구하기 어려움


Sway-yaw 동역학이 속도 \(u\)에 의존 → 한 속도에서 선형화한 모델로는 부정확
모델을 분해해 각 단계의 불변 집합을 계산 가능하게 구성
예측된 미래 속도 프로파일로 모델을 스케줄링하여 속도 변화 반영
빗금 영역까지 불확실성으로 포함 → 과도하게 보수적인 불변 집합
속도 변화를 모델에 직접 반영 → 덜 보수적인 tube로 접안 궤적 계획
t = 55 s
t = 250 s
바람
바람
✕ 충돌
차량–장애물 거리 대신 좌·우 회전원–장애물 거리로 CBF를 정의 — 선회 한계를 반영해
짧은 예측구간으로도 감속 없이 효율적으로 회피
경로 추종과 충돌회피를 함께 푸는 MPC — 장애물 제약의 형태가 필요한 예측구간과 연산 부담을 결정
거리 제약 \(\|\mathbf{p}-\mathbf{o}\|>o_r\)은 장애물에 가까워져야 활성화
→ 예측구간이 짧으면 회피 실패, 길면 연산 부담 증가
동일 조건에서 예측구간만 달리한 거리 제약 MPC
안전 집합 \(h(\mathbf{x})\ge 0\)이 유지되도록
장애물 쪽 접근 속도를 상대 거리에 비례해 제한

기존 ED-CBF는 장애물까지의 최단 거리만 고려해, 선회로 피할 수 있는 상태까지 제한 → TC-CBF는 좌·우 회전원 중심과 장애물 사이의 거리로 안전 여유를 정의
최대 선회율 \(r_{\max}\)로 선회할 때의 회전 반경 — 속도 \(u\)에 비례
우·좌 회전원 중심 \(\mathbf{p}_{tr},\mathbf{p}_{tl}\)에서 장애물까지의 안전 여유
좌·우 중 한쪽이라도 선회로 피할 수 있으면 안전한 상태


CBF < 0 인 상태가 제한됨 (+x 방향 1.5 m/s 진행)
감속 없음
부드러운 선회추월(Overtaking) 시나리오 · 붉은 원: 이동 장애물 · 스냅샷 4초 간격 · 4배속
| 시나리오 | 제어기 | 도착 시간 \(t_a\) [s] | 속도 오차 \(e_{\mathrm{speed}}\) | 경로 오차 \(e_{\mathrm{cte}}\) |
|---|---|---|---|---|
| 정적Static | ED-CBF | 45.4 | 0.124 | 1.765 |
| TC-CBF | 41.0 | 0.040 | 1.623 | |
| 정면 조우Head-on | ED-CBF | 42.2 | 0.097 | 2.014 |
| TC-CBF | 38.8 | 0.051 | 1.453 | |
| 추월Overtaking | ED-CBF | 46.8 | 0.133 | 2.113 |
| TC-CBF | 40.7 | 0.063 | 1.776 |
ED-CBF 대비 · 3개 시나리오 평균 감소율
교통선마다 COLREGs 조우 상황을 판단해 좌·우 회전원 CBF를 QP 안전 필터 제약으로 선택
MPC 수준의 규칙 준수 회피를 평균 약 0.1 ms 연산으로 구현
조우 상황별로 정해진 방향으로 피항

규칙에 맞춰 선속 벡터를 제한하는 방식

VO보다 성능은 우수하나 매 주기 최적화 필요
안전이 보장되고 COLREGs를 준수하는 충돌회피 프레임워크
기존 CBF에 부족했던 회피 방향 논리와 선회 한계를 좌·우 회전원으로 반영
선속 \(u\)와 최대 선회율 \(r_{\max}\)로 정한 좌·우 회전원을 장애물 밖에 유지
RTC-CBF → 우현 회피
LTC-CBF → 좌현 회피
교통선마다 조우 유형을 판정하고 규칙이 정한 회피 방향의 제약만 적용
예: 정면 조우 → 우현 변침 → RTC-CBF
| 시나리오 | 제어기 | 평균 연산 시간* | 최대 연산 시간 | 평균 CTE | 최대 CTE | 제어 입력량** |
|---|---|---|---|---|---|---|
| A · 교통선 6척 | 제안 (TC-CBF) | 0.14 ms | 1.80 ms | 439.5 m | 992.4 m | 6.16−29% |
| MPC 기반 | 23.35 ms | 40.18 ms | 390.6 m | 1001.2 m | 8.66 | |
| B · 4척 상호 회피 | 제안 (TC-CBF) | 0.09 ms | 1.62 ms | 61.4 m | 228.6 m | 12.25−20% |
| MPC 기반 | 12.60 ms | 38.70 ms | 52.9 m | 164.9 m | 15.29 |
굵은 값이 더 우수 · 평균 CTE(경로 횡방향 오차)는 제안 방법이 MPC보다 13–16% 큼 · ** 가속도·선회율 절댓값의 누적합
장애물마다 좌·우 통과 방향을 회전원 기반 CBF로 지정하고 모든 조합을 병렬로 풀어,
가이드 경로 없이 지역 최적해를 벗어나는 멀티모달 MPC
단일 호모토피 클래스 안에서만 최적화 → 장애물 뒤에 갇힘
좌·우 통과 방향에 따라 서로 다른 호모토피 경로 \(\tau_1,\ldots,\tau_5\)

별도의 상위 수준 가이드 경로 생성 단계 필요 → 계산 부담 증가
거리만으로 회피 → 좌·우 통과 방향 결정 모호 · 선회 한계 미반영
\(\sigma_j^{(k)}\in\{\mathrm{L},\mathrm{R}\}\): 모드 \(k\)에서 장애물 \(j\)의 통과 방향 (좌·우 회전원)
장애물 2개 → 4개 모드의 OCP를 병렬 평가하고 최저 비용 모드 선택 (배경: \(h(\mathbf{x})\))
VLCC급 선박(L = 320 m) · 33.7 km 항로 · 교통 밀도 D1–D3(동적 8 / 12 / 16척)별 100회 대응표본 Monte Carlo
D3 · 제안 방법(K = 16: Branch 4척 + Guard 2척) 전체 항해 · 1 Hz 재계획, 예측구간 600 s

16개 모드를 모두 푸는 MM-MPC(전문가)의 최저 비용 모드를 정답으로 학습
분기 장애물 4척을 완전 그래프로 연결하고 로짓 \(\ell_i\)의 부호로 통과 방향 \(\sigma_i\) 결정
SideNet 제안 모드와 직전 실행 모드 중 비용이 낮은 쪽을 실행
강건 MPC · 도달가능성 · 학습 · 데이터셋 · 모바일 로봇 · 멀티에이전트로 이어지는 연구 성과
선박이 상황을 묻고 답하며, 협상 조우에서 결정을 설명
사람의 작업 공간을 침범하지 않도록 로봇팔의 관절 속도 명령에 안전 필터 적용
선박에서 개발한 안전 제어 기술을 모바일 로봇과 매니퓰레이터로 확장
MPC가 선택한 회피 방식을 모사학습해 매니퓰레이터의 온라인 최적화 부담 감소

실내 · 보행자 환경의 자율주행과 동적 장애물 회피 실험

조작과 학습 실험을 위한 로봇팔 플랫폼

로봇과 사람의 움직임 측정 (사진은 예시)




| IEEE TCST ×2 | 2024 · 2026 | Cascade Tube MPC 접안 · TC-CBF 충돌회피 |
| IEEE/ASME TMECH | 2024 | 운하 환경 NMPC 자율운항 |
| IEEE RA-L | 2023 | 인지 기반 MPC · ICRA 2024 발표 |
| IJRR | 2023 | Pohang Canal Dataset |
| JFR | 2024 | ★ Editor's Choice at Science Robotics |
그 외 7편Mechatronics · Ocean Engineering · IJCAS 2026 · IEEE TCNS · CEP · Autonomous Robots 2023 · IEEE Sensors Letters 2022
JournalTMECH · TCST · T-ITS · TIE · L-CSS · RA-L · RAS · JFR · IJNAOE · JAIS · ISR · NODY · JKROS
ConferenceCDC · IFAC WC · CAMS · ICCAS · MECC · UR
국제 학회 5편 (IFAC WC ×2 · ICCAS ×2 · OCEANS) · 한국연구재단 신진연구 · 대학원생 1명 · 학부연구생 3명 합류
국립공주대학교 기계자동차공학부
Safe Autonomy & Intelligence Lab
속도 장애물 기반 CBF · COLREGs 고려 선박 충돌회피
적응형 CBF · ICROS 2026 1저자
TC-CBF COLREGs 충돌회피 · IFAC WC 2026 발표
도달가능성 기반 MPPI · 2026–2029
CBF 기반 bearing-only 편대 추종 (HUST 협업)
TC-CBF · 비홀로노믹 이동체 충돌회피
전·후방 도달가능성 기반 선박 접안
L1-MPC · 부족구동 선박 경로추종
진행 상황 1:1 점검 · 연구 계획 수립
논문·실험 결과 발표 및 상호 피드백
국내외 학회에서 연구 결과 발표
실험 결과 기반 학술대회·저널 논문 작성
국가·기업 과제의 경로계획 · 제어 · 실험 수행
2025 대한기계학회 추계학술대회 발표
ICROS 2026 · 유재민
IFAC WC 2026 · 부산
학부생 및 대학원생 상시 모집