技術概要：C-ZUPT（定常性支援による航空機ホバリング）

問題定義

グローバルナビゲーション衛星システム（GNSS）が利用できない環境で動作する自律システムは、長期間にわたって正確な状態推定を維持するという重大な課題に直面している。慣性航法システム（INS）は高頻度の測定に依存するが、センサーのバイアスやノイズに起因するドリフトが本質的に発生しやすい。外部からの補正（GNSS や視覚更新など）がない場合、推定誤差は制御されずに蓄積し、フィルタの発散と制御の喪失を招く。

従来の解決策であるゼロ速度更新（ZUPT）は、物理的な静止期間を利用することで、歩行者や車両などの地表に固定されたプラットフォームに対して非常に効果的である。しかし、これらの手法は、擾乱に対抗するために連続的な能動制御が必要であり、ホバリング中であっても真のゼロ速度を達成することが稀なクアッドコプターなどの航空プラットフォームには一般的に適用できない。その結果、航空システムは、静止飛行段階において状態推定を固定するための信頼性のあるセンサーレス機構を欠いており、これにより精度の急速な劣化と、蓄積する誤差と戦うコントローラーによるエネルギー消費の増加を招いている。

手法

著者は、航空航法のために特別に設計されたセンサーレスの状態補正アプローチである「制御付きゼロ速度更新（C-ZUPT）」を提案する。この手法は、以下の 3 つの中核要素を統合している。

1. 理論的枠組みとモデリング

システムは、ホバリング平衡点を中心に線形化された連続時間動的システムとしてクアッドコプターをモデル化する。

• 動力学: ニュートン - オイラーの枠組みが、推力、重力、および低速では無視される空気抵抗を考慮した 6 自由度の運動を記述する。
• 制御アーキテクチャ: システムは、制御のための線形二次レギュレータ（LQR）と状態推定のためのカルマンフィルタ（KF）を組み合わせる線形二次ガウシアン（LQG）コントローラーを採用している。
• バッテリーモデリング: エネルギー効率を評価するために、電圧降下、充電状態（SoC）の進化、および高電流需要に対する過渡応答を含むバッテリー動力学をシミュレートする、テブナンの等価回路モデルを使用する。

2. C-ZUPT メカニズム

中核的な革新は、表面との物理的接触を必要とせずに ZUPT 補正をトリガーするために、飛行中に「準静的平衡」を識別するヒューリスティックである。

• 検出ロジック: アルゴリズムは、スライディングウィンドウ（K サンプル）にわたって推定されたボディ速度（$\hat{v}_B$）と特定力（$\tilde{f}$）の $L_2$ ノルムを監視する。
• トリガー条件: 両方のノルムが事前に定義された閾値（$\delta_{\hat{v}}$ および $\delta_{\tilde{f}}$）を下回ると、システムは準静止状態であると仮定する。
• 補正: 検出されると、フィルタは速度状態に対して疑似測定更新（$y_k = 0$）を適用し、速度誤差を実質的にリセットし、不確実性の成長を抑制する。これは「情報支援」メカニズムとして実装され、ホバリング平衡の物理学的原理から導かれた合成測定として機能する。

3. シグナルフローと実装

このアプローチは、制御ループにおける現実世界の非理想性を考慮している。

• コマンド処理: LQR の出力は、物理的な実現可能性を確保するために非負最小二乗法（NNLS）ソルバーを介してローター速度に変換され、その後 PWM 生成が行われる。
• アクチュエータ動力学: ローターの慣性と空気力学的遅れは一次系としてモデル化され、コマンドと実際の推力との間に遅延が生じる。
• 統合: 定常性が検出された場合、C-ZUPT 更新は KF の標準的な予測ステップをバイパスし、ゼロ速度制約を直接推定ループに注入する。

主要な貢献

1. センサーレス航空 ZUPT: 地表との接触に依存せず、準静的平衡を維持するために能動制御を活用する、航空プラットフォーム向けの最初の ZUPT 実装を提案する。
2. ドリフト耐性航法: 静止段階中のドリフトを抑制するようにクアッドコプター向けに調整された特定の速度補正法を提示し、公開されているフレームワークを通じて検証した。
3. バッテリー感知推定: 推定精度と電力消費の関係を定量化できるようにする統合回路モデルにより、リアルタイムのエネルギー監視を可能にする。
4. 高忠実度運動モデリング: LQG 制御とバッテリー動力学およびアクチュエータ遅延を結合し、センサー制限下での現実的な飛行条件をシミュレートする包括的なシステムモデルを提供する。

結果と分析

更新レート（$\Gamma$）と擾乱レベルを変化させた条件下でシステムを評価し、C-ZUPT 支援システムを支援なしのベースラインと比較するための広範なシミュレーションが実施された。

• 安定性と誤差低減: 疎な GNSS 更新（例：$\Gamma = 0.005$）のシナリオにおいて、支援なしのシステムは推定誤差と制御誤差で顕著な発散を示した。C-ZUPT システムは安定性を維持し、以下の改善を実現した。
  • 追跡誤差を**28.8%**削減
  • 姿勢誤差を**21.6%**削減
  • 制御飽和時間を**76.9%**削減
  • 推定不確実性を**28%**削減
• 制御努力: 速度ドリフトを補正することにより、C-ZUPT はホバリングを維持するために必要な制御努力を約**31.9%**削減した。
• エネルギー効率: 制御努力の削減は直接的に電力節約につながった。C-ZUPT システムは、ベースラインと比較して平均電力消費と電流引き込みを**3% から 7%**削減することを示した。
• 飛行時間の延長: 効率の向上により、30% のバッテリー SoC に達するまでの推定安全ホバリング時間が、テストされたすべての擾乱レベルでほぼ1 分増加し、システム全体の効率で**3% から 6%**の改善を表した。

意義と主張

著者は、C-ZUPT が GNSS 利用不可環境におけるリソース制約のある航空システムの運用耐空性を延長するための実用的な解決策を提供すると主張している。制御されたホバリングの固有の安定性を活用することで、この手法は追加のセンサーを必要とせずにフィルタの発散を軽減し、航法の安定性を高める。

この論文は、エネルギー効率と持続的な飛行が最優先される時間的制約のあるミッションにおいて、これらの改善が重要であると述べており、特に以下の応用例を挙げている。

• 都市戦および警察活動
• 救助活動
• 持続的監視
• インフラ点検
• 配送サービス

著者は限界を認め、この手法は温和な動力学（速度誤差は有界でなければならない）に依存しており、感度と偽陽性のバランスを取るためにヒューリスティックパラメータ（閾値とウィンドウサイズ）の慎重な調整が必要であると指摘している。それでもなお、本研究は C-ZUPT が航空機の静止間隔を、堅牢なセンサーレス航法のための重要な資産へと効果的に変換すると結論づけている。