Compliant Explicit Reference Governor for Contact Friendly Robotic Manipulators

기술 요약: 접촉 친화적 로봇 매니퓰레이터를 위한 준거 Explicit Reference Governor

문제 제기
전통적인 로봇 운동 계획은 안전을 보장하기 위해 충돌 회피를 최우선으로 여기며, 환경 접촉을 종종 장애물로 간주합니다. 그러나 현대 로봇공학은 물리적 상호작용을 자원으로 활용하는 "접촉이 풍부한 (contact-rich)" 능력이 점점 더 요구되고 있습니다. 핵심적인 과제는 자유 운동과 접촉 사이의 전환을 관리하면서 두 가지 유형의 제약을 모두 만족시키는 데 있습니다:

1. 경성 제약 (Hard Constraints): 관절 범위, 토크 한계, 금지된 표면 등 협상할 수 없는 제한 사항.
2. 연성 제약 (Soft Constraints): 접촉이 허용되지만 안전하게 처리되어야 하는 조건들. 이러한 조건들은 로봇이 접촉을 완전히 피하거나 또는 특정 접촉 안전 제한 하에 작동해야 하는 매우 비볼록한 "OR" 조건을 생성합니다.

기존의 최적화 기반 전략 (예: 모델 예측 제어) 은 종종 제어 법칙의 전면적인 재설계와 접촉 역학의 복잡한 시간 가변 근사를 요구하여, 레거시 컨트롤러를 가진 실무자들에게 매력적이지 않습니다. 반면, 제어 장벽 함수 (Control Barrier Functions) 나 에너지 기반 준거 (compliance) 와 같은 계층적 접근법은 엄격한 제약 보장이나 점근적 안정성이 부족할 수 있습니다. 명시적 참조 관리 (Explicit Reference Governor, ERG) 는 하위 컨트롤러를 변경하지 않고 참조를 수정하는 계층적 안전 필터를 제공하지만, 이전 구현들은 접촉을 바람직하지 않은 것으로 간주하여 접촉 시 운동을 정지시켰습니다. 본 논문은 하위 레벨 컨트롤러를 수정하지 않고도 접촉 중 안전하고 연속적인 작동을 가능하게 하는 프레임워크의 필요성을 다룹니다.

방법론: 준거 Explicit Reference Governor (CERG)
저자들은 고수준 계획자와 저수준 컨트롤러 사이에 배치된 모듈형 참조 관리 시스템인 준거 Explicit Reference Governor (CERG) 를 제안합니다. CERG 는 사전 안정화된 컨트롤러로 전송되는 참조 신호 $v(t)$ 를 조작하여 운영 제약을 강제하고 자유 운동과 접촉 작동 간의 원활한 전환을 가능하게 합니다.

이 방법론은 세 가지 핵심 구성 요소에 의존합니다:

1. 사전 안정화 계층 (Pre-stabilization Layer): 중력 보상 기능이 있는 표준 PD 컨트롤러가 로봇을 참조 구성 $v$ 로 유도합니다. 시스템의 총 에너지 (운동 에너지 + 가상 위치 에너지) 는 Lyapunov 함수 $V(x, v)$ 로 정의되며, $v$ 가 일정할 때 단조 감소합니다.
2. 준거 동적 안전 마진 (Compliant Dynamic Safety Margin, DSM): 접촉 제약의 배타적 (OR) 성질을 처리하도록 설계된 DSM, $\Delta(x, v)$ 가 핵심 혁신입니다. 안전 조건은 다음과 같이 공식화됩니다:
   $$s(q(t)) < 0 \quad \lor \quad V(x(t), v(t)) \le E_{\max}$$
   여기서 $s(q) < 0$ 은 자유 운동을 나타내고 $V \le E_{\max}$ 는 에너지가 제한된 안전한 접촉을 나타냅니다. CERG 는 다음과 같은 복합 DSM 을 구성합니다:
   $$\Delta(x, v) = \min(\Delta_h, \max(\Delta_s, \Delta_E))$$
   • $\Delta_h$: 경성 제약 (관절 한계 등) 을 강제합니다.
   • $\Delta_s$: 연성 제약 표면 $s(q)$ 를 위한 궤적 기반 마진입니다.
   • $\Delta_E$: $\kappa_E(E_{\max} - V(x, v))$ 로 정의된 에너지 기반 마진입니다.
     이 구조는 로봇이 자유 운동 상태일 때 에너지 제약을 완화하고, 접촉이 발생하면 시스템 총 에너지를 $E_{\max}$ 로 엄격히 제한하도록 보장합니다.
3. 연성 항법장 (Soft Navigation Field, NF): 경성 제약이 참조를 밀어내는 것과 달리, CERG 는 참조 $v$ 가 제약 경계를 $\delta_s$ 한도까지 침투할 수 있게 하는 "연성" 반발장 $\rho_s(v)$ 를 사용합니다. 이 침투는 준거 접촉에 필요한 힘을 생성하는 데 필수적입니다. 전체 항법장은 목표에 대한 인력, 경성 제약에 대한 반발력, 그리고 이 연성 반발력을 결합합니다.

주요 기여
본 논문은 세 가지 주요 기여를 주장합니다:

• 모듈형 참조 필터링: 컨트롤러 재설계 없이 관절 각도, 속도, 토크 제약을 준수하면서 접촉 없는 운동과 접촉이 풍부한 운동 간의 원활한 전환을 가능하게 하는 프레임워크.
• 배타적 제약 처리: 접촉을 피하거나 접촉 중 제한된 에너지를 유지하는 것 중 하나를 증명 가능하게 만족시키도록 설계된 "OR 형" 제약 전용 안전 메커니즘.
• 에너지 기반 안전 가이드라인: 폐루프 시스템의 총 기계적 에너지 (위치 에너지 + 운동 에너지) 에 기반한 안전 지표. 이 지표는 좌표계 불변이며, 안정성 보장과 직접적으로 연결되고 해석이 용이합니다.

결과 및 검증
CERG 는 점점 더 복잡한 시스템에서 수치적 및 실험적으로 검증되었습니다:

• 2 링크 평면 암 (시뮬레이션): CERG 는 관절 공간 및 엔드 이펙터 컨트롤러 모두와 함께 테스트되었습니다. 결과는 CERG 가 이를 사용하지 않고 작동할 때보다 상호작용 힘을 성공적으로 감소시켰으며 에너지 한계를 준수했음을 보여주었습니다. 연구는 엔드 이펙터 공간 공식화가 카테시안 오차를 최소화하지만, 계층적 아키텍처에는 관절 공간 공식화가 더 바람직하다고 지적했습니다.
• Franka Emika Panda 시뮬레이션 (Drake): 마찰과 소산이 포함된 준거 접촉 모델을 사용하여, 암이 벽을 따라 미끄러지는 작업에 대해 CERG 를 테스트했습니다. 시뮬레이션은 CERG 가 접촉 중 $E_{\max}$ 한계를 준수한 반면, 접촉 시 정지하는 표준 ERG 와 수정되지 않은 시스템은 에너지 전환을 효과적으로 관리하지 못했음을 확인했습니다.
• 실제 실험 (Franka Emika Panda): 두 가지 작업이 수행되었습니다:
  1. 화이트보드 닦기: 에너지에 크게 민감하지 않은 작업. CERG, ERG, 임피던스 제어 모두 작업을 완료했지만, 접촉 중 경성 제약 (관절 속도 위반 방지) 과 에너지 한계를 강제한 것은 CERG 뿐이었습니다.
  2. 젱가 탑 밀기: 에너지에 매우 민감한 작업. 임피던스 컨트롤러는 관절 한계 위반 또는 탑 전도로 인해 실패했습니다. 표준 ERG 는 과도한 접촉 에너지로 인해 탑 전도를 방지하지 못해 실패했습니다. 오직 CERG 만이 접촉 중 $E_{\max}$ 를 엄격히 강제하면서 자유 운동 중에는 더 높은 에너지를 허용함으로써 탑을 전도시키지 않고 성공적으로 밀어냈습니다.

의의 및 주장
본 논문은 CERG 가 "플러그 앤 플레이" 안전 필터로 작용함으로써 접촉이 풍부한 조작을 위한 실용적인 해결책을 제공한다고 주장합니다. 그 의의는 전체 MPC 재설계의 계산적 부담이나 수정되지 않은 컨트롤러의 불안정성 위험 없이 로봇이 접촉을 위험이 아닌 자원으로 취급할 수 있게 한다는 점에 있습니다. 이 프레임워크는 총 시스템 에너지에 대한 증명 가능한 제약을 통해 안전을 보장하여 자유 운동과 접촉 간의 원활한 위상 전환을 가능하게 합니다. 저자들은 이 접근법이 실현 가능하고 효과적이며, 향후 작업은 CERG 를 작업 지향적 계획기와 인터페이스하는 방향으로 진행될 것이라고 결론지었습니다.