15.35 라그랑주 운동 방정식의 행렬 형식
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{M}(\mathbf{q}) \in \mathbb{R}^{n \times n}: 관성 행렬
- \mathbf{C}(\mathbf{q}, \dot{\mathbf{q}}) \in \mathbb{R}^{n \times n}: 코리올리/원심력 행렬
- \mathbf{g}(\mathbf{q}) \in \mathbb{R}^{n}: 중력 벡터
- \boldsymbol{\tau} \in \mathbb{R}^{n}: 일반화 힘 벡터
2.2 차원
매니퓰레이터의 자유도가 n이면 위의 모든 양은 n차원이다.
3. 각 항의 의미
3.1 관성 행렬
관성 행렬 \mathbf{M}(\mathbf{q})는 운동 에너지의 이차 형식의 계수 행렬이다.
T = \frac{1}{2}\dot{\mathbf{q}}^T\mathbf{M}(\mathbf{q})\dot{\mathbf{q}}
이는 시스템의 관성 분포를 일반화 좌표 공간에서 표현한다.
3.2 코리올리/원심력 행렬
코리올리/원심력 행렬 \mathbf{C}(\mathbf{q}, \dot{\mathbf{q}})는 일반화 속도와 관련된 비선형 항을 표현한다.
[\mathbf{C}\dot{\mathbf{q}}]_i = \sum_{j,k}c_{ijk}(\mathbf{q})\dot{q}_j\dot{q}_k
여기서 c_{ijk}는 크리스토펠 기호의 1종이다.
3.3 중력 벡터
중력 벡터 \mathbf{g}(\mathbf{q})는 위치 에너지의 기울기이다.
\mathbf{g}(\mathbf{q}) = \nabla_{\mathbf{q}}U(\mathbf{q})
3.4 일반화 힘 벡터
\boldsymbol{\tau}는 액추에이터 토크와 외력의 합이다.
\boldsymbol{\tau} = \boldsymbol{\tau}_{\text{actuator}} + \mathbf{J}^T\mathbf{F}_{\text{ext}}
4. 행렬 형식의 성질
4.1 관성 행렬의 대칭성
관성 행렬은 대칭이다.
\mathbf{M}^T = \mathbf{M}
4.2 관성 행렬의 양정치성
관성 행렬은 양정행렬이다.
\mathbf{x}^T\mathbf{M}(\mathbf{q})\mathbf{x} > 0, \quad \forall \mathbf{x} \neq 0
4.3 코리올리/원심력 행렬의 반대칭 성질
\dot{\mathbf{M}} - 2\mathbf{C}는 반대칭이다.
\dot{\mathbf{M}}(\mathbf{q}) - 2\mathbf{C}(\mathbf{q}, \dot{\mathbf{q}}) = -(\dot{\mathbf{M}}(\mathbf{q}) - 2\mathbf{C}(\mathbf{q}, \dot{\mathbf{q}}))^T
이 성질은 매니퓰레이터의 안정성 분석에 핵심적으로 사용된다.
5. 변형된 형식
5.1 마찰을 포함한 형식
관절 마찰을 포함하면 다음과 같이 확장된다.
\mathbf{M}\ddot{\mathbf{q}} + \mathbf{C}\dot{\mathbf{q}} + \mathbf{B}\dot{\mathbf{q}} + \mathbf{g} = \boldsymbol{\tau}
여기서 \mathbf{B}는 점성 마찰 행렬이다.
5.2 외력을 포함한 형식
말단의 외력 또는 환경 접촉력을 포함하면
\mathbf{M}\ddot{\mathbf{q}} + \mathbf{C}\dot{\mathbf{q}} + \mathbf{g} = \boldsymbol{\tau} + \mathbf{J}_e^T\mathbf{F}_e
여기서 \mathbf{J}_e는 말단의 자코비안이고 \mathbf{F}_e는 외력이다.
5.3 구속을 포함한 형식
구속이 있는 시스템에서 라그랑주 곱셈수가 도입된다.
\mathbf{M}\ddot{\mathbf{q}} + \mathbf{C}\dot{\mathbf{q}} + \mathbf{g} - \boldsymbol{\Phi}_q^T\boldsymbol{\lambda} = \boldsymbol{\tau}
6. 상태 공간 형식
6.1 상태 변수
상태 공간 표현을 위해 다음의 상태 변수를 정의한다.
\mathbf{x} = \begin{bmatrix} \mathbf{q} \\ \dot{\mathbf{q}} \end{bmatrix}
6.2 상태 방정식
매니퓰레이터의 동역학은 다음의 1차 미분 방정식으로 표현된다.
\dot{\mathbf{x}} = \begin{bmatrix} \dot{\mathbf{q}} \\ \mathbf{M}^{-1}(\mathbf{q})(\boldsymbol{\tau} - \mathbf{C}(\mathbf{q}, \dot{\mathbf{q}})\dot{\mathbf{q}} - \mathbf{g}(\mathbf{q})) \end{bmatrix}
이는 시뮬레이션과 제어 분석에 사용된다.
7. 행렬 형식의 응용
7.1 안정성 분석
행렬 형식은 매니퓰레이터의 안정성 분석에 적합하다. 관성 행렬과 코리올리/원심력 행렬의 성질이 분석에 활용된다.
7.2 제어 설계
모형 기반 제어 설계는 행렬 형식의 동역학에 기반한다.
7.3 매개 변수 식별
회귀 행렬 형식으로 변환하여 매개 변수 식별을 수행한다.
\boldsymbol{\tau} = \mathbf{Y}(\mathbf{q}, \dot{\mathbf{q}}, \ddot{\mathbf{q}})\boldsymbol{\pi}
7.4 시뮬레이션
상태 공간 형식의 동역학은 수치 적분으로 시뮬레이션된다.
8. 응용 예시: 2자유도 매니퓰레이터
8.1 행렬 형식
\begin{bmatrix} M_{11} & M_{12} \\ M_{12} & M_{22} \end{bmatrix}\begin{bmatrix} \ddot{q}_1 \\ \ddot{q}_2 \end{bmatrix} + \begin{bmatrix} C_{11} & C_{12} \\ C_{21} & C_{22} \end{bmatrix}\begin{bmatrix} \dot{q}_1 \\ \dot{q}_2 \end{bmatrix} + \begin{bmatrix} g_1 \\ g_2 \end{bmatrix} = \begin{bmatrix} \tau_1 \\ \tau_2 \end{bmatrix}
각 성분이 자세와 속도의 함수이다.
9. 본 절의 의의
본 절은 라그랑주 운동 방정식의 행렬 형식을 다루었다. 이 형식은 매니퓰레이터의 동역학 분석, 제어 설계, 시뮬레이션의 표준 표현이다.
10. 참고 문헌
- Spong, M. W., Hutchinson, S., & Vidyasagar, M. (2020). Robot Modeling and Control (2nd ed.). Wiley.
- Murray, R. M., Li, Z., & Sastry, S. S. (1994). A Mathematical Introduction to Robotic Manipulation. CRC Press.
- Slotine, J.-J. E., & Li, W. (1991). Applied Nonlinear Control. Prentice Hall.
- Featherstone, R. (2008). Rigid Body Dynamics Algorithms. Springer.
version: 1.0