40.14 관절 토크 및 관절력의 최종 산출
관절 토크와 관절력의 최종 산출은 RNEA의 최종 목적이다. 후방 재귀에서 계산한 관절 힘과 모멘트로부터 각 관절의 구동 토크 또는 힘을 추출한다. 본 절에서는 관절 토크 및 관절력의 최종 산출을 학술적으로 다룬다.
1. 최종 출력
1.1 관절 토크 벡터
\vec{\tau} = [\tau_1, \tau_2, \ldots, \tau_n]^\top이다.
1.2 역동역학 해
역동역학 문제의 해이다.
1.3 제어 입력
제어 시스템의 입력 토크이다.
2. 회전 관절
2.1 추출 공식
\tau_i = {}^i\vec{n}_i^\top \cdot {}^i\hat{z}_i
40.14.2.2 관절 축 투영
관절 모멘트를 관절 축에 투영한다.
40.14.2.3 스칼라 결과
스칼라 토크 값이다.
40.14.3 직동 관절
40.14.3.1 추출 공식
f_i = {}^i\vec{f}_i^\top \cdot {}^i\hat{z}_i
2.2 관절 힘
직동 관절은 힘이다.
2.3 스칼라 결과
스칼라 힘 값이다.
3. 관절 유형 통합
3.1 일반화 힘
회전 토크와 직동 힘이 모두 일반화 힘이다.
3.2 통일된 벡터
\vec{\tau} 벡터로 통일된다.
3.3 학술적 표현
학술적으로 통일된 표현이다.
4. 마찰 포함
4.1 마찰 토크
관절 마찰 토크를 추가할 수 있다.
4.2 확장 공식
\tau_i = {}^i\vec{n}_i^\top \cdot {}^i\hat{z}_i + \tau_{f,i}
40.14.5.3 실무적 모델
실무적 모델이 마찰을 포함한다.
40.14.6 구동기 고려
40.14.6.1 감속기
감속기 고려가 필요할 수 있다.
40.14.6.2 반사 관성
반사 관성이 포함될 수 있다.
40.14.6.3 모터 토크
모터 측 토크로 변환한다.
40.14.7 검증
40.14.7.1 차원 확인
벡터 차원의 확인이다.
40.14.7.2 정적 평형
정적 구성에서 \vec{\tau} = \vec{G}가 된다.
40.14.7.3 대칭성
특정 구성의 대칭성을 확인한다.
40.14.8 응용
40.14.8.1 컴퓨터 토크 제어
컴퓨터 토크 제어의 입력이다.
40.14.8.2 시뮬레이션
시뮬레이션에 활용된다.
40.14.8.3 궤적 최적화
궤적 최적화에 활용된다.
40.14.9 실시간 계산
40.14.9.1 O(n) 복잡도
전체 알고리즘이 O(n)이다.
40.14.9.2 실시간 가능
실시간 계산이 가능하다.
40.14.9.3 고성능
고성능 제어의 기반이다.
40.14.10 학술적 활용
본 절에서 다룬 관절 토크 및 관절력의 최종 산출은 RNEA의 최종 단계이다. 체계적 토크 추출이 역동역학 문제의 완전한 해결을 제공한다.
출처
- 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.
버전
- 문서 버전: 1.0
- 작성일: 2026-04-18