17.27 힘 제어를 위한 동역학 기초

1. 개요

힘 제어는 엔드 이펙터가 환경과 상호 작용하는 동안 원하는 접촉력을 유지하거나 일정한 접촉력 궤적을 따르도록 하는 제어 방식이다. 위치 제어가 기하학적 궤적 추종을 주된 목표로 하는 것과 달리, 힘 제어는 접촉 상태에서 로봇과 환경이 결합된 동적 시스템을 하나로 다루어야 하며, 이 결합 시스템의 특성이 제어 설계와 안정성을 결정한다. 본 절은 힘 제어기의 설계 이전에 확보되어야 할 동역학적 기초를 정리한다. 즉, 자유 운동과 접촉 운동의 통합된 방정식, 환경 임피던스의 효과, 접촉 안정성에 관련된 필수 조건, 그리고 힘 제어가 가능한 제어 구조의 전제 조건을 체계적으로 다룬다.

2. 결합 시스템의 동역학 방정식

로봇이 환경에 접촉한 상태에서 전체 운동은 관절 공간 동역학 방정식에 접촉 렌치가 추가된 형태로 기술된다.

$M(q)\ddot{q} + C(q,\dot{q})\dot{q} + g(q) + \tau_f = \tau - J_c(q)^\top \mathcal{F}_c$

여기서 $\mathcal{F}_c$ 는 환경이 엔드 이펙터에 가하는 접촉 렌치이며, $J_c(q)$ 는 접촉 자코비안이다. 작업 공간에서의 등가 표현은 다음과 같다.

$\Lambda(q)\ddot{x} + \mu(q,\dot{q})\dot{x} + p(q) = F - \mathcal{F}_c$

이 방정식은 엔드 이펙터의 가속도, 관성, 힘, 그리고 접촉력 사이의 관계를 명확히 보여준다. 힘 제어기는 $F$ 를 조작하여 $\mathcal{F}_c$ 가 원하는 값으로 수렴하도록 설계되며, 이때 환경의 응답 특성이 제어 설계의 핵심 변수가 된다.

3. 환경의 동역학 모델

접촉력은 로봇 단독의 운동에 의해 결정되지 않고, 환경의 변형 특성에 따라 결정된다. 가장 단순한 환경 모델은 탄성-감쇠 모델이며 다음과 같다.

$\mathcal{F}_c = K_e\,(x - x_e) + B_e\,\dot{x}$

여기서 $K_e$ 는 환경의 강성 행렬, $B_e$ 는 환경의 감쇠 행렬, $x_e$ 는 접촉 경계면의 위치이다. 딱딱한 환경( $K_e$ 가 매우 큼)에서는 작은 위치 변화도 큰 접촉력을 유발하므로 위치 제어만으로는 안정적인 힘 조절이 어렵다. 반면 부드러운 환경에서는 위치 오차가 크더라도 접촉력이 완만하게 변하므로 힘 제어의 여유가 상대적으로 크다. 이러한 특성은 힘 제어기의 이득 선택과 제어 구조에 결정적 영향을 미친다.

힘 제어의 전제 조건

힘 제어가 가능하려면 몇 가지 동역학적 전제 조건이 충족되어야 한다. 첫째, 접촉이 유지되어야 하므로 접촉점에서 법선력이 양의 값을 가져야 하며, 이는 관통 방향으로의 기준 궤적이 필요함을 의미한다. 둘째, 제어 대상인 접촉력은 센서 또는 추정기에 의해 충분한 대역폭으로 측정 가능해야 한다. 셋째, 로봇의 기계적 임피던스가 환경의 임피던스와 상충되지 않아야 한다. 환경이 매우 강성한 경우 로봇의 위치 제어형 구조는 오버슈트와 진동을 유발하므로, 역동역학 기반의 고대역폭 토크 제어나 저임피던스 엔드 이펙터 구조가 요구된다.

자유 공간과 접촉 공간의 분해

접촉 상태에서는 엔드 이펙터의 운동이 자유 방향과 구속 방향으로 분해된다. 구속 방향은 접촉 법선과 그에 연관된 축으로 구성되며, 자유 방향은 접촉면에 접하는 방향이다. 이러한 분해는 상호 수직인 두 부분공간으로 표현되며, 한 쪽에서는 위치 제어가, 다른 쪽에서는 힘 제어가 수행된다. 수학적으로 다음과 같은 투영 행렬이 정의된다.

$\ddot{x} = P_f \ddot{x}_{\text{force}} + P_p \ddot{x}_{\text{pos}}$

여기서 $P_f + P_p = I$ 이며 두 투영은 직교한다. 이러한 분해는 하이브리드 위치-힘 제어의 동역학적 기초가 되며, 동일 엔드 이펙터의 서로 다른 축에서 두 제어 모드를 동시에 수행할 수 있게 한다.

4. 접촉 안정성의 수동성 해석

접촉 시스템의 안정성은 단순한 이득 조정으로는 보장되지 않으며, 로봇과 환경이 결합된 시스템의 패시비티(passivity)에 의존한다. 환경이 수동 시스템이고 로봇 제어 블록 또한 수동이면, 두 수동 시스템의 피드백 결합은 항상 안정적이다. 이 성질은 힘 제어 설계에서 수동성을 유지하는 제어 구조를 선호하는 이론적 배경이다. 대표적으로 임피던스 제어는 에너지 형태의 리아푸노프 함수를 통해 수동성을 자연스럽게 보장하며, 위치-기반 또는 순수 힘-기반 제어는 과도한 이득에서 수동성이 깨질 수 있으므로 주의가 요구된다.

5. 힘 제어를 위한 내부 토크 루프

정밀한 힘 제어는 구동기가 지령받은 토크를 실제로 관절에 전달할 수 있는 능력에 의해 제약된다. 일반적 로봇 구동기는 고감속비 하모닉 드라이브나 유성 기어를 사용하므로 출력단의 토크는 구동기 전류와 단순 비례하지 않으며, 마찰과 탄성 변형이 개입한다. 이를 해결하기 위해 관절 토크 센서를 기반으로 한 내부 고대역폭 토크 루프가 요구되며, 이 루프는 바깥쪽 힘 제어 루프가 전제하는 이상적 토크원 가정을 근사적으로 구현한다. 이러한 계층 구조는 DLR LWR 및 KUKA LBR과 같은 토크 제어형 매니퓰레이터 설계에서 일반화된 방식이다.

6. 센서 대역폭과 시간 지연의 영향

힘 센서 측정값은 대개 잡음과 필터링에 의해 대역폭이 제한되며, 제어 루프의 샘플링 지연이 추가된다. 이러한 지연은 폐루프의 위상 여유를 감소시켜 접촉 상태의 안정 한계를 제한한다. 환경이 딱딱할수록 이 문제가 심각해지며, 이를 완화하기 위해 예측 관측기, 지연 보상, 낮은 제어 대역폭 설정이 사용된다. 접촉 안정성 확보를 위한 한 가지 전통적 지침은 힘 제어 대역폭이 기계 시스템의 주요 공진 주파수와 센서 대역폭의 일정 비율 이하여야 한다는 점이다.

7. 힘 제어 법칙의 기본 형식

가장 기본적인 힘 제어 법칙은 제어 대상 접촉력 $\mathcal{F}_c^d$ 와 실제 측정값 $\mathcal{F}_c$ 사이의 오차 $e_f = \mathcal{F}_c^d - \mathcal{F}_c$ 에 대한 보상 형태이다.

$F = \mathcal{F}_c^d + K_{Pf} e_f + K_{If} \int_0^t e_f\,d\tau$

위 제어 입력을 자코비안 전치를 통해 관절 토크로 변환하여 인가하며, 동역학 보상 항을 함께 포함하는 완전 형태는 다음과 같다.

$\tau = J^\top F + \hat{C}\dot{q} + \hat{g}$

이 구조는 순수 힘 제어(direct force control)에 해당하며, 환경의 임피던스가 완만할 때 안정적으로 작동한다. 딱딱한 환경에서는 임피던스 기반 접근이 선호되며, 이는 후속 절에서 상세히 논의된다.

8. 접촉 개시와 해제의 과도 상태

접촉이 시작되는 순간에는 유한한 충돌 에너지가 순간적으로 흡수되어야 하며, 접촉이 해제되는 순간에는 로봇의 관성이 자유 공간으로 방출되어 과도한 가속이 발생할 수 있다. 힘 제어 설계는 이러한 과도 상태에서도 안정성을 유지해야 하며, 이를 위해 접촉 검출 로직, 임피던스 적응, 에너지 탱크 기반 수동성 유지 기법 등이 사용된다. 특히 에너지 탱크 기법은 제어 블록이 방출하는 에너지를 유한한 자원으로 제한하여 수동성을 보장하는 실용적 도구이다.

9. 본 절의 의의

본 절은 힘 제어기가 설계되기 이전에 확보되어야 할 동역학적 기반을 체계적으로 정리하며, 결합 시스템의 방정식, 환경 모델, 접촉 안정성 조건, 토크 루프 구조, 센서 대역폭의 제약, 그리고 기본 힘 제어 법칙의 형태를 포괄한다. 이 기초는 이후 임피던스 제어, 어드미턴스 제어, 하이브리드 위치-힘 제어 설계가 공통적으로 의존하는 전제 조건을 형성하며, 환경과의 안전하고 정밀한 상호 작용을 가능케 한다.

10. 학습 권장사항

독자는 1자유도 질량-스프링 모델이 탄성 벽에 충돌하는 상황에서 PI 힘 제어기의 이득 변화에 따른 폐루프 응답을 시뮬레이션해 보고, 환경 강성과 이득 사이의 안정 한계를 관찰할 것을 권장한다. 또한 내부 토크 루프와 외부 힘 루프로 구성된 이중 계층 구조를 직접 구현하고, 두 루프의 대역폭 비율이 접촉 안정성에 미치는 영향을 분석하는 실습이 유익하다. 에너지 탱크 기반 수동성 유지 기법의 간단한 구현 예제를 통해 수동성 조건이 힘 제어 안정성에 기여하는 방식을 체험할 수 있다.

11. 참고 문헌

Raibert, M. H., & Craig, J. J. (1981). Hybrid position/force control of manipulators. Journal of Dynamic Systems, Measurement, and Control, 103(2), 126–133.
Hogan, N. (1985). Impedance control: An approach to manipulation. Journal of Dynamic Systems, Measurement, and Control, 107(1), 1–24.
Villani, L., & De Schutter, J. (2008). Force control. In Springer Handbook of Robotics, 161–185. Springer.
Siciliano, B., & Villani, L. (1999). Robot Force Control. Springer.
Albu-Schäffer, A., Ott, C., & Hirzinger, G. (2007). A unified passivity-based control framework for position, torque and impedance control of flexible joint robots. International Journal of Robotics Research, 26(1), 23–39.
Ferraguti, F., Secchi, C., & Fantuzzi, C. (2013). A tank-based approach to impedance control with variable stiffness. IEEE International Conference on Robotics and Automation.
De Luca, A., & Mattone, R. (2005). Sensorless robot collision detection and hybrid force/motion control. IEEE International Conference on Robotics and Automation.

version: 1.0