Time-Optimal Switching Surfaces for Triple Integrator under Full Box Constraints

기술적 요약: 전체 박스 제약 하의 삼중 적분기에 대한 시간 최적 스위칭 표면

문제 정의
본 논문은 전체 박스 제약 조건을 받는 삼중 적분기 시스템에 대한 시간 최적 제어 문제를 다룬다. 시스템 동역학은 저크 제한 제어 입력 ($u$) 과 위치 ($x_1$), 속도 ($x_2$), 가속도 ($x_3$) 에 대한 상태 제약을 포함한다. 목표는 임의의 초기 상태 $\mathbf{x}_0$ 에서 고정된 최종 상태 $\mathbf{x}_f$ 로 시스템을 최소 시간 $t_f$ 내에 전달하는 것이다.

이중 적분기에 대한 시간 최적 제어는 잘 알려져 있지만, 삼중 적분기 사례는 특히 다음과 같은 경우에서 상당한 도전을 제시한다:

1. 비대칭 제약: 저크 및 상태의 상한과 하한이 크기가 같지 않은 경우.
2. 비정상 경계 조건: 임의의 초기 및 최종 상태.
3. 활성 위치 제약: 궤적이 위치 제약 경계 ($x_3 = \bar{x}_3$ 또는 $x_3 = \underline{x}_3$) 를 접촉하거나 따라 미끄러져야 하는 시나리오.

기존 솔루션인 상용 Ruckig 알고리즘 (커뮤니티 버전) 은 종종 비대칭 제약이나 활성 위치 제약 하에서 실패한다. 이전의 분석적 접근법은 상태 제약을 무시하거나, 대칭 제약을 가정하거나, 위치 제약에 대한 스위칭 표면과 활성 조건의 완전한 특성을 제공하지 못하였다.

방법론
저자들은 최적 제어 법칙을 특성화하기 위해 폰트랴긴 최대 원리 (PMP) 를 활용하며, 이는 Bang-Bang-Singular(BBS) 구조를 따른다. 방법론의 핵심은 시간 최적 스위칭 표면을 유도하기 위해 상태 공간에 대한 기하학적 분석을 수행하는 것이다.

1. 확장 스위칭 법칙 (ASL): 최적 궤적은 호들 (제약 없는 뱅 - 뱅 호와 상태가 고정된 제약 호) 과 "접점 마커"의 시퀀스로 표현된다. 접점 마커는 위치 제약이 접선적으로 활성화될 때 발생한다 (즉, $x_3 = \bar{x}_3$, $x_2 = 0$, 그리고 $x_1 \geq 0$).
2. 스위칭 표면 구성:
   • 위치 제약 없이: 저자들은 최종 상태 $\mathbf{x}_f$ 에서 후방 적분을 통해 스위칭 매니폴드를 구성한다. 그들은 3 차원 상태 공간을 분할하는 특정 ASL 에 해당하는 표면들 (예: $\bar{0}\bar{0}\bar{0}$, $\bar{0}\bar{1}\bar{0}\bar{0}$) 을 정의한다.
   • 위치 제약과 함께: 논문은 위치 제약이 활성화되는 구체적인 조건들을 유도한다. 위치 경계에 접하는 궤적을 고려하는 새로운 스위칭 표면들 (예: $\bar{0}(\bar{3}, 2)\bar{0}\bar{0}\bar{0}$) 을 도입한다. 정리 2 는 전체 박스 제약을 가진 삼중 적분기에 대한 모든 가능한 ASL 형태의 완전한 분류를 제공하며, 최적 궤적이 제약 없는 호와 접점 마커의 시퀀스로 구성됨을 확립한다.
3. 알고리즘적 구현:
   • 알고리즘 1: 2 차 투영을 분석하여 $\mathbf{x}_0$ 와 $\mathbf{x}_f$ 사이의 상대적 방향을 결정하며, 스위칭 표면이 다중 값인 경우를 처리한다.
   • 알고리즘 2: 2 차 최적 제어들을 통해 상태를 연결하고 호 지속 시간에 대한 다항 방정식을 풀어 위치 제약 없이 문제를 해결한다.
   • 알고리즘 3: 전체 박스 제약으로 솔루션을 확장한다. 제약 없는 솔루션이 위치 제약을 위반하는 경우, 알고리즘은 상태를 정리 2 에서 유도된 접점 마커에 재귀적으로 연결하고 부분 문제들을 해결한다.
   • 호 지속 시간에 대한 방정식 체계는 그로브너 기저 (Gröbner bases) 를 사용하여 해결되며, 문제를 6 차 이하의 단일 다항 방정식으로 축소한다.

주요 기여

• 스위칭 표면의 완전한 특성화: 최초로 전체 박스 제약 하의 삼중 적분기에 대한 시간 최적 스위칭 표면의 완전한 분석적 특성화를 제공하며, 활성 위치 제약을 가진 해들의 기하학적 구조를 포함한다.
• 활성 조건 유도: 논문은 위치 제약이 활성화되는 조건들 ("접점 마커" 조건) 을 명시적으로 유도하며, 이는 기존 문헌에서 누락되어 있던 부분이다.
• 정리 2 (ASL 분류): 이 문제에 대한 허용 가능한 확장 스위칭 법칙의 완전한 집합을 확립하며, 최적 궤적이 접점 마커를 포함하는 특정 시퀀스를 따른다는 것을 증명한다.
• 효율적인 알고리즘: 임의의 경계 상태와 비대칭 제약을 위한 시간 최적 궤적을 계획하는 알고리즘이 제안되었다.

결과
제안된 방법은 Ruckig (커뮤니티 버전), CasADi (IPOPT 기반), 그리고 SCP (순차적 볼록 프로그래밍) 라는 세 가지 기준선과 비교 평가되었다.

• 성공률: 제안된 방법은 대칭 (Case 1) 과 비대칭 및 활성 위치 제약 (Case 2) 모두에 대해 실현 가능한 해를 찾는 데 100% 성공률을 달성하였다. 반면, Ruckig 은 비대칭성으로 인해 Case 2 에서 실패했으며, SCP/CasADi 는 Case 2 에서 각각 34.1% 와 97.7% 로 현저히 낮은 성공률을 보였다.
• 계산 효율성: 궤적당 평균 계산 시간은 약 10 $\mu$s (Case 1 의 경우 구체적으로 $2.38 \times 10^{-6}$ 초, Case 2 의 경우 $1.25 \times 10^{-5}$ 초) 였다. 이는 최적화 기반 기준선 (CasADi: 약 0.28 초; SCP: 약 7.28 초) 에 비해 5 차수 감소를 나타낸다.
• 최적성: 이 방법은 일관되게 전역 최적 해를 찾았다. 최적화 기반 방법들이 지역 최적 (비최적 ASL) 에 수렴한 테스트 사례에서, 제안된 방법은 최종 시간을 Case 1 에서 최대 90.9%, Case 2 에서 **73.4%**까지 단축하였다.

의의
저자들은 이 작업이 비정상 최종 조건과 활성 위치 제약 하의 3 차 시간 최적 제어 문제에 대한 최초의 완전한 스위칭 표면 특성화와 효율적인 알고리즘을 제공한다고 주장한다. 반복적 최적화에서 기하학적 분석적 솔루션으로 전환함으로써, 본 논문은 고정밀 시간 최적 제어가 마이크로초 수준의 계산 시간으로 달성될 수 있음을 보여주며, 제약이 종종 비대칭적이고 활성인 로봇 운동 및 수치 제어 가공과 같은 실시간 산업 응용에 매우 적합함을 입증한다.