6.93 힘-토크 매핑과 정역학 관계

로봇 매니퓰레이터의 정역학(statics)은 말단 장치에 가해지는 외력 및 모멘트와 이를 평형 상태로 유지하기 위해 필요한 관절 토크 사이의 관계를 다룬다. 이 관계는 자코비안 행렬의 전치를 통해 수학적으로 기술되며, 속도 관계의 쌍대(dual)로서 에너지 보존의 원리로부터 유도된다. 본 절에서는 힘-토크 매핑의 유도, 구조, 물리적 해석을 다룬다.

1. 가상 일의 원리에 의한 유도

정역학적 평형 상태에서 가상 변위(virtual displacement) \delta\mathbf{q}와 \delta\mathbf{x}에 대해, 관절 토크에 의한 가상 일과 말단 장치의 외력에 의한 가상 일이 동일하여야 한다.

\delta W = \boldsymbol{\tau}^\top \delta\mathbf{q} = \mathbf{F}^\top \delta\mathbf{x}

여기서 \boldsymbol{\tau} \in \mathbb{R}^n는 관절 토크(또는 관절력) 벡터, \mathbf{F} \in \mathbb{R}^m는 말단 장치에 작용하는 일반화된 힘(generalized force) 벡터이다. 미분 기구학 관계 \delta\mathbf{x} = J(\mathbf{q}) \delta\mathbf{q}를 대입하면 다음을 얻는다.

\boldsymbol{\tau}^\top \delta\mathbf{q} = \mathbf{F}^\top J(\mathbf{q}) \delta\mathbf{q}

이 등식이 임의의 가상 변위 \delta\mathbf{q}에 대해 성립하여야 하므로, 다음의 정역학 관계를 얻는다.

\boldsymbol{\tau} = J^\top(\mathbf{q}) \, \mathbf{F}

이것이 자코비안 전치에 의한 힘-토크 매핑의 기본 관계식이다.

2. 작업 공간 렌치

말단 장치에 작용하는 일반화된 힘 벡터 \mathbf{F}는 힘(force)과 모멘트(moment)를 결합한 6차원 렌치(wrench) 벡터로 표현된다.

\mathbf{F} = \begin{bmatrix} \mathbf{f} \\ \mathbf{n} \end{bmatrix} \in \mathbb{R}^6

여기서 \mathbf{f} \in \mathbb{R}^3는 말단 장치에 작용하는 힘 벡터, \mathbf{n} \in \mathbb{R}^3는 모멘트 벡터이다. 자코비안 전치를 블록으로 분할하면 정역학 관계는 다음과 같이 전개된다.

\boldsymbol{\tau} = J_v^\top \mathbf{f} + J_\omega^\top \mathbf{n}

여기서 J_v^\top \in \mathbb{R}^{n \times 3}는 선속도 자코비안의 전치, J_\omega^\top \in \mathbb{R}^{n \times 3}는 각속도 자코비안의 전치이다.

3. 속도-힘 쌍대성

속도 관계와 정역학 관계는 자코비안과 그 전치를 통해 쌍대적 구조를 이룬다.

이 쌍대성은 에너지 보존에 근거한 것으로, 자코비안의 열 공간(column space)에서 생성 가능한 작업 공간 속도 방향과, 자코비안 전치의 열 공간에서 관절 토크를 생성하는 작업 공간 힘 방향이 서로 밀접하게 관련된다.

4. 개별 관절의 정역학적 기여

자코비안 전치의 i번째 행은 \mathbf{j}_i^\top이므로, i번째 관절의 토크는 다음과 같다.

\tau_i = \mathbf{j}_i^\top \mathbf{F}

관절 유형에 따라 이를 전개하면 다음과 같다.

4.1 회전 관절의 경우

\tau_i = [\mathbf{z}_{i-1} \times (\mathbf{p}_n - \mathbf{p}_{i-1})]^\top \mathbf{f} + \mathbf{z}_{i-1}^\top \mathbf{n}

제1항은 말단 장치의 힘 \mathbf{f}가 레버 암을 통해 관절 i에 유발하는 토크이고, 제2항은 모멘트 \mathbf{n}의 관절 축 방향 성분이다.

4.2 직동 관절의 경우

\tau_i = \mathbf{z}_{i-1}^\top \mathbf{f}

직동 관절에서의 관절력은 말단 장치 힘의 관절 축 방향 투영이다.

5. 역정역학 문제

원하는 말단 장치 힘 \mathbf{F}_d를 생성하기 위한 관절 토크를 구하는 문제는 정역학 관계를 직접 적용하면 된다.

\boldsymbol{\tau} = J^\top(\mathbf{q}) \, \mathbf{F}_d

반대로, 주어진 관절 토크 \boldsymbol{\tau}로부터 말단 장치에 생성되는 힘을 구하는 순정역학(forward statics) 문제는 다음과 같다.

정방 비특이 자코비안의 경우:

\mathbf{F} = J^{-\top}(\mathbf{q}) \, \boldsymbol{\tau}

여유 자유도 시스템의 경우, 관절 토크의 일부는 내부 응력(internal stress)으로 소비되어 말단 장치에 힘을 생성하지 않을 수 있다.

6. 중력 보상

정역학적 평형에서 중력의 영향을 보상하려면, 각 링크에 작용하는 중력을 등가적인 관절 토크로 변환하여야 한다. 링크 i의 질량 중심에 작용하는 중력 벡터를 \mathbf{f}_{g,i} = m_i \mathbf{g}라 하면, 중력 보상 토크 벡터 \mathbf{g}(\mathbf{q})는 다음과 같다.

\mathbf{g}(\mathbf{q}) = \sum_{i=1}^{n} J_{v,c_i}^\top(\mathbf{q}) \, m_i \mathbf{g}

여기서 J_{v,c_i}(\mathbf{q})는 링크 i의 질량 중심에 대한 선속도 자코비안이고, \mathbf{g} \in \mathbb{R}^3는 중력 가속도 벡터이다.

7. 접촉력 제어에서의 활용

로봇이 환경과 접촉하면서 작업을 수행하는 경우(연마, 조립 등), 원하는 접촉력을 생성하기 위한 관절 토크 명령은 자코비안 전치를 통해 계산된다.

\boldsymbol{\tau}_{\text{contact}} = J^\top(\mathbf{q}) \, \mathbf{F}_d

이 관계는 임피던스 제어(impedance control)와 힘 제어(force control) 방식의 기본 구성 요소이다. 임피던스 제어에서는 원하는 임피던스 거동을 설정하고, 이에 대응하는 힘을 자코비안 전치를 통해 관절 토크로 변환한다.

\mathbf{F} = M_d \ddot{\tilde{\mathbf{x}}} + B_d \dot{\tilde{\mathbf{x}}} + K_d \tilde{\mathbf{x}}

여기서 \tilde{\mathbf{x}} = \mathbf{x} - \mathbf{x}_d는 작업 공간 오차, M_d, B_d, K_d는 각각 원하는 관성, 감쇠, 강성 행렬이다.

8. 특이점에서의 정역학적 특성

특이 형상에서 자코비안의 랭크가 감소하면, 속도 생성이 불가능한 작업 공간 방향이 존재한다. 쌍대적으로, 이 방향에서는 관절 토크 없이(또는 매우 작은 토크로) 대응하는 작업 공간 힘에 저항할 수 있다. 이는 특이점에서의 기구학적 잠금(kinematic locking) 효과로서, 구조물과 유사한 하중 지지 능력을 나타낸다.

이 특성은 때로 의도적으로 활용되기도 한다. 예를 들어, 매니퓰레이터가 무거운 물체를 지지하여야 하는 경우, 특이 형상에 가까운 자세를 취하면 최소한의 관절 토크로 하중을 지탱할 수 있다.

9. 참고 문헌

• Craig, J. J. (2005). Introduction to Robotics: Mechanics and Control. 3rd ed. Pearson Prentice Hall.
• Siciliano, B., Sciavicco, L., Villani, L., & Oriolo, G. (2009). Robotics: Modelling, Planning and Control. Springer.
• Spong, M. W., Hutchinson, S., & Vidyasagar, M. (2006). Robot Modeling and Control. John Wiley & Sons.
• Hogan, N. (1985). “Impedance Control: An Approach to Manipulation.” Journal of Dynamic Systems, Measurement, and Control, 107(1), 1–24.
• Murray, R. M., Li, Z., & Sastry, S. S. (1994). A Mathematical Introduction to Robotic Manipulation. CRC Press.

v 0.1