15.46 계산 토크법의 원리
1. 개요
계산 토크법(computed torque method)은 매니퓰레이터의 동역학 모형을 활용하여 비선형성을 정확히 보상하는 모형 기반 제어 기법이다. 이는 매니퓰레이터의 정밀 제어의 표준 방법 중 하나이다. 본 절에서는 계산 토크법의 원리를 다룬다.
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}
2.2 입력 변환
계산 토크법은 다음과 같은 입력 변환을 도입한다.
\boldsymbol{\tau} = \mathbf{M}(\mathbf{q})\mathbf{u} + \mathbf{C}(\mathbf{q}, \dot{\mathbf{q}})\dot{\mathbf{q}} + \mathbf{g}(\mathbf{q})
여기서 \mathbf{u}는 새로운 가상 입력이다.
2.3 결과
이 입력 변환을 동역학 방정식에 대입하면
\mathbf{M}(\mathbf{q})\ddot{\mathbf{q}} + \mathbf{C}(\mathbf{q}, \dot{\mathbf{q}})\dot{\mathbf{q}} + \mathbf{g}(\mathbf{q}) = \mathbf{M}(\mathbf{q})\mathbf{u} + \mathbf{C}(\mathbf{q}, \dot{\mathbf{q}})\dot{\mathbf{q}} + \mathbf{g}(\mathbf{q})
이는
\ddot{\mathbf{q}} = \mathbf{u}
즉, 입력 변환 후 시스템이 단순한 적분기 사슬이 된다.
3. 외부 루프 제어
3.1 선형 시스템
내부 변환으로 인해 시스템이 선형이 된 후 외부 루프에서 선형 제어를 적용한다.
3.2 PD 제어
가장 단순한 외부 루프 제어는 PD 제어이다.
\mathbf{u} = \ddot{\mathbf{q}}_d + \mathbf{K}_v(\dot{\mathbf{q}}_d - \dot{\mathbf{q}}) + \mathbf{K}_p(\mathbf{q}_d - \mathbf{q})
여기서 \mathbf{K}_p, \mathbf{K}_v는 양정행렬인 게인이다.
3.3 폐 루프 동역학
이 외부 루프 제어와 내부 변환을 결합하면 폐 루프 동역학은 다음과 같다.
\ddot{\mathbf{e}} + \mathbf{K}_v\dot{\mathbf{e}} + \mathbf{K}_p\mathbf{e} = 0
여기서 \mathbf{e} = \mathbf{q}_d - \mathbf{q}는 추종 오차이다.
3.4 수렴
폐 루프가 선형이고 게인이 양정이면 오차가 0으로 점근 수렴한다.
4. 계산 토크법의 성질
4.1 비선형성의 정확한 보상
이상적인 모형의 경우 계산 토크법은 매니퓰레이터의 비선형성을 정확히 보상한다. 폐 루프가 정확히 선형이 된다.
4.2 추종 성능
폐 루프가 선형이므로 게인을 통해 원하는 추종 성능을 달성할 수 있다.
4.3 모형 의존성
계산 토크법은 정확한 동역학 모형을 필요로 한다. 모형 오차가 있으면 폐 루프 성능이 저하된다.
5. 부분 보상
5.1 중력만 보상
전체 동역학 모형 대신 중력만 보상하는 단순화된 형식이 가능하다.
\boldsymbol{\tau} = \mathbf{g}(\mathbf{q}) + \mathbf{K}_p(\mathbf{q}_d - \mathbf{q}) - \mathbf{K}_v\dot{\mathbf{q}}
이는 단순하고 효과적이며 정적 추종에 충분하다.
5.2 단순화의 트레이드오프
부분 보상은 계산 부담을 줄이지만 동적 추종 성능이 떨어진다.
6. 모형 오차의 영향
6.1 매개 변수 불확실성
매니퓰레이터의 매개 변수가 정확히 알려지지 않으면 폐 루프 성능이 저하된다.
6.2 강건성
모형 오차에 대한 강건성을 위해 추가 기법이 필요하다.
6.3 적응 보상
매개 변수의 온라인 추정과 보상이 가능하다(적응 제어).
7. 계산 효율성
7.1 동역학 함수 평가
계산 토크법은 매 제어 주기마다 동역학 함수 \mathbf{M}, \mathbf{C}, \mathbf{g}의 평가가 필요하다.
7.2 효율적 알고리즘
뉴턴-오일러 재귀 알고리즘을 사용하면 효율적으로 계산할 수 있다.
7.3 실시간 응용
효율적인 알고리즘 덕분에 실시간 응용이 가능하다.
8. 변형
8.1 작업 공간 계산 토크
작업 공간에서 직접 계산 토크법을 적용할 수 있다.
\mathbf{F}_x = \mathbf{\Lambda}(\mathbf{q})\mathbf{u}_x + \boldsymbol{\mu}(\mathbf{q}, \dot{\mathbf{q}}) + \mathbf{p}(\mathbf{q})
8.2 강건 제어와의 결합
계산 토크법과 강건 제어 기법(슬라이딩 모드 등)을 결합할 수 있다.
8.3 적응 제어와의 결합
적응 매개 변수 추정을 결합한 적응 계산 토크법이 있다.
9. 응용
9.1 산업 매니퓰레이터의 정밀 제어
산업 매니퓰레이터의 빠른 정밀 운동에 사용된다.
9.2 협동 매니퓰레이터
협동 매니퓰레이터의 부드럽고 정확한 운동에 활용된다.
9.3 휴머노이드 로봇
휴머노이드 로봇의 전신 운동 제어의 기반이 된다.
10. 본 절의 의의
본 절은 계산 토크법의 원리를 다루었다. 계산 토크법은 매니퓰레이터의 정밀 제어의 핵심 기법이며, 라그랑주 동역학 모형을 활용한다.
11. 참고 문헌
- Spong, M. W., Hutchinson, S., & Vidyasagar, M. (2020). Robot Modeling and Control (2nd ed.). Wiley.
- Slotine, J.-J. E., & Li, W. (1991). Applied Nonlinear Control. Prentice Hall.
- Siciliano, B., Sciavicco, L., Villani, L., & Oriolo, G. (2010). Robotics: Modelling, Planning and Control. Springer.
- Asada, H., & Slotine, J.-J. E. (1986). Robot Analysis and Control. Wiley.
version: 1.0