Forward Kinematics Accuracy Enhancement of a Force-Torque Decoupled Spherical Parallel Manipulator near Singular Configurations within a Tripodal Robot

기술 요약: 특이점 근방에서 힘-토크가 분리된 구형 병렬 매니퓰레이터의 순운동학 정확도 향상

문제 정의
병렬 매니퓰레이터, 특히 구형 병렬 매니퓰레이터(SPM)는 조인트 공간과 작업 공간 사이의 관계가 불량해지는 특이 구성(singular configurations)에 취약하다. 특이점 근방에서는 조인트 좌표의 미세한 측정 오차가 증폭되어, 결과적으로 엔드 이펙터(EE) 포즈 재구성 시 상당한 오차를 초과하게 된다. 이러한 성능 저하는 본 연구에서 제안된 삼각 로봇(tripodal robot)의 보행 및 조작 작업과 같이 높은 정밀도를 요구하는 응용 분야에서 제어 안정성과 정확도를 저해한다. 일반적으로 특이점은 회피되지만, 실제 시나리오(예: 로봇이 앉은 자세를 취하는 경우)에서는 이러한 영역을 통과해야 할 수도 있다. 본 논문은 매니퓰레이터의 근본적인 기계적 컨디셔닝을 변경하지 않고도, 이러한 불량 조건 상태에서 순운동학(FK) 정확도를 향상시키는 구체적인 과제를 다룬다.

방법론
제안된 솔루션은 새로운 기계적 설계와 그에 대응하는 중복 운동학 알고리즘을 포함한다:

1. 기계적 설계 (힘-토크 분리):
   저자들은 매니퓰레이터의 사용되지 않는 중앙 공간 내부에 내부 직렬 구조(RRR 체인)를 통합한 확장된 SPM 설계를 제시한다. 이는 하이브리드 3-CCC (외부 쉘) + RRR (내부 체인) 메커니즘을 생성한다.

• 분리(Decoupling): 외부 3-CCC 링크는 토크를 전달하고, 내부 RRR 체인은 힘을 흡수하여 효과적으로 힘과 토크 전달을 분리한다.
• 중복 센싱(Redundant Sensing): 이 내부 구조를 통해 내부 체인의 베이스 축($\hat{c}_1$)에 네 번째 조인트 센서($E_4$)를 부착할 수 있다. 결정적으로, 이 측정 축은 특이 구성(구체적으로 Type 2 특이점으로 인해 제어 불가능한 자유도가 증가하는 축)에 민감해지는 회전축과 일치한다.

2. 운동학 정식화:

• 자코비안 유도: 네 개의 입력 조인트(세 개의 베이스 액추에이터와 내부 지지 축)로부터 툴 플랫폼으로 매핑되는 중복 센서 자코비안 행렬($J_{red}$)을 유도한다. 이 행렬은 직사각형 형태($3 \times 4$)이며, 무어-펜로즈 유사 역행렬(Moore-Penrose pseudo-inverse)을 사용할 수 있다.
• 순운동학(FK) 솔루즘: 중복된 센서 데이터로 인해 FK 문제는 과결정 최적화 문제(overdetermined optimization problem)로 취급된다.
  • 1단계: 세 개의 주요 센서($E_1$–$E_3$)를 사용하는 고전적인 루프 폐쇄(loop-closure) 접근 방식을 통해 엔드 이펙터 방향의 초기 추정치를 제공하며, 이때 레벤버그-마쿼트(Levenberg-Marquardt, LM) 알고리즘을 사용한다.
  • 2단계: 추정된 방향의 역운동학으로부터 예측된 값과 측정된 중복 센서 값($\tilde{Z}$) 사이의 오차를 최소화하는 정밀화 단계를 수행한다. 여기에는 중복 센서의 가중치를 조절 가능한 가중 최소 제곱법(weighted least-squares minimization)이 포함된다.

3. 동적 인력 제어 (Dynamic Attraction Control):
   중복 센서가 컨디셔닝이 양호한 포즈(여기서 중복 센서가 주요 센서와 충돌할 수 있는 경우)에서 정확도를 저하시드는 것을 방지하기 위해, 저자들은 네 번째 센서에 대한 인력 계수($k_4$)의 동적 조정을 제안한다. 이 계수는 매니퓰레이터의 컨디셔닝 지수($1/\kappa$)에 따라 조절된다. 시스템은 매니퓰레이터가 불량 조건 상태에 접근할 때만 중복 센서에 더 높은 인력을 적용함으로써, 특이점 근방에서 정확도를 회복하는 동시에 다른 곳에서의 안정성을 유지한다.

주요 기여

• 새로운 기계적 토폴로지: 힘-토크가 분리된 설계 내의 사용되지 않는 내부 공간에 중복 센싱을 구현함으로써, 구형 링크 상의 공간을 차지하지 않고도 네 번째 센서를 배치할 수 있는 3-CCC SPM의 통합 구조를 제시하였다.
• 특이점 강건성: 특이 자유도의 각도 위치를 명시적으로 측정하는 방법을 통해, 고전적인 3-센서 방식이 실패하거나 매우 부정확해지는 구성에서도 엔드 이펙터 포즈를 재구성할 수 있게 하였다.
• 적응형 알고리즘: 현재의 기계적 컨디셔닝에 따라 중복 센서의 영향력을 균형 있게 조절하는 동적 조절 인력 계수를 갖춘 2단계 FK 솔버를 개발하였다.
• 검증: 상세한 해석적 유도, 왜곡된 측정 신호를 이용한 시뮬레이션, 그리고 제작된 물리적 프로토타입 형태의 삼각 로봇에 대한 검증을 수행하였다.

결과

• 시뮬레이션: 연구는 Type 1 및 Type 2 특이점에 접근하는 모션 프로파일을 활용하였다. 결과에 따르면, 고전적인 3-센서 방식은 컨디셔닝 지수($1/\kappa$)가 0에 가까워짐에 따라 방향 오차가 지수적으로 증가함을 보였다. 반면, 동적 인력이 적용된 제안된 4-센서 방식($4S_{ffk,D}$)은 현저히 낮은 오차 수준을 유지하였다.
• 오차 감소: 가장 불량한 조건의 영역에서, 동적 4-센서 방식은 3-센서 방식에 비해 최대 방향 오차를 약 3.45배 감소시켰다.
• 통계적 분포: 동적 4-센서 설정은 일반적으로 조인트 각도 오차의 퍼짐(spread)이 약간 더 넓었으나, 이상치(outliers)를 크게 줄이고 직접 측정된 축($Z$)의 사분위 범위(IQR)를 개선하여 특이점 근방에서 이상적인 각도를 더 일관되게 추적함을 보여주었다.
• 프로토타입 검증: 이 방법은 실제 삼각 로봇 프로토타입에 구현되었다. 광학 추적 분석 결과는 시뮬레이션 결과를 뒷받침하였으며, 동적 조정이 양호한 상태에서의 성능을 저해하지 않으면서 특이 구성 근방의 오차를 성공적으로 완화함을 검증하였다.

의의 및 주장
본 논문은 측정 부정확성이 존재하는 일반적인 SPM, 특히 특이 구성 근방에서의 순운동학 문제 재구성 정확도를 높이는 작업을 수행한다고 주장한다. 저자들은 이러한 개선이 매니퓰레이터의 실제 기계적 컨디셔닝을 변경하는 것이 아니라, 불량 조건 포즈에서 발생하는 측정 오차의 증폭을 완화함으로써 달성된다는 점을 강조한다.

이 연구의 의의는 SPM을 힙(hip) 관절로 사용하는 보행 로봇이 특이점으로 인해 통제 불능 상태가 되거나 심각한 정확도 손실이 발생할 수 있는 포즈(예: 앉기 또는 특정 보행 전환)를 통과할 수 있도록 하여 견고한 제어를 가능하게 한다는 데 있다. 이 접근 방식은 본 연구의 특정 삼각 로봇을 넘어, 의료 및 수술적 맥락을 포함하여 높은 신뢰성을 요구하는 작업에 SPM의 일반적인 적용 범위를 확장할 수 있는 범용성을 가진 것으로 제시된다. 본 연구는 힘-토크가 분리된 설계의 사용되지 않는 내부 공간에 중복 센싱을 통합하는 것이 고전적인 병렬 매니퓰레이터 운동학의 한계를 극복하기 위한 유효한 전략임을 입증한다.