An omnidirectional multirotor has the maneuverability of decoupled translational and rotational motions, superseding the traditional multirotors' motion capability. Such maneuverability is achieved due to the ability of the omnidirectional multirotor to frequently alter the thrust amplitude and direction. In doing so, the rotors' settling time, which is induced by inherent rotor dynamics, significantly affects the omnidirectional multirotor's tracking performance, especially in aggressive flights. To resolve this issue, we propose a novel tracking controller that takes the rotor dynamics into account and does not require additional rotor state measurement. This is achieved by integrating a linear rotor dynamics model into the vehicle's equations of motion and designing a PD controller to compensate for the effects introduced by rotor dynamics. We prove that the proposed controller yields almost global exponential stability. The proposed controller is validated in experiments, where we demonstrate significantly improved tracking performance in multiple aggressive maneuvers compared with a baseline geometric PD controller.
논문 ID : 2209.10024제목 : Geometric Tracking Control of Omnidirectional Multirotors for Aggressive Maneuvers저자 : Hyungyu Lee, Sheng Cheng, Zhuohuan Wu, Jaeyoung Lim, Roland Siegwart, Naira Hovakimyan분류 : cs.RO (로봇공학), cs.SY (시스템 및 제어), eess.SY (전기공학 시스템 및 제어)발표 시간 : 2022년 9월 최초 제출, 2025년 1월 업데이트논문 링크 : https://arxiv.org/abs/2209.10024 전방향 다중로터 항공기는 분리된 병진 및 회전 운동 기동 능력을 갖추고 있어 기존 다중로터 항공기의 운동 능력을 초월합니다. 이러한 기동성은 추력의 크기와 방향을 빈번하게 변경함으로써 달성됩니다. 이 과정에서 고유한 로터 동역학으로 인한 로터 안정화 시간이 전방향 다중로터의 추적 성능에 상당한 영향을 미치며, 특히 공격적 비행 중에 그렇습니다. 이 문제를 해결하기 위해 본 논문은 로터 동역학을 고려하면서도 추가 로터 상태 측정이 필요 없는 새로운 추적 제어기를 제안합니다. 선형 로터 동역학 모델을 항공기 운동 방정식에 통합하고 로터 동역학으로 인한 영향을 보상하기 위해 PD 제어기를 설계함으로써, 저자들은 제안된 제어기가 거의 전역적 지수 안정성을 갖는다는 것을 증명합니다. 실험 검증은 기준선 기하학적 PD 제어기와 비교하여 다양한 공격적 기동에서 추적 성능이 크게 개선됨을 보여줍니다.
핵심 문제 : 전방향 다중로터 항공기가 공격적 기동을 수행할 때 로터 동역학의 안정화 시간이 추적 성능에 심각한 영향을 미침기술적 과제 : 기존 제어기는 로터가 이상적인 빠른 응답을 갖는다고 가정하여 로터 동역학이 시스템 성능에 미치는 영향을 무시함실제 요구사항 : 동적 환경에서 전방향 다중로터는 빈번하고 정확하게 속도와 방향을 변경해야 하므로 제어 정확도 요구사항이 매우 높음전방향 다중로터 항공기는 임의의 자세에서 중력을 상쇄하는 추력을 생성할 수 있어 응용 범위를 크게 확장함 공격적 기동 능력은 동적 환경에서의 작동에 매우 중요함 기존 방법은 로터 동역학에 대한 체계적 고려가 부족하여 실제 응용 성능을 제한함 로터 동역학 무시 : 대부분의 연구는 로터가 빠른(따라서 무시할 수 있는) 동역학 특성을 갖는다고 가정추가 센서 필요 : 로터 동역학을 고려하는 일부 방법은 로터 상태를 측정하기 위해 전용 센서나 특수 ESC가 필요안정성 보장 부족 : 기존 방법은 엄격한 안정성 분석을 제공하지 않음획기적 제어 아키텍처 : 로터 동역학을 고려하면서도 추가 로터 상태 측정이 필요 없는 최초의 전방향 다중로터 제어기 설계 제안이론적 보장 : 로터 동역학을 포함한 완전한 시스템에서 제안된 제어기가 거의 전역적 지수 안정성을 갖는다는 것을 증명실험 검증 : 8축 전방향 다중로터 플랫폼을 사용하여 공격적 기동에서 제어기의 우수한 성능 검증일반성 설계 : 제어기는 단방향 및 양방향 로터 시스템에 적용 가능입력 : 원하는 위치 궤적 p d ( t ) p_d(t) p d ( t ) , 원하는 자세 궤적 R d ( t ) R_d(t) R d ( t ) 및 그 도함수
출력 : 로터 추력 명령 f c m d f_{cmd} f c m d 제약 : 로터 동역학 영향 하에서의 궤적 추적 제어
추력 동역학(TD) 모델을 채택하여 추력을 1차 시스템으로 단순화:
f i ˙ = 1 α f , i ( f c m d , i − f i ) \dot{f_i} = \frac{1}{\alpha_{f,i}}(f_{cmd,i} - f_i) f i ˙ = α f , i 1 ( f c m d , i − f i )
여기서 α f , i \alpha_{f,i} α f , i 는 i번째 로터의 추력 시간 상수입니다.
로터 동역학을 고려한 Newton-Euler 방정식:
m v ˙ = − α m v ¨ − α R ( F × ω ) − m g z ^ I + R F c m d m\dot{v} = -\alpha m\ddot{v} - \alpha R(F \times \omega) - mg\hat{z}_I + RF_{cmd} m v ˙ = − α m v ¨ − α R ( F × ω ) − m g z ^ I + R F c m d J ω ˙ = − α ( ω ˙ × J ω + ω × J ω ˙ + J ω ¨ ) − ω × J ω + M c m d J\dot{\omega} = -\alpha(\dot{\omega} \times J\omega + \omega \times J\dot{\omega} + J\ddot{\omega}) - \omega \times J\omega + M_{cmd} J ω ˙ = − α ( ω ˙ × J ω + ω × J ω ˙ + J ω ¨ ) − ω × J ω + M c m d
오차 정의:
위치 오차: e p = p − p d e_p = p - p_d e p = p − p d 속도 오차: e v = v − v d e_v = v - v_d e v = v − v d 힘 오차: e F = F − F d e_F = F - F_d e F = F − F d 제어 법칙 설계:
F c m d = F d + α F d ˙ F_{cmd} = F_d + \alpha \dot{F_d} F c m d = F d + α F d ˙
여기서 원하는 힘은:
F d = R T ( − k p e p − k v e v + m g z ^ I + m v d ˙ ) F_d = R^T(-k_p e_p - k_v e_v + mg\hat{z}_I + m\dot{v_d}) F d = R T ( − k p e p − k v e v + m g z ^ I + m v d ˙ )
오차 정의:
자세 오차: e R = 1 2 [ R d T R − R T R d ] ∨ / 1 + t r ( R d T R ) e_R = \frac{1}{2}[R_d^T R - R^T R_d]^{\vee}/\sqrt{1 + tr(R_d^T R)} e R = 2 1 [ R d T R − R T R d ] ∨ / 1 + t r ( R d T R ) 각속도 오차: e ω = ω − R T R d ω d e_{\omega} = \omega - R^T R_d \omega_d e ω = ω − R T R d ω d 토크 오차: e M = M − M d e_M = M - M_d e M = M − M d 제어 법칙 설계:
M c m d = M d + α M d ˙ M_{cmd} = M_d + \alpha \dot{M_d} M c m d = M d + α M d ˙
보상항 설계 : α F d ˙ \alpha\dot{F_d} α F d ˙ 및 α M d ˙ \alpha\dot{M_d} α M d ˙ 항을 통해 로터 동역학으로 인한 지연을 능동적으로 보상추가 센서 불필요 : IMU를 활용하여 힘과 토크 오차를 추정하여 전용 로터 상태 센서를 회피기하학적 제어 프레임워크 : SO(3) 다양체에서 제어기를 설계하여 특이점 문제를 회피분리된 설계 : 병진 및 회전 제어기를 독립적으로 설계하여 제어 구조를 단순화구성 : 8축 고정 경사 양방향 로터 전방향 다중로터하드웨어 : BrotherHobby LPD 2306.5 2000KV 모터, Gemfan 513D 3엽 3D 프로펠러파라미터 : 질량 1.481kg, 관성 모멘트 J = diag(0.020, 0.021, 0.020) kg·m²로터 시간 상수 : αf = 0.07s세 가지 주요 테스트 시나리오:
순수 병진 궤적 : 병진 제어 시스템 검증단축 회전 궤적 : 회전 제어 시스템 검증다축 회전 궤적 : 복합 운동 제어 검증위치 제곱평균제곱근 오차(RMSE) 자세 제곱평균제곱근 오차(RMSE) 추적 정확도 비교 궤적 : x d ( t ) = − 0.4 cos ( 4 π 3 t ) x_d(t) = -0.4\cos(\frac{4\pi}{3}t) x d ( t ) = − 0.4 cos ( 3 4 π t ) , y d ( t ) = 0.4 sin ( 4 π 3 t ) y_d(t) = 0.4\sin(\frac{4\pi}{3}t) y d ( t ) = 0.4 sin ( 3 4 π t ) , z d ( t ) = 0.6 z_d(t) = 0.6 z d ( t ) = 0.6 m결과 : 제안된 방법의 위치 RMSE가 기준선 방법보다 31% 감소분석 : x 및 y축 방향에서 추적 성능이 크게 개선되었으며, z축 성능은 동등함궤적 : ω z B = π 2 sin ( 2 π t ) \omega_z^B = \frac{\pi}{2}\sin(2\pi t) ω z B = 2 π sin ( 2 π t ) rad/s결과 : 자세 RMSE가 기준선 방법보다 39% 감소분석 : 높은 각가속도 조건에서 자세 추적 성능이 크게 개선됨궤적 : ω z B = 2 π \omega_z^B = 2\pi ω z B = 2 π rad/s, ω y I ( t ) = π 2 sin ( π t ) \omega_y^I(t) = \frac{\pi}{2}\sin(\pi t) ω y I ( t ) = 2 π sin ( π t ) rad/s결과 : 자세 RMSE 11% 개선, 위치 추적 크게 개선분석 : 복잡한 기동에서의 종합적 성능 향상 검증로터 동역학 영향 : 공격적 기동에서 로터 안정화 시간이 성능에 영향을 미치는 주요 요인보상 효과 : 제안된 방법이 로터 동역학으로 인한 위상 지연을 효과적으로 보상일반성 : 방법이 다양한 유형의 공격적 기동에서 개선 효과를 보임병진 시스템 :
V 1 = 1 2 k p ∥ e p ∥ 2 + 1 2 m ∥ e v ∥ 2 + 1 2 α ∥ e F ∥ 2 + c 1 e p ⋅ e v V_1 = \frac{1}{2}k_p\|e_p\|^2 + \frac{1}{2}m\|e_v\|^2 + \frac{1}{2}\alpha\|e_F\|^2 + c_1 e_p \cdot e_v V 1 = 2 1 k p ∥ e p ∥ 2 + 2 1 m ∥ e v ∥ 2 + 2 1 α ∥ e F ∥ 2 + c 1 e p ⋅ e v
회전 시스템 :V 2 = 1 2 e ω ⋅ J e ω + k R Ψ ( R , R d ) + 1 2 α ∥ e M ∥ 2 + c 2 e R ⋅ e ω V_2 = \frac{1}{2}e_{\omega} \cdot Je_{\omega} + k_R\Psi(R,R_d) + \frac{1}{2}\alpha\|e_M\|^2 + c_2 e_R \cdot e_{\omega} V 2 = 2 1 e ω ⋅ J e ω + k R Ψ ( R , R d ) + 2 1 α ∥ e M ∥ 2 + c 2 e R ⋅ e ω
제어 이득이 다음을 만족해야 함:
k p > c 1 k v 2 + 2 c 1 k v − c 1 2 m ( 4 ( k v − c 1 ) − 1 ) , k v > c 1 + 1 4 k_p > \frac{c_1k_v^2 + 2c_1k_v - c_1^2}{m(4(k_v - c_1) - 1)}, \quad k_v > c_1 + \frac{1}{4} k p > m ( 4 ( k v − c 1 ) − 1 ) c 1 k v 2 + 2 c 1 k v − c 1 2 , k v > c 1 + 4 1
k R > c 2 k ω 2 λ m ( 4 ( k ω − 1 2 c 2 ) − 1 ) , k ω > 1 2 c 2 + 1 4 k_R > \frac{c_2k_{\omega}^2}{\lambda_m(4(k_{\omega} - \frac{1}{2}c_2) - 1)}, \quad k_{\omega} > \frac{1}{2}c_2 + \frac{1}{4} k R > λ m ( 4 ( k ω − 2 1 c 2 ) − 1 ) c 2 k ω 2 , k ω > 2 1 c 2 + 4 1
정리 1 : 설계 조건을 만족할 때, 완전한 시스템의 추적 오차 동역학 영점 평형점은 거의 전역적 지수 안정성을 갖습니다.
단방향 로터 시스템 : 최소 7개의 로터 또는 가변 경사 메커니즘 필요양방향 로터 시스템 : 기계 구조 단순화, 하지만 전력 효율이 낮음제어 방법 : 기하학적 PID에서 비선형 MPC로의 진화DCMD 모델 : 무선 직류 모터 동역학을 기반으로 한 정확한 모델TD 모델 : 정확도와 복잡도의 균형을 맞춘 단순화된 추력 동역학 모델응용 : 고정익 및 쿼드로터에서의 성공적 응용로터 동역학을 고려한 전방향 다중로터 제어기 설계에 성공 거의 전역적 지수 안정성을 이론적으로 증명 공격적 기동에서의 현저한 성능 개선을 실험으로 검증 추가 센서가 필요 없는 실용적 설계 로터 포화 : 현재 설계는 로터 포화 제약을 고려하지 않음반전 지연 : 양방향 로터의 반전 지연이 모델링되지 않음파라미터 적응 : 로터 특성 변화에 대한 강건성을 고려하지 않음제약 최적화 : 제약 최소제곱을 통한 로터 포화 처리반전 지연 모델링 : 특히 양방향 로터에 대한 상세 모델링강건 제어 : 로터 특성 변화에 적응하는 강건 제어 메커니즘 통합이론적 엄밀성 : 완전한 안정성 분석 및 증명 제공실용성 : 추가 센서 불필요, 실제 배포 용이충분한 실험 : 세 가지 다른 유형의 공격적 기동으로 검증높은 혁신성 : 전방향 다중로터에서 로터 동역학을 처음으로 체계적으로 고려모델 단순화 : TD 모델이 DCMD 모델 대비 정확도 손실실험 규모 : 단일 플랫폼에서만 검증, 다양성 부족환경 제한 : 이상적인 실내 환경에서 실험, 외부 간섭 테스트 부족계산 복잡도 : 실시간 계산 부담에 대한 상세 분석 부족학술 기여 : 전방향 다중로터 제어 이론에 새로운 관점 제공실용적 가치 : 공격적 기동 응용을 위한 실행 가능한 솔루션 제공재현성 : 상세한 파라미터 및 구현 세부사항 제공확장성 : 후속 연구를 위한 좋은 이론적 기초 제공수색 구조 : 복잡한 환경에서 공격적 기동 수행 필요산업 검사 : 좁은 공간에서의 정확한 위치 결정 및 검사연구 플랫폼 : 전방향 항공기 제어 연구의 기초 플랫폼엔터테인먼트 공연 : 복잡한 비행 궤적이 필요한 공연 응용논문은 34편의 관련 문헌을 인용하고 있으며, 다중로터 모델링 및 제어, 전방향 항공기 설계, 로터 동역학 모델링 등 핵심 분야의 중요한 연구를 포함하고 있어 본 연구에 견고한 이론적 기초를 제공합니다.
종합 평가 : 이것은 전방향 다중로터 제어 분야에 중요한 기여를 하는 높은 품질의 논문으로, 이론이 엄밀하고 실험이 충분하며 실용적 가치와 학술적 영향력이 강합니다.