14.30 다자유도 직렬 매니퓰레이터의 뉴턴-오일러 해석

14.30 다자유도 직렬 매니퓰레이터의 뉴턴-오일러 해석

1. 개요

다자유도 직렬 매니퓰레이터는 가장 흔한 매니퓰레이터의 형태이다. 이러한 매니퓰레이터의 동역학 해석은 뉴턴-오일러 재귀 알고리즘으로 효율적으로 수행된다. 본 절에서는 다자유도 직렬 매니퓰레이터의 뉴턴-오일러 해석을 자세히 다룬다.

2. 매니퓰레이터의 구조

2.1 직렬 연결

직렬 매니퓰레이터는 강체 링크가 관절로 연속적으로 연결된 구조이다. 기저로부터 말단까지 각 링크가 하나의 관절로 다음 링크와 연결된다.

2.2 자유도

n개의 관절을 가진 매니퓰레이터의 자유도는 일반적으로 n이다. 이는 각 관절의 1자유도 운동의 합이다.

2.3 운동 변수

  • 관절 각도 \mathbf{q} = (q_1, q_2, \ldots, q_n)^T
  • 관절 속도 \dot{\mathbf{q}}
  • 관절 가속도 \ddot{\mathbf{q}}

3. 좌표계의 설정

3.1 링크 좌표계

각 링크에 대해 좌표계 \{i\}가 정의된다. 디나비트-하르텐베르크 표기법이 일반적으로 사용된다.

3.2 좌표 변환

좌표계 \{i-1\}에서 좌표계 \{i\}로의 변환은 다음의 동차 변환으로 표현된다.

{}^{i-1}\mathbf{T}_i = \begin{bmatrix} {}^{i-1}\mathbf{R}_i & {}^{i-1}\mathbf{p}_i \\ \mathbf{0}^T & 1 \end{bmatrix}

여기서 {}^{i-1}\mathbf{R}_i는 회전 행렬이고 {}^{i-1}\mathbf{p}_i는 위치 벡터이다.

4. 뉴턴-오일러 재귀 알고리즘

4.1 알고리즘의 구조

뉴턴-오일러 재귀 알고리즘은 두 단계로 구성된다.

  1. 전방 재귀: 기저로부터 말단까지 각 링크의 운동(속도, 가속도)을 계산
  2. 후방 재귀: 말단으로부터 기저까지 각 링크에 작용하는 힘과 토크를 계산

4.2 전방 재귀

각 링크의 각속도, 각가속도, 선가속도를 다음과 같이 계산한다.

회전 관절의 경우

{}^i\boldsymbol{\omega}_i = {}^i\mathbf{R}_{i-1}\,{}^{i-1}\boldsymbol{\omega}_{i-1} + \dot{q}_i\,{}^i\mathbf{z}_i

{}^i\dot{\boldsymbol{\omega}}_i = {}^i\mathbf{R}_{i-1}\,{}^{i-1}\dot{\boldsymbol{\omega}}_{i-1} + \ddot{q}_i\,{}^i\mathbf{z}_i + ({}^i\boldsymbol{\omega}_i \times \dot{q}_i\,{}^i\mathbf{z}_i)

{}^i\dot{\mathbf{v}}_i = {}^i\mathbf{R}_{i-1}({}^{i-1}\dot{\mathbf{v}}_{i-1} + {}^{i-1}\dot{\boldsymbol{\omega}}_{i-1} \times {}^{i-1}\mathbf{p}_i + {}^{i-1}\boldsymbol{\omega}_{i-1} \times ({}^{i-1}\boldsymbol{\omega}_{i-1} \times {}^{i-1}\mathbf{p}_i))

각 링크 질량 중심의 가속도

{}^i\dot{\mathbf{v}}_{c,i} = {}^i\dot{\mathbf{v}}_i + {}^i\dot{\boldsymbol{\omega}}_i \times {}^i\mathbf{p}_{c,i} + {}^i\boldsymbol{\omega}_i \times ({}^i\boldsymbol{\omega}_i \times {}^i\mathbf{p}_{c,i})

4.3 후방 재귀

각 링크의 관성력과 관성 모멘트를 계산한 후 힘과 토크를 후방으로 전파한다.

관성력과 관성 모멘트

{}^i\mathbf{F}_i = m_i\,{}^i\dot{\mathbf{v}}_{c,i}

{}^i\mathbf{N}_i = {}^i\mathbf{I}_i\,{}^i\dot{\boldsymbol{\omega}}_i + {}^i\boldsymbol{\omega}_i \times ({}^i\mathbf{I}_i\,{}^i\boldsymbol{\omega}_i)

힘과 토크의 후방 전파

{}^i\mathbf{f}_i = {}^i\mathbf{R}_{i+1}\,{}^{i+1}\mathbf{f}_{i+1} + {}^i\mathbf{F}_i

{}^i\mathbf{n}_i = {}^i\mathbf{N}_i + {}^i\mathbf{R}_{i+1}\,{}^{i+1}\mathbf{n}_{i+1} + {}^i\mathbf{p}_{c,i} \times {}^i\mathbf{F}_i + {}^i\mathbf{p}_{i+1} \times {}^i\mathbf{R}_{i+1}\,{}^{i+1}\mathbf{f}_{i+1}

각 회전 관절의 토크

\tau_i = {}^i\mathbf{n}_i^T\,{}^i\mathbf{z}_i

5. 초기 조건

5.1 기저 조건

매니퓰레이터의 기저가 고정되어 있으면 다음의 초기 조건이 사용된다.

{}^0\boldsymbol{\omega}_0 = 0, \quad {}^0\dot{\boldsymbol{\omega}}_0 = 0

중력을 포함하기 위해

{}^0\dot{\mathbf{v}}_0 = -\mathbf{g}_0

여기서 \mathbf{g}_0는 중력 가속도 벡터이다.

5.2 말단 조건

매니퓰레이터의 말단에 외부 힘이 없으면 다음과 같다.

{}^{n+1}\mathbf{f}_{n+1} = 0, \quad {}^{n+1}\mathbf{n}_{n+1} = 0

말단에 외부 힘이 작용하면 그 값이 사용된다.

6. 효율성과 정확성

6.1 계산 복잡도

뉴턴-오일러 재귀 알고리즘의 계산 복잡도는 O(n)이며, 라그랑주 방법의 O(n^4)보다 훨씬 효율적이다.

6.2 수치 정확성

각 링크의 운동을 직접 계산하므로 수치 오차가 적다.

6.3 실시간 응용

효율성과 정확성 덕분에 실시간 제어와 시뮬레이션에 적합하다.

7. 응용 예시

7.1 자유도 산업 매니퓰레이터

표준 6자유도 산업 매니퓰레이터(예: PUMA, KUKA, ABB)의 동역학은 뉴턴-오일러 알고리즘으로 효율적으로 계산된다.

7.2 자유도 협동 매니퓰레이터

7자유도 협동 매니퓰레이터는 추가 자유도로 인한 잉여성 때문에 더 다양한 자세에서 작업이 가능하다. 동역학 해석도 같은 방법으로 수행된다.

8. 본 절의 의의

본 절은 다자유도 직렬 매니퓰레이터의 뉴턴-오일러 해석을 자세히 다루었다. 이 방법은 매니퓰레이터의 효율적이고 정확한 동역학 해석의 표준이다.

9. 참고 문헌

  • Spong, M. W., Hutchinson, S., & Vidyasagar, M. (2020). Robot Modeling and Control (2nd ed.). Wiley.
  • Featherstone, R. (2008). Rigid Body Dynamics Algorithms. Springer.
  • Craig, J. J. (2005). Introduction to Robotics: Mechanics and Control (3rd ed.). Pearson.
  • Luh, J. Y. S., Walker, M. W., & Paul, R. P. C. (1980). On-line computational scheme for mechanical manipulators. ASME Journal of Dynamic Systems, Measurement, and Control, 102(2), 69-76.

version: 1.0