Constrained Whole-Body Tracking for Humanoid Robots

Motivation

• Known: 인간형 로봇의 전신 제어에서 강화학습 기반 접근법이 민첩성을 입증했으나, 훈련 후 명시되는 안전 제약조건 만족이 과제로 남아있다. operational space control과 control barrier functions은 최적화 기반 제어에서 안전을 강제하는 데 사용되어 왔다.
• Gap: 기존 humanoid에 대한 CBF 연구는 축약된 동적 모델을 사용하거나 locomotion에만 집중했으며, 전신 모션 추적 정책에 대한 contact-constrained 동역학 기반 안전 강제는 미흡하다.
• Why: 실제 배포 환경에서 사전 정의되지 않은 안전 제약조건이 발생하므로, 훈련된 정책을 수정하지 않으면서 런타임에 임의의 제약조건을 강제할 수 있는 정책-불가지론적 방법이 중요하다.
• Approach: kinematic reference (IK retargeting 내)와 policy output (joint commands) 두 지점에서 제약조건을 강제하는 세 가지 방법을 제시한다. Contact null-space projection을 통해 contact mode를 유지하면서 CBF 기반 quadratic programming을 구성하여 task-consistent한 filtering objective를 실현한다.

Achievement

Figure 1: Where does safety fit into a learning-based humanoid motion tracking stack? We approach

제약조건 강제 방법 세 가지 제시: constrained retargeting, kinematic filter, dynamic filter를 contact-constrained kinematics/dynamics 위에서 구성. 실시간 실행 가능: CPU, GPU, TPU에서 300-500 Hz 배포 가능. 전신 추적 정책 호환성: 사전 훈련된 정책 수정 없이 collision avoidance, joint limits, center of mass stability 제약조건 만족 시연.

How

Figure 1: Where does safety fit into a learning-based humanoid motion tracking stack? We approach

• Contact null-space projection matrix를 통해 접촉 제약조건을 고려한 kinematics/dynamics 모델 구성
• Joint limits, collision avoidance, CoM stability에 대한 barrier functions 정의 및 CBF 조건 적용
• Task-consistent QP 목적함수로 최저 우선순위 component 선호적 수정
• JAX 기반 완전 미분 가능 구현으로 빠른 계산

Originality

• Contact-constrained 전신 동역학 기반 CBF 구성으로 발을 slip하지 않으면서 안전 제약 강제
• Kinematics와 dynamics 양단에서 동시에 안전 필터링하는 이중 계층 접근법
• Task-consistent objective를 통해 추적 성능 저하 최소화하면서 제약조건 만족
• 정책-불가지론적 설계로 기존 훈련된 정책에 적용 가능한 실용성

Limitation & Further Study

• 시뮬레이션 환경(Unitree G1)에서만 검증되었으며, 실제 하드웨어 로봇에서의 성능 미확인
• Sphere-sphere, sphere-plane, sphere-cylinder 충돌 모델로 제한되어 복잡한 메시 기하학 처리 미흡
• 제약조건 infeasibility 상황에 대한 처리 전략 미상세
• 후속 연구: 더 정교한 충돌 검사 모델, 다중 제약조건 우선순위 관리, 실하드웨어 검증

Evaluation

총평: 본 논문은 humanoid 전신 제어에서 contact-constrained 동역학을 통한 체계적이고 실용적인 안전 강제 방법을 제시한다. Kinematics와 dynamics 양단 필터링, task-consistent 설계, 실시간 실행 가능성은 주목할 만하나, 실하드웨어 검증과 충돌 모델 확장이 필요하다.