15.22 중력 벡터의 라그랑주 형식 유도
1. 개요
매니퓰레이터의 동역학 방정식에서 중력 벡터 \mathbf{g}(\mathbf{q})는 중력에 의한 일반화 토크를 나타낸다. 라그랑주 방정식에서 중력 벡터는 위치 에너지의 기울기로 직접 유도된다. 본 절에서는 중력 벡터의 라그랑주 형식의 유도와 그 성질을 다룬다.
2. 위치 에너지로부터의 유도
2.1 라그랑지언
매니퓰레이터의 라그랑지언은 다음과 같다.
L(\mathbf{q}, \dot{\mathbf{q}}) = T(\mathbf{q}, \dot{\mathbf{q}}) - U(\mathbf{q})
2.2 라그랑주 방정식의 위치 에너지 항
라그랑주 방정식에서 위치 에너지 항은 다음과 같이 등장한다.
-\frac{\partial L}{\partial q_i} = -\frac{\partial T}{\partial q_i} + \frac{\partial U}{\partial q_i}
이 중 \frac{\partial U}{\partial q_i} 항이 중력 토크에 해당한다.
2.3 중력 벡터의 정의
매니퓰레이터의 중력 벡터는 다음과 같이 정의된다.
g_i(\mathbf{q}) = \frac{\partial U(\mathbf{q})}{\partial q_i}
또는 벡터 형식으로
\mathbf{g}(\mathbf{q}) = \nabla_{\mathbf{q}}U(\mathbf{q})
3. 위치 에너지의 표현
3.1 균일 중력장
매니퓰레이터의 작업 환경은 일반적으로 균일 중력장으로 모형화된다. 이 경우 위치 에너지는 다음과 같다.
U(\mathbf{q}) = \sum_{i=1}^{n}m_i g h_i(\mathbf{q})
여기서 m_i는 링크 i의 질량, g는 중력 가속도의 크기, h_i(\mathbf{q})는 링크 i의 질량 중심의 높이이다.
3.2 일반적 표현
균일 중력장에서 더 일반적인 표현은 다음과 같다.
U(\mathbf{q}) = -\sum_{i=1}^{n}m_i \mathbf{g}_0^T \mathbf{r}_{c,i}(\mathbf{q})
여기서 \mathbf{g}_0는 중력 가속도 벡터(예: \mathbf{g}_0 = (0, 0, -g)^T)이고 \mathbf{r}_{c,i}(\mathbf{q})는 링크 i의 질량 중심의 위치이다.
4. 중력 벡터의 명시적 형식
4.1 미분의 적용
위치 에너지의 정의에 미분을 적용하면
g_j(\mathbf{q}) = \frac{\partial U}{\partial q_j} = -\sum_{i=1}^{n}m_i\mathbf{g}_0^T\frac{\partial \mathbf{r}_{c,i}}{\partial q_j}
4.2 자코비안의 활용
\frac{\partial \mathbf{r}_{c,i}}{\partial q_j}는 링크 i의 질량 중심의 선속도 자코비안의 j번째 열이다.
\frac{\partial \mathbf{r}_{c,i}}{\partial q_j} = (\mathbf{J}_{v,i})_{(:,j)}
따라서 중력 벡터는 다음과 같이 표현된다.
\mathbf{g}(\mathbf{q}) = -\sum_{i=1}^{n}m_i \mathbf{J}_{v,i}^T(\mathbf{q})\mathbf{g}_0
4.3 행렬 형식
이는 매우 우아한 행렬 형식이다. 모든 링크에 대한 중력의 효과가 자코비안의 전치를 통해 일반화 좌표로 변환된다.
5. 중력 벡터의 성질
5.1 자세 의존성
중력 벡터는 일반화 좌표 \mathbf{q}의 함수이며, 매니퓰레이터의 자세에 따라 변한다.
5.2 속도 무관성
중력 벡터는 일반화 속도에 의존하지 않는다. 매니퓰레이터가 정지해 있을 때도 중력 토크가 작용한다.
5.3 보존성
중력 벡터는 보존력이며, 위치 에너지의 기울기로 표현된다.
\mathbf{g}(\mathbf{q}) = \nabla_{\mathbf{q}}U(\mathbf{q})
따라서 중력 토크에 의한 일은 경로에 의존하지 않고 시작점과 끝점의 위치 에너지의 차이에 해당한다.
5.4 한계
매니퓰레이터의 중력 벡터의 크기는 자세에 따라 달라지지만 일반적으로 한계가 있다.
\Vert\mathbf{g}(\mathbf{q})\Vert \leq g_{\max}
이 한계는 매니퓰레이터의 매개 변수에 의존한다.
6. 매니퓰레이터의 동역학 방정식에서의 역할
6.1 표준 형식
매니퓰레이터의 동역학 방정식은 다음과 같다.
\mathbf{M}(\mathbf{q})\ddot{\mathbf{q}} + \mathbf{C}(\mathbf{q}, \dot{\mathbf{q}})\dot{\mathbf{q}} + \mathbf{g}(\mathbf{q}) = \boldsymbol{\tau}
중력 벡터는 동역학 방정식의 세 번째 항이다.
6.2 정적 평형
매니퓰레이터가 정지 상태에서 평형을 유지하기 위해서는 액추에이터 토크가 중력 벡터와 같아야 한다.
\boldsymbol{\tau}_{\text{static}} = \mathbf{g}(\mathbf{q})
이는 정적 토크 분석의 기반이다.
6.3 중력 보상
매니퓰레이터의 제어에서 중력 보상은 중력 벡터를 피드포워드로 더하는 것이다.
\boldsymbol{\tau} = \mathbf{g}(\mathbf{q}) + \boldsymbol{\tau}_{\text{fb}}
이는 매니퓰레이터의 정적 평형 유지와 부드러운 운동에 도움이 된다.
7. 응용 예시: 2자유도 평면 매니퓰레이터
7.1 위치 에너지
수직 평면의 2자유도 매니퓰레이터의 위치 에너지는 다음과 같다.
U(\mathbf{q}) = m_1 g l_{c1}\sin q_1 + m_2 g(l_1 \sin q_1 + l_{c2}\sin(q_1 + q_2))
7.2 편미분
\frac{\partial U}{\partial q_1} = m_1 g l_{c1}\cos q_1 + m_2 g(l_1\cos q_1 + l_{c2}\cos(q_1 + q_2))
\frac{\partial U}{\partial q_2} = m_2 g l_{c2}\cos(q_1 + q_2)
7.3 중력 벡터
\mathbf{g}(\mathbf{q}) = \begin{bmatrix} m_1 g l_{c1}\cos q_1 + m_2 g(l_1\cos q_1 + l_{c2}\cos(q_1 + q_2)) \\ m_2 g l_{c2}\cos(q_1 + q_2) \end{bmatrix}
8. 본 절의 의의
본 절은 라그랑주 형식의 중력 벡터 유도를 다루었다. 중력 벡터는 매니퓰레이터의 정적 분석과 제어에 핵심적이며, 라그랑주 방법에서 자연스럽게 유도된다.
9. 참고 문헌
- 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.
- Siciliano, B., Sciavicco, L., Villani, L., & Oriolo, G. (2010). Robotics: Modelling, Planning and Control. Springer.
- Featherstone, R. (2008). Rigid Body Dynamics Algorithms. Springer.
version: 1.0