17.31 하이브리드 위치-힘 제어의 동역학적 기초

1. 개요

하이브리드 위치-힘 제어는 로봇 엔드 이펙터가 특정 방향으로는 정밀한 운동 궤적을 추종하면서 다른 방향으로는 원하는 접촉력을 유지해야 하는 작업에 적합한 제어 구조이다. 예를 들어 면을 따라 연마하는 작업에서는 면에 접한 방향으로는 속도와 위치가 지정되고, 면에 수직한 방향으로는 일정한 압력을 유지해야 한다. 이러한 작업은 단일 제어 목표가 아니라 작업 공간의 각 방향에 대해 서로 다른 제어 목표가 할당되는 다중 목표 구조이며, 이를 수학적으로 기술하기 위해서는 작업 공간을 위치 제어 부분공간과 힘 제어 부분공간으로 분해하는 체계적 접근이 요구된다. 본 절은 이러한 분해의 수학적 정의, 구속 기하학적 해석, 동역학 방정식으로의 통합, 제어 법칙의 기본 형식, 그리고 일관성 조건을 체계적으로 서술한다.

2. 작업 공간의 직교 분해

하이브리드 제어의 수학적 출발점은 작업 공간을 두 개의 상호 수직한 부분공간으로 분해하는 것이다. 접촉 상태에서 엔드 이펙터의 운동은 접촉면과 평행한 자유 방향과 접촉면에 수직한 구속 방향으로 분리될 수 있다. 이 분해는 선택 행렬을 통해 수학적으로 기술된다.

$S + \bar{S} = I,\qquad S\bar{S} = 0$

여기서 $S$ 는 힘 제어가 적용되는 방향을 선택하는 대각 또는 블록 대각 행렬이며, $\bar{S} = I - S$ 는 위치 제어가 적용되는 방향을 선택한다. 예컨대 접촉면 법선 방향에 해당하는 축에서 $S_{ii} = 1$ 이고, 나머지 축에서는 $\bar{S}_{ii} = 1$ 로 설정된다. 이 두 투영은 직교 관계에 있으며, 각 방향에서 독립적인 제어 목표가 할당된다.

구속 기하학과 인공적·자연적 구속

Mason의 구속 기하학(compliance frame formulation)에 따르면 접촉 상태의 자유 공간은 자연적 구속(natural constraints)과 인공적 구속(artificial constraints)의 결합으로 기술된다. 자연적 구속은 환경의 기하와 물리에 의해 강제되는 조건이며, 인공적 구속은 제어기가 부과하는 기준 운동 또는 기준 힘이다. 접촉면에서 일반적인 자연적 구속은 다음과 같다.

접촉면 법선 방향의 속도는 $0$ 이다.
접촉면 접선 방향의 힘은 마찰 원뿔 내부에 있다.

이에 대응하는 인공적 구속은 다음과 같이 명시된다.

접촉면 법선 방향의 힘을 원하는 값으로 유지한다.
접촉면 접선 방향의 속도 또는 위치를 원하는 궤적으로 제어한다.

자연적 구속과 인공적 구속은 서로 보완적이며, 동일 축에 두 종류의 구속이 동시에 할당될 수 없다. 이 원칙이 위치와 힘의 상호 배타적 분해를 정당화한다.

구속 자코비안과 동역학 방정식

접촉이 존재하는 상태에서 관절 공간 동역학 방정식은 다음과 같이 확장된다.

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

여기서 $J_c$ 는 접촉 자코비안이며 $\mathcal{F}_c$ 는 접촉 렌치이다. 하이브리드 제어는 이를 작업 공간으로 변환하여 다음과 같이 분해된 표현을 사용한다.

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

선택 행렬 $S$ 를 이용하면 힘 제어 부분과 위치 제어 부분에 각각 다음과 같은 관계가 주어진다.

$S\,\mathcal{F}_c = S\,F_d^{\text{force}}$

$\bar{S}\,(\ddot{x}) = \bar{S}\,\ddot{x}_d^{\text{pos}}$

이들이 동시에 성립하도록 $F$ 를 설계하며, 관절 토크는 $\tau = J^\top F + \text{dynamics compensation}$ 의 형태로 주어진다.

하이브리드 제어 법칙의 기본 형식

Raibert와 Craig가 제안한 원형 하이브리드 제어 법칙은 다음과 같은 구조를 가진다.

$F^{*} = \bar{S}\bigl(\ddot{x}_d + K_{dp}(\dot{x}_d - \dot{x}) + K_{pp}(x_d - x)\bigr) + S\bigl(\mathcal{F}_c^d + K_{pf}(\mathcal{F}_c^d - \mathcal{F}_c)\bigr)$

$F = \Lambda F^{*} + \mu\dot{x} + p$

$\tau = J^\top F + (I - J^\top J^{+\top})\tau_0$

위 법칙에서 첫째 항은 $\bar{S}$ 가 적용된 위치 제어 성분이며, 둘째 항은 $S$ 가 적용된 힘 제어 성분이다. 각 축에서 두 제어가 독립적으로 작동하도록 선택 행렬이 분리를 보장하며, 여유 자유도가 있는 경우 영공간 토크 $\tau_0$ 로 부과업이 추가된다. 이 법칙은 각 축에 대한 폐루프 오차 동역학을 선형화하여 설계 이득을 해석적으로 처리할 수 있게 한다.

3. 일관성 조건과 좌표계 선택

하이브리드 제어가 수학적으로 일관되게 동작하려면 위치와 힘의 분해가 동일한 좌표계에서 이루어져야 하며, 이 좌표계는 접촉의 기하학적 성질에 맞춰 순간적으로 정의되어야 한다. 예를 들어 곡면을 따르는 접촉에서는 접촉점의 법선 방향이 위치에 따라 변화하므로, 분해 기준 좌표계 역시 곡면의 기하에 동기화되어 회전한다. Lipkin과 Duffy는 이러한 분해가 단순 직교 좌표계에서만 이루어지면 좌표 변환에서 일관성이 파괴될 수 있음을 지적하였으며, 이를 해결하기 위해 운동과 힘을 각각 트위스트와 렌치로 보고 사영 기하에 기반한 분해를 수행하는 접근이 제안되었다. 이 관점은 올바른 좌표계 정의가 하이브리드 제어의 수학적 완결성을 결정함을 의미한다.

4. 선택 행렬의 시간 변동

작업 진행에 따라 접촉 상태나 작업 단계가 변화하면, 선택 행렬 $S$ 도 시간에 따라 변화할 수 있다. 이 경우 분해의 전환 순간에 불연속이 발생하여 제어 출력의 급격한 변화가 일어날 수 있으므로, 전환 시점에서 제어 입력을 부드럽게 연결하는 절차가 필요하다. 또한 선택 행렬이 작업의 단계에 따라 이산적으로 변하는 경우에는 각 단계에서 수동성 조건과 일관성 조건이 동시에 만족되는지를 별도로 확인해야 한다.

5. 환경 모델의 불확실성에 대한 취급

하이브리드 제어는 접촉면의 법선 방향이 정확히 알려져 있다는 가정에 의존하며, 이 정보의 부정확성은 서로 수직이어야 할 두 부분공간이 실제로는 기울어지는 결과를 낳는다. 이로 인해 힘 제어 방향에 위치 오차가 누적되고 위치 제어 방향에 힘 간섭이 발생할 수 있다. 이를 완화하기 위해 접촉 기하를 실시간으로 추정하는 기법과, 두 부분공간의 경계에서 부드러운 전이 영역을 도입하는 방식이 사용된다. 또한 임피던스 제어와 결합하여 경계 근방에서 순응적 거동을 허용하는 하이브리드 임피던스 접근이 제안되어 왔다.

6. 제어 안정성과 수동성

각 축에서 위치 제어와 힘 제어가 독립적으로 작동하는 이상적 조건에서, 하이브리드 제어의 안정성 해석은 각 축의 단일 제어 법칙에 대한 표준 해석으로 환원된다. 그러나 실제로는 동역학적 결합, 자코비안의 시간 변화, 환경 모델 오차 등이 두 축을 연결하므로 결합 안정성이 독립 안정성보다 엄격한 조건이 된다. 패시비티 기반 해석을 도입하면 두 제어 모드가 모두 수동 구조를 유지할 때 결합 시스템의 수동성이 보장되며, 이는 하이브리드 제어의 실무적 강건성을 확보하는 주요 근거가 된다.

7. 본 절의 의의

본 절은 하이브리드 위치-힘 제어의 수학적·동역학적 기초를 체계적으로 제시한다. 작업 공간의 직교 분해, 자연적·인공적 구속의 분류, 선택 행렬, 작업 공간 동역학과의 통합, 기본 제어 법칙, 좌표계의 일관성, 수동성 기반 결합 안정성은 모두 이 접근을 구현할 때 필수적으로 고려되어야 하는 요소이다. 이러한 기초는 조립, 연마, 연삭, 탐색, 협동 조작 등 힘과 운동을 동시에 지배해야 하는 실제 작업 환경에서 하이브리드 제어를 안정적이고 정확하게 구현하는 데 필요한 이론적 토대를 제공한다.

8. 학습 권장사항

독자는 평면 매니퓰레이터가 수평면을 따라 접촉하면서 수직 방향의 힘을 일정하게 유지하는 시나리오에 대해 하이브리드 제어 법칙을 직접 구현해 볼 것을 권장한다. 이 과정에서 선택 행렬의 정의, 접촉 자코비안의 계산, 작업 공간 동역학 보상의 구성 요소를 명시적으로 다뤄보면 이론과 구현 사이의 간격이 좁혀진다. 또한 접촉면의 기울기에 작은 오차를 인위적으로 부여하여 두 부분공간의 간섭이 성능에 미치는 영향을 관찰하고, 임피던스 특성을 일부 부여한 수정된 하이브리드 구조와 비교해 보는 실습이 유익하다.

9. 참고 문헌

Raibert, M. H., & Craig, J. J. (1981). Hybrid position/force control of manipulators. Journal of Dynamic Systems, Measurement, and Control, 103(2), 126–133.
Mason, M. T. (1981). Compliance and force control for computer controlled manipulators. IEEE Transactions on Systems, Man, and Cybernetics, 11(6), 418–432.
Khatib, O. (1987). A unified approach for motion and force control of robot manipulators: The operational space formulation. IEEE Journal of Robotics and Automation, 3(1), 43–53.
Lipkin, H., & Duffy, J. (1988). Hybrid twist and wrench control for a robotic manipulator. Journal of Mechanisms, Transmissions, and Automation in Design, 110(2), 138–144.
Duffy, J. (1990). The fallacy of modern hybrid control theory that is based on orthogonal complements of twist and wrench spaces. Journal of Robotic Systems, 7(2), 139–144.
Siciliano, B., & Villani, L. (1999). Robot Force Control. Springer.
De Schutter, J., De Laet, T., Rutgeerts, J., Decré, W., Smits, R., Aertbeliën, E., Claes, K., & Bruyninckx, H. (2007). Constraint-based task specification and estimation for sensor-based robot systems in the presence of geometric uncertainty. International Journal of Robotics Research, 26(5), 433–455.

version: 1.0