Actuator-Aware Inverse Kinematics with Joint-Limit Admissibility for Torque-Controlled Redundant Robots

기술 요약: 토크 제어 기반 여유 자유도 로봇을 위한 액추에이터 인지형 역기구학 및 관절 한계 허용성

문제 정의
여유 자유도 로봇은 특정 작업 공간 운동을 달eric 위해 필요한 것보다 더 많은 구동 관절을 보유하고 있으며, 이를 통해 관절 한계 회피와 같은 부차적인 목적을 달성할 수 있는 추가적인 자유도를 제공한다. 그러나 토크 제어 구조에서 역기구학(IK) 출력은 최종 제어 입력이 아니라 하류의 토크 레벨 컨트롤러(예: 가상 분해 제어, VDC)로 전달되는 참조 속도이다. 따라서 명령된 기구학적 잔차(kinematic residual)만을 최소화하는 것은 반드시 양호한 실제 운동을 보장하지 않는다. 만약 생성된 관절 속도 참조가 하류 컨트롤러의 동역학이나 액추에이터 한계와 호환되지 않는다면, 특히 관절 한계 근처에서 물리적 시스템이 작업을 추종하는 데 실패할 수 있다. 기존의 IK 방식들은 종종 기구학적 기준(예: 최소 노름, 영공간 투영)에 따라 여유 자유도를 해결하며, 이는 특정 토크 레벨 제어 루프나 액추에이터 용량 제약을 명시적으로 고려하지 않는다.

방법론
본 논문은 7자유도 상지 외골격 로봇의 엔드 이펙터 궤적과 토크 레벨 컨트롤러 사이의 중간 계층 역할을 수행하도록 설계된, 볼록 이차 계획법(Convex Quadratic Programming, QP)을 통한 컨트롤러 호환형 IK 정식화를 제안한다. 이 방법은 필요한 관절 수준의 속도($\dot{q}_r$)를 생성한다.

1. 컨트롤러 호환성 목적 함수: QP는 작업 보존과 컨트롤러 호환성 사이의 균형을 맞추는 비용 함수를 최소화하며, 가중치 행렬($W_c$)은 다음을 포함한다:

   • 등방성 베이스라인(Isotropic Baseline): 양호한 조건 형성(well-conditioning)을 보장한다.
   • 이전 명령 일관성($W_\Delta$): 이전 단계의 요구 속도와 비교하여 급격한 변화를 억제함으로써 부드러움을 촉진한다.
   • 액추에이터 토크 용량 가중치($W_\tau$): 시스템 내 가장 강한 관절 대비 토크 용량이 낮은 관절의 사용을 억제한다. 이 가중치는 측정된 토크가 아닌 알려진 액추에이터 한계로부터 유도된다.

2. 관절 한계 허용성: QP를 불능(infeasible) 상태로 만들 수 있는 하드 제약 조건 대신, 본 방법은 제어 함수(Control Barrier Function, CBF) 스타일의 부등식을 사용하여 허용 가능한 요구 속도 집합($D_r(q)$)을 정의한다. 이러한 경계는 명령된 속도가 기계적 한계를 향해 너무 빠르게 이동하지 않도록 보장한다.

3. 소프트 작업 제약: 작업 명령이 허용 가능한 속도 집합과 호환되지 않는 경우를 처리하기 위해, 작업 방정식($J\dot{q}_r = V_r$)은 슬랙 변수($s$)를 사용하는 소프트 제약 조건으로 취급된다. 작업 잔차는 목적 함수에서 페널티를 받으며, 이를 통해 솔버가 필요 시 작업 보존보다 컨트롤러 호환성을 우선시할 수 있도록 한다.

주요 기여

• 정식화: 토크 제어 로봇의 여유 자유도 해결을 위해 액추에이터 토크 용량과 이전 명령 일관성을 명시적으로 통합한 새로운 QP 기반 IK 정식화를 제안한다.
• 참조 레벨 안전성: 하류 컨트롤러를 수정하지 않고도 참조 레벨에서의 관절 한계 허용성을 제공하기 위해, 플랜트 입력이 아닌 '요구 속도'(IK 출력)에 대한 CBF 스타일의 경계를 도입한다.
• 작업-허용성 트레이드오프: 작업 방정식에 슬랙 변수를 사용하여 작업 보존과 컨트롤러 호환성 사이의 균형을 맞추는 메커니즘을 제공하며, 이를 통해 작업 잔차가 필요한 매끄러운 참조 생성을 방해하지 않도록 한다.

실험 결과
본 방법은 가상 분해 제어(VDC) 프레임워크를 사용하는 7자유도 상지 외골격 로봇에서 평가되었다. 비교 대상으로는 의사 역행렬(PINV), 댐핑 최소 제곱법(DLS), 영공간 관절 한계 회피(NS-JLA), 그리고 동일한 허용성 제약을 사용하지만 컨트롤러 호환성 목적 함수가 결여된 작업 보존 QP(TP-QP) 등 4가지 베이스라인이 사용되었다.

• 실현된 성능: 제안된 방법은 모든 베이스라인보다 낮은 루트 평균 제곱(RMS) 위치 및 자세 오차와 가장 낮은 실현된 작업 속도 잔차를 달ar성했다. 특히, TP-QP 베이스라인과 비교했을 때 RMS 위치 오차를 29.6%, RMS 자세 오차를 20.2% 감소시켰다.
• 한계 동작: 제안된 방법은 다른 방법들에 비해 "한계 밀기(limit-pushing)" 지수(한계를 향해 움직임을 지시하는 명령)를 최대 96%까지 낮추며 현저히 낮은 수치를 보였다.
• 토크 효율성: 가장 낮은 RMS 토크 노름을 기록하였으며, 이는 액추에이터 자원을 더 효율적으로 사용함을 시사한다.
• 허용성: 기구학적 베이스라인(PINV, DLS, NS-JLA)은 허용 가능한 요구 속도 경계를 빈번히 초과한 반면, 제안된 방법은 요구 속도 경계 위반이 발생하지 않았다.

의의 및 주장
본 논문은 토크 제어 기반의 여유 자유도 로봇을 위한 IK는 단순히 기구학적 오차를 최소화하는 것이 아니라, 하류 컨트롤러 및 액추에이터 역량과 호환되는 관절 레벨의 참조를 생성해야 한다고 주장한다. 실험 결과는 제안된 정식화가 작업 보존과 허용성 사이의 우수한 균형을 달성함을 보여준다. 액추에이터 용량을 존중하고 공격적인 한계 밀기를 피하는 참조를 생성함으로써, 이 방법은 기존의 토크 레벨 컨트롤러를 재설계하지 않고도 실현된 작업 동작을 개선한다. 저자들은 이러한 발견을 공식적인 플랜트 레벨의 안전성 증명이 아닌, "참조 레벨의 관절 한계 인식" 및 "컨트롤러 호환형 여유 자유도 해결"로 겸허하게 규정하였다. 향후 연구 과제로 결합된 IK-토크 제어 제약 정식화 및 공식적인 폐루프 제약 분석에 대한 조사가 확인되었다.