On the Stability of Undesirable Equilibria in the Quadratic Program Framework for Safety-Critical Control

1. 문제 정의 (Problem Statement)

• 배경: 안전-중요 시스템 (Safety-Critical Systems) 의 제어에서 **제어 리아푸노프 함수 (CLF)**와 **제어 장벽 함수 (CBF)**를 2 차 계획법 (QP) 을 통해 결합한 프레임워크 (CLF-CBF-QP) 는 안전성 (불변 집합 유지) 과 안정성 (목표 지점 수렴) 을 동시에 보장하는 강력한 도구로 널리 사용되고 있습니다.
• 핵심 문제: 기존 CLF-CBF-QP 프레임워크는 안전 집합 내의 궤적 불변성을 보장하지만, **CLF 의 전역 최소점 (목표 지점) 이 아닌 원치 않는 평형점 (Undesirable Equilibrium Points)**을 폐루프 시스템에 도입할 수 있습니다.
• 위험성: 이러한 원치 않는 평형점 중 일부는 **점근적으로 안정적 (Asymptotically Stable)**일 수 있으며, 특히 안전 영역의 경계 (Unsafe set boundary) 에 매우 근접하여 존재할 수 있습니다. 이는 시스템이 목표 지점에 도달하지 못하고 **데드락 (Deadlock)**에 빠지거나, 안전 마진을 과도하게 보수적으로 설정해야 하는 원인이 되어 시스템 성능을 저하시킵니다.
• 연구 목표: 비선형 제어-아핀 (Control-affine) 시스템에서 다수의 CBF 가 적용될 때 발생하는 평형점의 생성 메커니즘과 안정성을 분석하고, 원치 않는 안정 평형점을 제거하거나 불안정하게 만드는 CLF-CBF 호환성 (CLF-CBF Compatibility) 개념을 도입하여 이를 해결하는 방법을 제시하는 것입니다.

2. 방법론 (Methodology)

저자들은 다음과 같은 수학적 도구를 사용하여 문제를 분석하고 해결책을 제시했습니다.

A. 평형점의 존재 및 안정성 분석

• 평형점 분류: 폐루프 시스템의 평형점은 CLF 제약과 CBF 제약이 모두 활성화된 **내부 평형점 (Interior Equilibrium Points)**과 CBF 경계에서 발생하는 **경계 평형점 (Boundary Equilibrium Points)**으로 나뉩니다.
• 안정성 조건 도출: 경계 평형점의 자코비안 (Jacobian) 행렬을 분석하여 안정성 조건을 유도했습니다. 특히, CBF 기울기 벡터에 수직인 부분 공간에서 자코비안의 부호를 확인하여 평형점이 불안정하기 위한 필요충분 조건을 제시했습니다 (Theorem 3).
• 결론: CLF 와 CBF 의 기하학적 관계 (곡률, 방향 등) 가 평형점의 안정성을 결정합니다.

B. CLF-CBF 호환성 (CLF-CBF Compatibility) 개념 도입

• 정의: 주어진 시스템 동역학과 CBF 집합에 대해, CLF-CBF-QP 제어기가 CLF 의 전역 최소점 외에는 어떠한 안정 평형점도 생성하지 않는 성질을 'CLF 호환성'으로 정의했습니다.
• 수학적 도구 (Q-Function): 2 차 CLF 와 2 차 CBF 를 사용하는 선형 시불변 (LTI) 시스템 및 드리프트 없는 (Driftless) 시스템의 경우, 평형점의 존재와 안정성을 분석하기 위해 Q-Function을 도입했습니다.
  • $q(\lambda) = \nu(\lambda)^T H_{hi} \nu(\lambda)$ 형태의 스칼라 함수로, $\lambda$는 KKT 승수입니다.
  • $q(\lambda)=1$을 만족하는 $\lambda$가 존재하면 경계 평형점이 존재함을 의미합니다.
  • Stability Polynomial Matrix $S(\lambda)$: 이 행렬의 부호를 통해 해당 평형점의 안정성을 판별할 수 있습니다. $S(\lambda)$가 음의 준정부호 (Negative Semi-definite) 가 되는 구간에서 평형점이 안정적입니다.

C. 호환성 보장 알고리즘 및 적응형 제어 전략

• 호환성 조건 (Compatibility Barrier): $S(\lambda)$가 음의 준정부호가 되는 구간에서 $q(\lambda) > 1$이 되도록 CLF 의 헤시안 (Hessian) 행렬을 조정하는 조건을 유도했습니다.
• 최적화 문제 (71): 주어진 기준 CLF 와 가장 유사하면서 호환성 조건을 만족하는 새로운 2 차 CLF 의 헤시안을 찾는 최적화 문제를 구성했습니다.
• 적응형 제어 전략 (Adaptive Strategy):
  1. 시스템 상태가 원치 않는 안정 평형점의 영역 (특정 CBF 가 활성화된 영역 $\Omega_{clf}^i$) 에 진입하면, 제어기는 실시간으로 CLF 의 기하학적 형태 (레벨셋) 를 호환 가능한 CLF 로 부드럽게 변형합니다.
  2. 이 변형은 폐루프 시스템의 분기 (Bifurcation) 를 유도하여 안정 평형점을 불안정하게 만들거나 제거합니다.
  3. 상태가 해당 영역을 벗어나면 CLF 는 다시 원래의 기준 CLF 로 복귀합니다.

3. 주요 기여 (Key Contributions)

1. 정밀한 평형점 분석: 비선형 제어-아핀 시스템에서 다중 CBF 가 적용된 CLF-CBF-QP 프레임워크의 평형점 존재 조건과 안정성 조건을 체계적으로 분석했습니다.
2. CLF 호환성 개념 정립: 원치 않는 안정 평형점의 생성을 방지하는 CLF 의 기하학적 성질인 'CLF 호환성'을 정의하고, 이를 위한 필요충분 조건을 2 차 CLF/CBF 및 LTI/드리프트 없는 시스템에 대해 유도했습니다.
3. Q-Function 기반 분석 도구: 행렬 다항식 (Matrix Polynomials) 이론을 활용하여 평형점의 수와 안정성을 효율적으로 판별하는 Q-Function 과 Stability Polynomial Matrix 를 제안했습니다.
4. 적응형 CLF 변형 제어기: 호환성이 없는 CLF 를 호환 가능한 CLF 로 변환하는 알고리즘과, 상태 공간의 특정 영역에서 CLF 의 기하학을 동적으로 변형하여 데드락을 방지하는 새로운 제어 전략을 제안했습니다.

4. 결과 (Results)

• 수치 시뮬레이션:
  • 예제 1 (2 차원 LTI 시스템): 고정된 CLF 를 사용할 경우, CBF 경계에서 안정 평형점에 수렴하여 데드락이 발생하는 것을 확인했습니다. 제안된 적응형 전략을 적용한 결과, 시스템이 해당 영역에 진입할 때 CLF 레벨셋이 변형되어 안정 평형점이 불안정해졌고, 궤적이 목표 지점으로 수렴하는 것을 확인했습니다.
  • 예제 2 (불완전 구동 2 차원 LTI 시스템): 입력 행렬이 풀랭크가 아닌 경우에도 제안된 방법이 유효함을 보였습니다. 고정 CLF 는 경계 평형점에 갇히지만, 적응형 CLF 전략은 장애물을 우회하여 목표 지점으로 성공적으로 도달하게 했습니다.
• 시뮬레이션 결과: 제안된 방법은 여러 안전 목표 (다중 CBF) 를 유지하면서도 원치 않는 평형점으로의 수렴을 방지하고, 매끄러운 궤적 추적을 가능하게 함을 입증했습니다.

5. 의의 및 결론 (Significance & Conclusion)

• 이론적 기여: CLF-CBF 프레임워크의 근본적인 한계인 '데드락' 및 '원치 않는 안정 평형점' 문제에 대한 이론적 분석을 심화시켰으며, 이를 해결하기 위한 기하학적 조건을 명확히 제시했습니다.
• 실용적 가치: 설계자가 안전 마진을 과도하게 보수적으로 설정할 필요가 줄어들며, 복잡한 환경 (다중 장애물, 비볼록 안전 영역) 에서도 안전하고 효율적인 제어가 가능해집니다.
• 미래 전망: 본 연구는 특정 클래스의 시스템 (LTI, 드리프트 없는 시스템) 에 국한되어 있으나, 향후 일반 비선형 시스템과 다양한 CLF/CBF 쌍으로의 이론 확장을 목표로 하고 있습니다.

요약하자면, 이 논문은 안전-중요 제어 시스템에서 발생할 수 있는 치명적인 데드락 현상을 예방하기 위해, CLF 의 기하학적 형태를 동적으로 조정하여 원치 않는 평형점을 불안정하게 만드는 새로운 제어 패러다임을 제시했습니다.