40.13 후방 재귀: 힘과 토크의 역방향 전파
힘과 토크의 역방향 전파는 후방 재귀의 핵심이다. 엔드 이펙터로부터 기저 방향으로 관절 힘과 모멘트를 순차적으로 계산하여 최종적으로 관절 토크를 얻는다. 본 절에서는 힘과 토크의 역방향 전파를 학술적으로 다룬다.
1. 역방향 전파의 개념
1.1 방향
엔드 이펙터에서 기저 방향이다.
1.2 순서
링크 n, n-1, \ldots, 1 순이다.
1.3 재귀적 계산
이전 결과를 활용한 재귀이다.
2. 힘 평형 방정식
2.1 뉴턴 방정식
각 링크에 대한 뉴턴 방정식이다.
2.2 관절 힘
\vec{f}_i가 이전 링크로부터의 관절 힘이다.
2.3 계산 공식
\vec{f}_i = {}^i\mathbf{R}_{i+1} \vec{f}_{i+1} + m_i \vec{a}_{c_i}
40.13.3 힘 평형의 해석
40.13.3.1 다음 링크 힘
다음 링크에서 전달된 힘이다.
40.13.3.2 링크 관성력
링크 자체의 관성력이다.
40.13.3.3 합
두 힘의 합이 현재 관절 힘이다.
40.13.4 모멘트 평형 방정식
40.13.4.1 오일러 방정식
각 링크에 대한 오일러 방정식이다.
40.13.4.2 관절 모멘트
\vec{n}_i가 이전 링크로부터의 관절 모멘트이다.
40.13.4.3 계산 공식
\vec{n}_i = {}^i\mathbf{R}_{i+1} \vec{n}_{i+1} + \vec{r}_{c_i} \times m_i \vec{a}_{c_i} + \vec{r}_{i,c_i} \times ({}^i\mathbf{R}_{i+1} \vec{f}_{i+1}) + \mathbf{I}_i \dot{\vec{\omega}}_i + \vec{\omega}_i \times (\mathbf{I}_i \vec{\omega}_i)
3. 모멘트 평형의 해석
3.1 다음 모멘트 전달
다음 링크로부터의 모멘트이다.
3.2 관성력 모멘트
링크 관성력의 모멘트이다.
3.3 다음 관절 힘 모멘트
다음 관절 힘의 모멘트이다.
3.4 관성 모멘트
링크 자체의 관성 모멘트이다.
4. 좌표계 변환
4.1 변환 행렬
{}^i\mathbf{R}_{i+1}이다.
4.2 역순 변환
i+1 좌표계에서 i 좌표계로 변환한다.
4.3 재귀 중 적용
재귀 중 변환이 적용된다.
5. 엔드 이펙터 초기 조건
5.1 외력 없음
외력이 없으면 \vec{f}_{n+1} = \vec{n}_{n+1} = \vec{0}이다.
5.2 외력 있음
외력이 있으면 초기 조건에 포함된다.
5.3 재귀 시작
이 조건에서 재귀가 시작된다.
6. 전방 재귀 결과 활용
6.1 운동학적 양
전방 재귀의 운동학적 양을 활용한다.
6.2 필수 입력
필수 입력이다.
6.3 완전한 정보
완전한 정보를 제공한다.
7. 관절 토크 추출
7.1 관절 축 투영
관절 모멘트를 축에 투영한다.
7.2 회전 관절
\tau_i = \vec{n}_i^\top \hat{z}_i이다.
7.3 직동 관절
\tau_i = \vec{f}_i^\top \hat{z}_i이다.
8. 학술적 활용
본 절에서 다룬 후방 재귀의 힘과 토크의 역방향 전파는 RNEA의 핵심이다. 체계적 역방향 전파가 정확한 관절 토크 계산의 학술적 기반이 된다.
9. 출처
- Luh, J. Y. S., Walker, M. W., and Paul, R. P. C., “On-line computational scheme for mechanical manipulators”, Journal of Dynamic Systems, Measurement, and Control, Vol. 102, No. 2, pp. 69–76, 1980.
- Craig, J. J., Introduction to Robotics: Mechanics and Control, 4th edition, Pearson, 2018.
- Featherstone, R., Rigid Body Dynamics Algorithms, Springer, 2008.
- Spong, M. W., Hutchinson, S., and Vidyasagar, M., Robot Modeling and Control, 2nd edition, Wiley, 2020.
- Siciliano, B., Sciavicco, L., Villani, L., and Oriolo, G., Robotics: Modelling, Planning and Control, Springer, 2009.
10. 버전
- 문서 버전: 1.0
- 작성일: 2026-04-18