Contact-Aware Planning and Control of Continuum Robots in Highly Constrained Environments

1. 문제 정의 (Problem Statement)

• 배경: 연속체 로봇 (Continuum Robots) 은 혈관 내 시술, 내시경, 좁은 공간 검사 등 제한적이고 취약한 환경에서 유용하게 사용되지만, 이러한 환경에서는 로봇과 주변 구조물 간의 접촉이 불가피합니다.
• 핵심 과제:
  • 접촉의 양면성: 제어된 접촉은 운동을 돕지만, 원치 않는 접촉 (특히 로봇 팁의 접촉) 은 제어 능력을 저하시키거나, 운동학적 특이점 (Kinematic Singularities) 을 유발하며, 혈관 천공과 같은 안전 위험을 초래할 수 있습니다.
  • 기존 방법의 한계: 기존 계획 알고리즘은 장애물을 완전히 회피하거나 접촉을 적극적으로 활용하는 두 가지 극단 중 하나를 선택하는 경향이 있습니다. 그러나 '유해한 접촉'과 '안전한 접촉'을 구분하지 못하거나, 실제 하드웨어 실행을 위한 폐루프 (Closed-loop) 제어와 통합되지 않는 문제가 있었습니다.
• 목표: 대동맥궁 (Aortic Arch) 을 통한 혈전 제거술 (Mechanical Thrombectomy) 과 같은 임상 시나리오를 가정하여, 로봇 팁이 혈관 벽을 손상시키지 않으면서도 필요한 접촉은 허용하는 접촉 인식 (Contact-Aware) 계획 및 제어 프레임워크를 개발하는 것입니다.

2. 방법론 (Methodology)

제안된 프레임워크는 계획 (Planning), 제어 (Control), 하드웨어 통합의 세 가지 주요 요소로 구성됩니다.

A. 접촉 인식 운동 모델 (Contact-Aware Motion Model)

• 로봇의 기하학적 형태는 조각별 일정 곡률 (Piecewise Constant Curvature) 모델을 사용하여 표현됩니다.
• 에너지 최소화 문제: 주어진 관절 명령 (삽입 길이, 근위부/원위부 힘줄 길이) 에 대해 로봇의 곡률을 계산할 때, 다음 제약 조건을 포함하는 최적화 문제를 풉니다.
  1. 환경 제약: 로봇 점과 환경 (혈관 벽) 간의 거리가 임계값 이상이어야 함.
  2. 구동 일관성: 계산된 로봇 형태가 실제 힘줄 길이와 일치해야 함.
• 이 모델을 통해 명령된 관절 값과 실제 로봇 형태 간의 불일치를 보정합니다.

B. 접촉 인식 계획 알고리즘 (Contact-Aware Planner)

• 작업 공간 분할 (Task-Space Partitions): 작업 공간을 목표에 도달하는 데 필요한 '운동 복잡도 (이동 유형 전환 횟수)'에 따라 분할합니다. 이를 통해 지역별 작업 복잡도에 따라 동적인 행동 공간 (Action Space) 을 선택하고, 접촉 비용 함수를 조정합니다.
• 비용 함수 (Cost Function):
  • 접촉 비용: 로봇 팁 (Distal Tip) 의 접촉은 혈관 파열 위험이 있으므로 가장 큰 패널티를 부여합니다. 연속체 세그먼트 끝 (ECS) 의 접촉은 운동성을 제한하므로 중간 정도의 패널티를, 몸체 (Body) 접촉은 허용하되 최소화합니다.
  • 행동 비용: 관절 이동량과 팁 이동 효율성을 기반으로 계산됩니다.
• 휴리스틱 (Heuristic): 목표 지점까지의 거리뿐만 아니라, 혈관 분기점에서의 접근 각도를 고려하여 안전한 접근 경로를 유도합니다.
• 알고리즘: 가중치 A* (Weighted A*) 탐색 기반의 계획 알고리즘을 사용하며, 계산 효율성을 위해 분석적 미분 (Analytical Derivatives) 과 캐싱 기법을 적용합니다.

C. 제어 (Control)

• 폐루프 궤적 추적: 계획된 궤적에 따라 로봇 팁을 추적하기 위해 피드포워드 (Feedforward) 및 피드백 (Feedback) 제어를 결합합니다.
• 접촉 인식 자코비안 (Contact-Aware Jacobian): 계획 단계에서 미리 계산된 자코비안 행렬을 사용하여, 실제 환경에서의 접촉 상태를 반영한 관절 - 작업 공간 매핑을 제공합니다.
• PD 제어: 측정된 팁 위치 오차를 기반으로 자코비안의 더미 역행렬 (Damped Pseudo-inverse) 을 사용하여 실시간으로 관절 명령을 보정합니다.

3. 주요 기여 (Key Contributions)

1. 접촉 인식 계획기 개발: 유해한 접촉 (팁 손상, 특이점 유발) 을 패널티로 부과하고, 안전한 접촉은 허용하는 탐색 기반 계획 알고리즘을 제안했습니다.
2. 통합 제어 프레임워크: 계획 단계에서 생성된 접촉 인식 자코비안을 활용하여, 최소한의 센싱 (팁 포즈 피드백) 으로만 정밀한 폐루프 제어가 가능하도록 했습니다.
3. 실제 환자 데이터 기반 검증: 환자 CT 스캔에서 재구성된 3 가지 유형의 대동맥궁 (Type I, II, III) 모델에서 하드웨어 실험을 수행하여 시스템의 유효성을 입증했습니다.
4. 안전성 및 신뢰성 증대: 로봇 팁의 혈관 접촉을 100% 성공적으로 회피하면서도 목표 지점에 도달하는 것을 증명했습니다.

4. 실험 결과 (Results)

• 실험 환경: Type I, II, III 대동맥궁 모델 (환자 스캔 기반 3D 프린팅).
• 성공률: 3 가지 환경 모두에서 9 회 (각 환경 3 회) 의 하드웨어 시연에서 100% 성공 (목표 도달 및 팁 접촉 회피).
• 추적 오차 (Mean Tracking Error):
  • Type I: 1.9 ± 0.5 mm
  • Type II: 1.2 ± 0.1 mm
  • Type III: 1.7 ± 0.2 mm
• 계획 시간: Type I (1531 초), Type II (298 초), Type III (838 초). 복잡한 Type III 의 경우 계획 시간이 길었으나, 분할 기반 행동 공간 기법으로 효율성을 확보했습니다.
• 애블레이션 연구 (Ablation Studies):
  • ECS 접촉 패널티 제거 시: 로봇의 가동성 (Manipulability) 이 급격히 저하되고, 하드웨어 실험에서 로봇이 벽에 걸려 실패했습니다.
  • 몸체 접촉 패널티 제거 시: 실험 시간과 완료 시간이 증가했으며, 계획과 실제 환경 간의 불일치로 인해 제어 정확도가 떨어졌습니다.
  • 폐루프 제어 부재 시: 개방 루프 (Open-loop) 실행 시 환경 오차로 인해 팁이 혈관 벽에 접촉하여 실패했습니다.

5. 의의 및 결론 (Significance)

• 임상적 가치: 뇌졸중 치료 시 혈전 제거를 위한 대동맥궁 통과 자동화 가능성을 보여주었습니다. 이는 시술 시간을 단축하고, 혈관 손상 위험을 줄여 환자의 예후를 개선할 수 있습니다.
• 기술적 혁신: 기존에 분리되어 있던 '접촉을 고려한 계획'과 '실시간 제어'를 통합하여, 실제 물리적 제약이 있는 환경에서도 신뢰성 있는 로봇 제어가 가능함을 입증했습니다.
• 향후 과제: 2D 평면 계획에서 3D 공간 계획으로 확장, 계획 시간 단축, 그리고 힘 추정 (Force Estimation) 기술을 통한 조직 손상 위험의 추가 감소를 목표로 합니다.

이 논문은 제한된 생체 내 환경에서 연속체 로봇의 안전한 자율 항법을 위한 핵심적인 방법론을 제시하며, 의료 로봇 분야의 실용화를 한 단계 진전시켰다는 점에서 의의가 큽니다.