14.22 중력 보상 토크의 계산

1. 개요

매니퓰레이터의 정적 평형을 유지하기 위해서는 각 관절에서 중력에 의한 정적 토크를 보상해야 한다. 중력 보상 토크는 매니퓰레이터의 자세에 의존하며, 동역학 방정식에서 위치만의 함수로 표현되는 항이다. 본 절에서는 중력 보상 토크의 정의, 계산 방법, 응용을 다룬다.

2. 중력 보상 토크의 정의

2.1 동역학 방정식에서의 중력 항

매니퓰레이터의 일반적인 동역학 방정식은 다음과 같다.

\mathbf{M}(\mathbf{q})\ddot{\mathbf{q}} + \mathbf{C}(\mathbf{q}, \dot{\mathbf{q}})\dot{\mathbf{q}} + \mathbf{g}(\mathbf{q}) = \boldsymbol{\tau}

여기서 \mathbf{g}(\mathbf{q})가 중력 항이며, 관절 위치 \mathbf{q}만의 함수이다.

2.2 정적 평형 조건

매니퓰레이터가 정지 상태(\dot{\mathbf{q}} = 0, \ddot{\mathbf{q}} = 0)에 있을 때 동역학 방정식은 다음으로 단순화된다.

\boldsymbol{\tau} = \mathbf{g}(\mathbf{q})

이때의 관절 토크가 중력 보상 토크이다.

3. 중력 보상 토크의 계산 방법

3.1 뉴턴-오일러 재귀 알고리즘에 의한 계산

뉴턴-오일러 재귀 역동역학 알고리즘에서 \dot{\mathbf{q}} = 0, \ddot{\mathbf{q}} = 0으로 설정하면 출력되는 관절 토크가 중력 보상 토크이다. 이 방법은 효율적이며 일반적으로 사용된다.

3.2 위치 에너지의 미분에 의한 계산

매니퓰레이터의 총 위치 에너지를 U(\mathbf{q})라 하면 중력 보상 토크는 다음과 같이 표현된다.

\mathbf{g}(\mathbf{q}) = \frac{\partial U(\mathbf{q})}{\partial \mathbf{q}}

총 위치 에너지는 각 링크의 위치 에너지의 합이다.

U(\mathbf{q}) = \sum_{i=1}^{n} m_i g h_i(\mathbf{q})

여기서 m_i는 링크 i의 질량, g는 중력 가속도의 크기, h_i(\mathbf{q})는 링크 i의 질량 중심의 높이이다.

3.3 자코비안에 의한 계산

각 링크의 질량 중심에 작용하는 중력을 관절 공간으로 변환하면 다음과 같다.

\mathbf{g}(\mathbf{q}) = -\sum_{i=1}^{n} \mathbf{J}_{v_i}^{T}(\mathbf{q}) m_i \mathbf{g}_0

여기서 \mathbf{J}_{v_i}는 링크 i의 질량 중심의 선속도 자코비안이고, \mathbf{g}_0는 중력 가속도 벡터이다.

4. 중력 보상 토크의 성질

4.1 자세 의존성

중력 보상 토크는 관절 위치에만 의존하고 관절 속도와 가속도에는 의존하지 않는다. 따라서 동일한 자세에서는 항상 같은 값이다.

4.2 보존성

중력 항은 보존력에 의한 항이며, 위치 에너지의 기울기로 표현된다.

4.3 작업 영역의 영향

매니퓰레이터의 작업 자세에 따라 중력 보상 토크의 크기가 크게 달라진다. 팔이 수평으로 펴진 자세에서 일반적으로 최대가 된다.

5. 응용

5.1 중력 보상 제어

매니퓰레이터의 제어에서 중력 보상 토크를 피드포워드로 더하면 위치 추종 성능이 향상된다. 이를 중력 보상 제어라 한다.

\boldsymbol{\tau} = \mathbf{g}(\mathbf{q}) + \boldsymbol{\tau}_{\text{fb}}

여기서 \boldsymbol{\tau}_{\text{fb}}는 피드백 항이다.

5.2 정적 분석

매니퓰레이터의 정적 부하 계산, 액추에이터 사양 결정, 평형 자세 분석 등에 사용된다.

5.3 직접 교시

협동 매니퓰레이터의 직접 교시 모드에서 중력 보상 토크가 정확히 적용되면 사용자가 가벼운 힘으로 매니퓰레이터를 움직일 수 있다.

5.4 균형 설계

매니퓰레이터의 기계적 설계에서 균형추, 스프링 등을 추가하여 중력 보상 토크를 줄일 수 있다. 이는 액추에이터의 부담을 줄인다.

6. 응용 예시: 2자유도 평면 매니퓰레이터

링크 길이 l_1, l_2, 링크 질량 m_1, m_2, 질량 중심까지의 거리 l_{c1}, l_{c2}를 가진 수직 평면 매니퓰레이터의 중력 보상 토크는 다음과 같다.

g_1(\mathbf{q}) = m_1 g l_{c1}\cos q_1 + m_2 g (l_1 \cos q_1 + l_{c2}\cos(q_1 + q_2))

g_2(\mathbf{q}) = m_2 g l_{c2}\cos(q_1 + q_2)

각 항은 링크의 질량 중심에 작용하는 중력에 의한 관절 토크의 기여를 나타낸다.

7. 본 절의 의의

본 절은 중력 보상 토크의 정의와 계산 방법을 다루었다. 중력 보상은 매니퓰레이터의 정적 분석과 제어에서 핵심적이며, 실제 시스템의 성능에 직접적인 영향을 미친다.

8. 참고 문헌

• Spong, M. W., Hutchinson, S., & Vidyasagar, M. (2020). Robot Modeling and Control (2nd ed.). Wiley.
• Siciliano, B., Sciavicco, L., Villani, L., & Oriolo, G. (2010). Robotics: Modelling, Planning and Control. Springer.
• Featherstone, R. (2008). Rigid Body Dynamics Algorithms. Springer.
• Craig, J. J. (2005). Introduction to Robotics: Mechanics and Control (3rd ed.). Pearson.

version: 1.0