Coordinated Trajectory Control Algorithm for Quadcopter Motion along a Smooth Spatial Trajectory

기술 요약: 매끄러운 공간 궤적을 따라 이동하는 쿼드콥터의 조정된 궤적 제어 알고리즘

문제 제기
본 논문은 쿼드콥터가 매끄러운 3 차원 공간 궤적을 따라 이동하도록 제어하는 과제를 다룹니다. 저자들은 두 가지 주요 제어 패러다임을 구분합니다: 추적 제어는 로봇이 특정 시간에 특정 위치에 도달하도록 시도하는 것으로, 종종 장애물이 많은 환경에서 실패할 수 있는 최단 경로 해법으로 이어집니다. 반면 조정된 제어에서는 궤적과 해당 곡선을 따른 속도 프로파일이 사전에 지정됩니다. 제어 목표는 특정 시간의 점까지의 거리가 아니라 경로에서의 편차를 최소화하는 것이며, 이를 통해 차량은 곡선을 따라 속도를 조절하여 장애물을 우회할 수 있습니다.

여기서 다루는 구체적인 문제는 제어 채널의 상대 차수 (relative degree) 가 동일하지 않아 모델 분해가 복잡해지는 쿼드콥터의 비선형 동역학 모델입니다. 또한, 제안된 솔루션은 기존 상태 피드백 접근법과 비교하여 중요한 제약 조건인 전체 상태 벡터 측정 대신 선형 좌표 $x, y, z$ 및 요 (yaw) 각도 $\psi$ 와 같은 출력 측정값에만 의존해야 합니다.

방법론
저자들은 기하학적 접근법과 강인한 출력 피드백에 기반한 제어 합성을 개발합니다:

1. 동역학 모델링 및 편차 정의:
   선형 좌표와 자세 (요, 피치, 롤) 를 모두 고려한 쿼드콥터의 완전한 비선형 모델이 수립됩니다. 원하는 궤적 $S$에서의 편차는 좌표 변환을 사용하여 정의됩니다. 이는 다음을 포함합니다:

   • 곡선 상의 가장 가까운 점을 나타내는 경로 좌표 $s$.
   • 원하는 속도 벡터에서 교차하는 두 평면까지의 거리를 나타내는 두 개의 선형 오차 좌표 ($e_1, e_2$).
   • 원하는 피치와 롤이 0 으로 가정되고, 원하는 요 (yaw) 가 궤적의 투영으로부터 유도되는 각도 오차 ($\delta\phi, \delta\theta, \delta\psi$).

2. 정규형 변환:
   제어 설계를 용이하게 하기 위해 시스템을 일련의 미분과 좌표 변화를 사용하여 "정규형 (normal form)"으로 변환합니다. 저자들은 추력 제어 입력 ($u_1$) 의 포화를 처리하기 위해 보조 변수와 적분기를 도입합니다. 이 변환은 규제 변수 ($\xi_1$) 와 그 미분 ($\xi_2, \xi_3, \xi_4$) 이 확장된 상태 벡터를 형성하는 시스템을 생성합니다. 시스템이 가역적임이 입증되어, 정규형 변수로부터 원래 제어 입력을 재구성할 수 있습니다.

3. 강인한 출력 피드백 제어 합성:

   • 이상적인 상태 피드백: 초기에 전체 상태 가용성을 가정하여 제어 법칙이 합성됩니다. 이 법칙은 국소 점근적 안정성을 보장하는 Hurwitz 다항식을 형성하도록 선택된 이득 ($\gamma_1$부터 $\gamma_4$까지) 을 가진 선형 피드백 구조를 사용합니다.
   • 출력 피드백 구현: 전체 상태 측정이 불가능하다는 점을 인식하여, 저자들은 확장된 관측기 방법을 사용합니다. 미지 상태 ($\hat{\xi}_2, \hat{\xi}_3, \hat{\xi}_4$) 와 미지 외란 항 ($\hat{\sigma}$) 을 추정하기 위해 고이득 관측기가 설계됩니다.
   • 제어 법칙: 최종 제어 법칙은 이러한 추정된 상태를 활용하며, 제어 입력이 물리적 한계 내에 있도록 매끄러운 포화 함수를 포함합니다. 네 개의 프로펠러에 대한 추력은 정규형에서 유도된 변환 행렬을 역전시켜 계산됩니다.

주요 기여

• 완전한 3 차원 모델: 요 (yaw) 동역학을 무시하거나 평면 운동으로 제한된 불완전한 모델을 활용한 이전 연구들과 달리, 본 논문은 3 차원 공간에서의 쿼드콥터 운동을 위한 완전한 동역학 모델을 제시합니다.
• 출력 피드백 조정 제어: 본 논문은 제어 채널의 비동일한 상대 차수라는 어려움을 해결하는 선형 좌표와 요 (yaw) 각도 측정값에만 의존하는 조정된 제어 법칙을 합성합니다.
• 단순화된 튜닝: 추가 적분기와 동적 제어 알고리즘을 활용함으로써, 저자들은 복잡한 매개변수 선택을 요구했던 기존 추적 제어 알고리즘에 비해 규제기 튜닝이 단순화된 방법론을 제안합니다.
• 강인성: 확장된 관측기의 포함은 시스템이 미지 항과 외란을 처리할 수 있게 하여 궤적 추적을 위한 강인한 솔루션을 제공합니다.

결과 및 주장
본 논문은 폐루프 시스템의 국소 안정성에 대한 이론적 증명을 제공합니다. 저자들은 제어기 매개변수가 Hurwitz 다항식의 계수로 선택될 경우, 편차 변수 ($\tilde{\xi}$) 가 점근적으로 0 으로 수렴함을 보여줍니다. 이는 쿼드콥터가 다음을 보장함을 의미합니다:

1. 지정된 공간 곡선을 따름.
2. 곡선을 따라 지정된 속도 프로파일을 유지함.
3. 자세 오차를 유계 한도 내에 유지함.

수학적 유도는 궤적의 곡률이 유계이고 초기 조건이 끌개 영역 (region of attraction) 내에 있을 경우, 제어 법칙이 궤적에서의 편차를 최소화하고 원하는 속도와 자세를 유지하는 목표를 달성함을 확인합니다.

의의
본 논문은 출력 피드백만을 사용하여 평면 이동 로봇에서 3 차원 쿼드콥터 운동으로 조정된 궤적 제어를 확장함으로써 문헌의 간극을 해소했다고 주장합니다. 이는 불완전한 모델을 사용하거나 전체 상태 측정을 요구했던 이전 연구들과 대조됩니다. 그 의의는 각속도나 전체 자세 벡터의 복잡한 상태 추정이 필요하지 않고 표준 센서 제약 (위치 및 요) 을 고려할 때 실제로 구현 가능한 이론적으로 근거가 있으며 강인한 공간 경로 추적 알고리즘을 제공한다는 점에 있습니다. 저자들은 이론적 프레임워크가 확립되었지만, 합성된 제어 법칙을 검증하기 위한 풀스케일 실험 연구는 향후 작업으로 계획되어 있다고 언급합니다.