A Geometric Task-Space Port-Hamiltonian Formulation for Redundant Manipulators

기술 요약: 여유 자유도를 가진 매니퓰레이터를 위한 기하학적 작업 공간 포트-해밀토니안 정식화

문제 정의
특정 미분 기구학적 작업(differential kinematic task)에 필요한 것보다 더 많은 자유도(DOF)를 가진 여유 매니퓰레이터(redundant manipulators)는 모델링과 제어 측면에서 과제를 안겨준다. 여유 자유도에 대한 라그랑주 정식화는 문헌(예: Dietrich et al., 2015; Ott et al., 2015)에서 잘 확립되어 있지만, 에너지와 전력을 작업 공간(task space)과 영 공간(null space) 사이에서 명시적으로 분해하여 처리하는 포트-해밀토니안(pH) 형식 내의 엄격한 기하학적 프레임워크가 필요하다. 기존의 작업 공간 임피던스 성형을 위한 pH 접근 방식(예: Scherpen et al., 2025)은 비여유 시스템을 다루거나 여유 자유도의 구조적 특성을 충분히 활용하지 못하는 경우가 많다. 핵심적인 문제는 여유 시스템을 위해 시스템의 운동량(momentum)과 전력 포트(power ports)를 작업 공간 및 영 공간 성분으로 자연스럽게 분해하는 pH 모델이 부족하다는 점이다.

방법론
저자들은 표준 해밀토니안 역학의 좌표 변환으로부터 유도된 새로운 기하학적 pH 정식화를 제안한다. 방법론은 다음 단계로 진행된다:

1. 기하학적 분해:

   • 속도 공간: 관성 메트릭 $M(q)$를 사용하여 접공간 $T_qQ$를 작업 자코비안 $J(q)$의 커널(영 공간)과 그 $M$-직교 보공간으로 분해한다. 이를 통해 조인트 속도 $\dot{q}$를 작업 공간 성분 $v$와 영 공간 성분 $\nu$로 고유하게 분리할 수 있다.
   • 힘 공간: 일반화된 힘 공간 $T^*_qQ$에 이중 분해가 적용된다. 토크 $\tau$는 $J^\top$의 상(image)에 있는 성분 $\tau_F$(작업 공간 힘)와 작업 공간 속도 부공간의 영핵(annihilator)에 있는 성분 $\tau_0$(영 공간 힘)로 분해된다.
   • 전력 균형: 이 분해는 기계적 전력 $\tau^\top \dot{q}$가 두 개의 독립적인 항인 $\tau_F^\top v$(작업 전력)와 $\tau_0^\top \nu$(영 공간 전력)로 분리됨을 밝혀낸다.

2. 좌표 변환:

   • 이 분해를 pH 구조에 삽입하기 위해, 저자들은 작업 자코비안 $J$와 영 공간 기저 행렬 $N$을 결합한 $\bar{J}(q)$를 사용하여 확장된 작업 속도 $\eta_e = \bar{J}(q)\dot{q}$를 정의한다.
   • 표준 해밀토니안 상태 $(q, p)$에 좌표 변화 $\Phi$를 적용하여, 운동량 $p$를 확장된 운동량 $\pi_e = \bar{J}^{-\top}(q)p$로 변환한다.
   • 이 변환을 통해 새로운 상태 벡터 $z = (q, \pi, \pi_\nu)$를 얻는다. 여기서 $\pi$는 작업 공간 운동량을, $\pi_\nu$는 영 공간 운동량을 나타낸다. 운동 에너지는 확장된 모빌리티 텐서 $\bar{\Lambda}$의 역행렬을 포함하는 작업 공간 및 영 공간 이차 형식의 합으로 분해됨이 입증된다.

3. 시스템 정식화:

   • 결과적으로 도출된 시스템은 왜곡 없는 교차 행렬 $J_z$를 갖는 포트-해밀토니안 시스템(식 27)이다. 이 시스템은 두 개의 뚜렷한 전력 포트를 특징으로 한다: 작업 포트 $(\sigma, \eta)$와 영 공간 포트 $(\tau_0, \nu)$.
   • 상호 연결 행렬은 작업 및 영 공간 역학 사이의 내부 에너지 결합을 명시적으로 모델링하는 비대각 항($G_{12}$)을 포함한다.

4. 제어 설계 (IDA-PBC):

   • 저자들은 새로운 모델에 상호 연결 및 댐핑 할당 수동성 기반 제어(IDA-PBC) 프레임워크를 적용한다.
   • 제어 목표는 원하는 작업 공간 평형점 $x^*$를 안정화하고 작업 공간 임피던스를 성형하는 것이다.
   • 매칭 조건은 운동 에너지를 구조적으로 보존하고 성형된 퍼텐셜 에너지 $V_c(q)$를 도입함으로써 해결된다.
   • 결과적인 제어 법칙은 세 가지 구성 요소로 이루어진다: 에너지 성형(평형점을 정의하기 위함), 에너지 라우팅(에너지를 소산시키지 않고 상호 연결을 수정하기 위함), 그리고 댐핑 주입(점근적 안정성을 보장하기 위함).

주요 기여

• 새로운 기하학적 pH 모델: 본 논문은 좌표 변환을 사용하여 운동량과 전력을 작업 공간 및 영 공간 성분으로 엄격하게 분해하는 여유 매니퓰레이터를 위한 최초의 pH 정식화를 제시한다.
• 이중 분해: 동역학적으로 일관된 투영기를 활용하여, 물리적으로 의미 있고 수학적으로 속도 분해와 일치하는 일반화된 힘 공간의 이중 분해를 도입한다.
• 명시적 전력 포트: 모델은 작업 공간(외부 상호작용 모델링)과 영 공간(내부 여유 역학 모델링)을 위한 두 개의 전력 결합 포트 쌍을 명시적으로 식별한다.
• IDA-PBC를 통한 임피던스 성형: 저자들은 작업 공간의 평형점에서 임피던스(강성 및 댐핑)를 능동적으로 성형하고 작업 공간 구성을 안정화하는 IDA-PBC 제어기를 설계함으로써 모델의 유용성을 입증한다.

결과
제안된 방법론은 3-DOF 데카르트 위치 작업을 수행하는 7-DOF Franka Emika Panda 로봇에 대한 시뮬레이션을 통해 검증되었다.

• 안정성: 폐루프 시스템은 외부 섭동이 없는 경우 총 해밀토니안 $H_{cl}$이 감소하거나 유지됨을 통해 안정적임이 입증되었다.
• 임피던스 거동: 시뮬레이션은 작업 공간 임피던스를 성형하는 능력을 보여주었다. 퍼텐셜 에너지 항 $V_c(q)$를 변화시킴으로써, 저자들은 평형점에서의 다양한 강성 프로파일(연성 vs 강성)을 달성하였다.
• 여유 자유도 처리: 결과는 제어기가 $x^*$를 안정화하는 동시에 영 공간 역학을 관리할 수 있음을 확인해주었다. 동일한 $x^*$로 이어지는 서로 다른 조인트 구성 $q^*$들이 서로 다른 영 공간 에너지 거동을 보이며 성공적으로 안정화되었으며, 이는 여유 자유도를 처리하는 제어기의 능력을 보여준다.
• 에너지 궤적: 시뮬레이션 플롯은 작업 공간 에너지($\bar{K}_t$), 영 공간 에너지($\bar{K}_\nu$), 그리고 총 에너지($H_{cl}$)의 진화를 보여주며, 예상된 에너지 교환 및 소산 특성을 확인시켜 준다.

의의 및 주장
저자들은 본 연구가 포트-해밀토니안 프레임워크 내에서 여유 매니퓰레이터를 분석하고 제어하기 위한 엄격한 이론적 토대를 제공한다고 주장한다. 작업 공간과 영 공간 포트로 시스템을 분해함으로써, 이 모델은 다음을 용이하게 한다:

1. 에너지 기반 분석: 전통적인 라그랑주 기술에 비해 에너지 흐름과 수동성 특성에 대한 분석을 단순화한다.
2. 모듈형 제어: 여유 자유도를 명시적으로 고려하는 작업 공간 제어 전략의 새로운 가능성을 열어주며, 작업 임피던스와 영 공간 거동을 독립적으로 성형할 수 있게 한다.
3. 구조적 통찰: 이 정식화는 다른 정식화에서는 종종 가려지는, 작업 및 영 공간 역학 사이의 결합의 기하학적 본질을 드러낸다.

본 논문은 이 정식화가 특히 정밀한 임피던스 제어와 안전한 물리적 상호작용을 요구하는 응용 분야를 위해, 여유 시스템을 위한 고급 에너지 인식 제어 전략을 개발하는 데 있어 중요한 단계라고 결론짓는다.