[論文レビュー] L1 guidance logic extension for small UAVs: handling high winds and small loiter radii

Thomas Stastny|arXiv (Cornell University)|Apr 11, 2018

Guidance and Control Systems被引用数 5

ひとこと要約

本論文は、L₁誘導論理を小型固定翼ドローンに拡張し、風速が高く、ロイタリング半径が小さい状況に対応するために、経路収束のための適応的L₁比と、脱線を抑止するための方位整合性パラメータを導入する。この手法により、風速に応じてL₁周期と空速リファレンスを動的に調整し、風速が空速を上回る場合やロイタリング半径が小さい場合でも、安定的かつ安全なロイタリングを実現する。シミュレーションにより、追従性能と制御安定性の向上が検証された。

ABSTRACT

L1 guidance logic is one of the most widely used path following controllers for small fixed-wing unmanned aerial vehicles (UAVs), primarily due to its simplicity (low-cost implementation on embedded on-board processors, e.g. micro-controllers) and ability to track both circles and lines, which make up the vast majority of a typical fixed-wing vehicle's flight plan. The logic was later extended for speed independent dynamic similarity with an adaptive L1 distance, a formulation currently used on common open-source autopilot platforms. Two primary drawbacks remain, specific to small, slow flying fixed-wing UAVs; namely, 1) the combination of low operator defined gains and high ground speeds may violate the bounds of the algorithms convergence region for the case of loiter circles with small radii and 2) L1 logic breaks down when wind speeds exceed the vehicle's airspeed, another common predicament for small, slow-flying UAVs. This brief presents simple extensions to this extensively field tested algorithm, allowing legacy operators to keep existing controller tunings while taking advantage of the enhanced performance and safety features developed within.

研究の動機と目的

• ロイタリング半径がノーマルL₁長さを下回る場合に生じるL₁誘導の制限を解消し、経路収束を可能にする。
• ドローンの空速を超える風速が生じる高風速条件下で生じる不安定化および脱線行動を解消する。これは、低速飛行プラットフォームで一般的な問題である。
• 従来のオープンソース自動操縦システム（例：PX4、ArduPilot）との互換性を維持するため、従来の制御ゲインを保ったまま実装する。
• ハイブリッド追従／安全制御目的を用いて、過風条件下でも継続的かつ安全な制御入力を保証する。
• 地上速度と風速のリアルタイム状態に基づいてL₁パラメータを適応的に変更することで、最小限のオペレータの再調整で安定したロイタリングを実現する。

提案手法

• L₁ > R の場合に L₁ = min(L₁, R) を再計算することで、収束条件 L₁ ≤ R を満たす適応的L₁比を導入する。
• 航空機がロイタリング円に近づくに従い、通常のL₁比から適応的L₁比への滑らかな遷移を実現するため、線形ラムプを適用する。
• 地上速度の向きが不安定になった場合に、経路追従から風抑制に制御命令を切り替えるための方位整合性パラメータを定義する。
• 風速比と整合性に基づいて、風速に比例する非ゼロの空速リファレンス増分を実装し、地上速度の脱線を防止する。
• 余弦定理と幾何的制約を用いてL₁方位と誤差角ηを計算し、一貫した経路追従を保証する。
• 数値安定性を確保し、ロイタリング中心付近の特異点を回避するため、飽和関数およびラップアラウンド関数（例：wrap_pi、constrain）を適用する。

実験結果

リサーチクエスチョン

• RQ1 ロイタリング半径がノーマルL₁長さよりも小さい場合に、L₁誘導が経路収束を維持できるか？
• RQ2 風速がドローンの空速を超える高風速条件下で、L₁誘導がどのように安定化できるか？
• RQ3 過風条件下で、バング・バイ・バングの振動を回避しながら、継続的かつ安全な制御入力を実現する制御戦略は何か？
• RQ4 提案された拡張手法が、従来の制御ゲインを保持し、レガシーオープンソース自動操縦システムに統合可能か？
• RQ5 方位整合性パラメータは、風の突風や持続的過風条件下で制御の滑らかさを向上させ、脱線を防止するのにどのように寄与するか？

主な発見

• 適応的L₁比は、元のL₁論理が失敗するような小ロイタリング半径（例：R = 15 m）に対しても、経路収束を成功裏に実現した。
• 中程度の風速（3 m/s）条件下でも、適応的L₁比は地上速度の変動に応じて有効周期を調整することで、よりタイトな追従性能を維持した。
• 一定の過風（12 m/s、空速を3 m/s上回る）条件下では、元のL₁論理は不安定で振動するロール命令と脱線行動を示した。
• 方位整合性関数は、過風条件下で制御を安全目的にスムーズに切り替えることができ、終端状態で安定した連続的ロールリファレンスとゼロの地上速度を達成した。
• 正弦波風の突風（平均10 m/s、振幅2 m/s）条件下でも、拡張手法はバング・バイ・バング行動を示さない滑らかな非振動的制御入力を維持した。これに対して、元のL₁論理はバング・バイ・バング振動を示した。
• 空速リファレンス増分は、不適切な状況下で風速にうまく対応し、最小限の地上速度で風向きを向いた安定したロイタリングを可能にした。