15.47 계산 토크법과 라그랑주 동역학의 결합
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}
각 항이 명시적인 함수이다.
2.2 동역학 함수의 활용
계산 토크법은 이 명시적 함수를 직접 활용한다.
3. 계산 토크법의 명시적 형식
3.1 입력 변환
계산 토크법의 입력 변환은 다음과 같다.
\boldsymbol{\tau} = \mathbf{M}(\mathbf{q})\mathbf{u} + \mathbf{C}(\mathbf{q}, \dot{\mathbf{q}})\dot{\mathbf{q}} + \mathbf{g}(\mathbf{q})
각 항이 라그랑주 동역학으로부터 직접 계산된다.
3.2 명시적 형식의 의의
라그랑주 동역학은 닫힌 형식의 명시적 함수를 제공한다. 이는 계산 토크법의 분석과 구현에 유리하다.
4. 외부 루프의 설계
4.1 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})
4.2 PID 제어
적분 항을 추가하여 정상 상태 오차를 제거할 수 있다.
\mathbf{u} = \ddot{\mathbf{q}}_d + \mathbf{K}_v\dot{\mathbf{e}} + \mathbf{K}_p\mathbf{e} + \mathbf{K}_i\int\mathbf{e}\, dt
4.3 폐 루프 동역학
이상적인 모형의 경우 폐 루프는 선형 미분 방정식이 된다.
\ddot{\mathbf{e}} + \mathbf{K}_v\dot{\mathbf{e}} + \mathbf{K}_p\mathbf{e} = 0
게인의 적절한 선택으로 원하는 응답 특성을 달성한다.
5. 라그랑주 형식의 장점
5.1 명시적 항
라그랑주 방법은 관성 행렬, 코리올리/원심력 행렬, 중력 벡터의 명시적 형식을 제공한다. 이는 분석에 유리하다.
5.2 매개 변수에 대한 선형성
라그랑주 동역학 방정식은 매개 변수에 대해 선형이다. 이는 적응 제어와 매개 변수 식별에 활용된다.
\boldsymbol{\tau} = \mathbf{Y}(\mathbf{q}, \dot{\mathbf{q}}, \ddot{\mathbf{q}})\boldsymbol{\pi}
5.3 안정성 분석
라그랑주 형식의 동역학은 안정성 분석에 적합하다. 코리올리/원심력 행렬의 반대칭 성질이 핵심이다.
6. 구현
6.1 효율적 계산
라그랑주 형식의 동역학은 직접 계산하면 비효율적이다. 그러나 합성 강체 알고리즘(CRBA)과 결합하면 효율적이다.
6.2 라이브러리
매니퓰레이터 동역학 라이브러리(Pinocchio, RBDL 등)가 효율적인 계산을 제공한다.
6.3 자동 코드 생성
심볼릭 도구로 자동 생성된 코드가 계산 토크법의 효율적 구현에 사용된다.
7. 적응 계산 토크법
7.1 동기
매개 변수 불확실성에 대응하기 위해 적응 보상이 사용된다.
7.2 추정 매개 변수
매개 변수 \boldsymbol{\pi}를 온라인으로 추정한다.
7.3 제어 식
추정 매개 변수를 사용한 제어 식은 다음과 같다.
\boldsymbol{\tau} = \mathbf{Y}(\mathbf{q}, \dot{\mathbf{q}}, \mathbf{u})\hat{\boldsymbol{\pi}}
여기서 \hat{\boldsymbol{\pi}}는 매개 변수 추정값이다.
7.4 안정성 증명
리아푸노프 분석을 통해 적응 알고리즘의 안정성과 매개 변수 추정의 수렴이 증명된다.
8. 응용
8.1 산업 매니퓰레이터의 정밀 추종
산업 매니퓰레이터의 정밀 위치 제어와 궤적 추종에 사용된다.
8.2 협동 매니퓰레이터의 부드러운 운동
협동 매니퓰레이터의 부드럽고 예측 가능한 운동 생성에 활용된다.
8.3 휴머노이드 로봇
휴머노이드 로봇의 전신 운동 제어에 확장된 형태의 계산 토크법이 사용된다.
9. 본 절의 의의
본 절은 계산 토크법과 라그랑주 동역학의 결합을 다루었다. 라그랑주 형식의 명시적 동역학은 계산 토크법의 분석과 구현에 유리하며, 매니퓰레이터의 정밀 제어의 기반이다.
10. 참고 문헌
- 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