Gravity Compensation of the dVRK-Si Patient Side Manipulator based on Dynamic Model Identification

기술 요약: 동적 모델 식별에 기반한 dVRK-Si 환자 측 매니퓰레이터(Patient Side Manipulator)의 중력 보상

문제 정의
da Vinci Research Kit (dVRK)은 로봇 보조 수술 분야를 발전시키기 위한 중요한 오픈 소스 플랫폼이다. 기존의 dVRK Classic 시스템은 중력의 영향이 미미한 환자 측 매니퓰레이터(PSM)를 사용했으나, da Vinci Si 수술 시스템에서 파생된 새로운 dVRK-Si 시스템은 구조적으로 업그레이드된 PSM을 특징으로 하며, 이로 인해 상당한 중력 오프셋이 발생하여 더 이상 무시할 수 없게 되었다. dVRK-Si PSM에서 보상되지 않은 중력은 제어 정확도 저하와 응답 시간 증가를 초래한다. dVRK Classic에 대해서는 동적 모델 식별이 다루어진 바 있으나, dVRK-Si의 기계적 차이로 인해 향상된 성능을 달 수 있는 모델 기반 제어에 대한 새로운 연구가 필요하다.

방법론
저자들은 전체 동적 모델 파라미터를 식별하고 중력 항 $G(q)$를 분리하여 보상하는 것을 중심으로 한 dVRK-Si PSM용 중력 보상(GC)의 포괄적인 접근 방식을 제안한다. 방법론은 다음과 같은 다섯 가지 단계로 진행된다:

1. 운동학적 모델링 (Kinematic Modeling): 제조사 사양과 물리적 측정을 바탕으로 dVRK-Si PSM의 전체 운동학적 모델을 구축하였다. 이 모델은 수정된 Denavit-Hartenberg (DH) 파라미터(표 I에 상세 기술됨)를 활용하며, 원격 중심점(Remote Center of Motion, RCM)을 포함한 Si PSM의 복잡한 링크 구조를 설명하기 위해 특정 프레임 구조(그림 2)를 정의한다.
2. 동적 모델링 (Dynamic Modeling): 오일러-라그랑주(Euler-Lagrangian) 접근 방식을 사용하여 동적 모델을 도출하였다. 운동 방정식은 $M(q)\ddot{q} + C(q, \dot{q})\dot{q} + G(q) = \tau$로 표현되며, 목표는 링크 관성, 모터 관성, 마찰 및 강성을 나타내는 파라미터 벡터 $\delta$를 식별하는 것이다.
3. 흥분 궤적 설계 (Excitation Trajectory Design): 풍부한 데이터 수집을 보장하기 위해 관절 제약 조건과 동적 모델을 기반으로 최적의 흥분 궤적을 계산하였다.
4. 데이터 수집 (Data Collection): 물리적인 dVRK-Si PSM에서 흥분 궤적을 실행하여 운동학적 및 동적 데이터를 수집하였다.
5. 파라미터 식별 (Parameter Identification): 동적 파라미터는 볼록 최적화(convex optimization) 접근 방식을 사용하여 해결되었다. 과적합을 방지하고 물리적 타당성을 확보하기 위해, 최적화 과정에는 링크 질량은 양수여야 하고, 질량 중심은 링크의 볼록 껍질(convex hull) 내에 머물러야 하며, 마찰 계수, 모터 관성 및 스프링 강성은 양수여야 한다는 특정 제약 조건이 포함되었다.

주요 기여
본 논문은 두 가지 주요 기여를 제시한다:

• 정확한 모델링에 필요한 프레임 관계와 파라미터를 명시적으로 정의한 dVRK-Si PSM의 새로운 전체 운동학적 모델.
• 동적 모델 식별에 기반한 중력 보상 전략. 전체 동적 모델을 식별함으로써, 저자들은 휴리스틱 또는 단순화된 모델에 의존하는 대신 중력 보상에 필요한 토크를 제공하기 위해 $G(q)$ 항을 추출한다.

결과
제안된 중력 보상의 효능은 드리프트 테스트(drift test)를 통해 검증되었다. 이 실험에서 PSM은 표준 PD 위치 제어기를 사용하여 원하는 포즈로 이동한 후, 5초 동안 개루프 토크 기반 중력 보상 모드로 전환되었다. 드리프트는 1도 또는 1mm를 초 exceeding하는 움직임으로 정의되었다.

• 드리프트 성능: 시스템은 다섯 가지 무작위 테스트 구성에서 눈에 띄는 드리프트 없이 로봇의 포즈를 유지하였다.
• 오차 감소: 중력 보상 방식은 PD 제어기 단독 사용 시보다 더 작은 정상 상태 오차(steady-state error)를 보여주었다.
• 토크 분석: 첫 세 개의 관절(중력의 영향을 가장 많이 받는 관절)에 대해 생성된 GC 방법의 관절 토크는 정적 마찰에 대항하여 관절을 위치시키기 위해 요구되는 계산된 하한 및 상한 범위 내에 있었다. 대부분의 경우, 이 토크들은 가용한 범위의 중간값에 근접했다.
• 관절 3 관찰 사항: 세 번째 관절(프리즘 관절)의 경우, 토크 중간값으로부터의 일부 편차가 관찰되었으며, 저자들은 이를 프리즘 관절과 캐뉼라(cannula)의 상당한 마찰 때문인 것으로 설명하였다.

의의 및 주장
저자들은 제안된 중력 보상 방식이 구조적 업그레이드로 인한 시스템의 결정적 한계를 해결하여, 눈에 띄는 드리프트 없이 dVRK-Si PSM의 포즈를 효과적으로 유지한다고 주장한다. 본 연구는 동일한 장착 각도 구성을 공유한다면 동적 모델 식별이 서로 다른 dVRK-Si PSM 간에 성공적으로 일반화될 수 있음을 입증한다. 정확한 중력 보상을 가능하게 함으로써, 본 연구는 더 높은 제어 정확도와 빠른 응답 시간을 촉진하여 dVRK-Si 플랫폼을 위한 더 진보된 연구 및 제어 애플리케이션을 지원한다. 본 연구는 모든 동적 제어 문제를 해결한다고 주장하는 것이 아니라, Si PSM 설계에 내재된 중력 오프셋 문제를 구체적으로 겨냥한다.