Pixhawk & eVTOL 飛行制御 完全攻略：PX4、カルマンフィルター、PWM信号、センサーフュージョンからROS2統合まで

• 1. 概要
• 2. Pixhawk — オープンソース飛行制御機の標準
  • 2.1 Pixhawkとは
  • 2.2 FMUバージョン履歴
  • 2.3 Pixhawk 6X (FMUv6X) 詳細仕様
  • 2.4 Pixhawk 6C (FMUv6C)
  • 2.5 対応オートパイロットファームウェア
  • 2.6 エコシステム
• 3. 飛行制御システムアーキテクチャ
  • 3.1 カスケード制御構造
  • 3.2 PIDコントローラー
  • 3.3 位置/速度コントローラー
  • 3.4 姿勢/角速度コントローラー
  • 3.5 ミキサー（Control Allocation）
• 4. PWM信号とESCプロトコル
  • 4.1 PWM（Pulse Width Modulation）の原理
  • 4.2 ESCプロトコル比較
  • 4.3 DShotプロトコル詳細
  • 4.4 PWM vs DShot 主要な違い
• 5. カルマンフィルター — 飛行制御の核心アルゴリズム
  • 5.1 カルマンフィルターの基本原理
  • 5.2 拡張カルマンフィルター（EKF）
  • 5.3 エラーステートカルマンフィルター（ESKF）
  • 5.4 PX4 EKF2 (ECL EKF) — 24個の状態ベクトル
  • 5.5 ArduPilot EKF2 vs EKF3
  • 5.6 相補フィルター vs カルマンフィルター
• 6. eVTOL（Electric Vertical Takeoff and Landing）
  • 6.1 eVTOLとは
  • 6.2 市場動向
  • 6.3 機体構成タイプ
    • マルチローター（Multirotor）
    • リフト＋クルーズ（Lift + Cruise）
    • ティルトローター（Tiltrotor）
    • ティルトウィング（Tiltwing）
  • 6.4 認証体系
  • 6.5 バッテリー技術
• 7. PX4オートパイロット
  • 7.1 アーキテクチャ
  • 7.2 飛行モード
  • 7.3 MAVLinkプロトコル
• 8. ArduPilot
  • 8.1 PX4 vs ArduPilot
  • 8.2 対応機体
• 9. ROS2統合
  • 9.1 2つの統合方式
  • 9.2 オフボード制御の例
• 10. SITL/HITLシミュレーション
  • 10.1 SITL（Software-In-The-Loop）
  • 10.2 HITL（Hardware-In-The-Loop）
  • 10.3 Gazebo統合
• 11. 学習ロードマップ
  • 11.1 基礎（1-2か月）
  • 11.2 中級（2-4か月）
  • 11.3 上級（4-6か月）
• 12. References
  • 公式ドキュメント
  • ハードウェア
  • 制御および推定
  • ESCプロトコル
  • eVTOL
  • ROS2統合
  • GitHubリポジトリ

1. 概要

ドローンとeVTOL（電動垂直離着陸機）は、もはや実験的な技術ではない。2026年にはJoby AviationとArcher Aviationが商業運航を開始し、都市型エアモビリティ（UAM）は現実のものとなりつつある。これらすべての技術の中心にあるのが飛行制御システムである。

本記事では、飛行制御の核心要素を総まとめする。

┌────────────────────────────────────────────────────────────┐
│                 飛行制御システム全体構造                        │
│                                                             │
│  センサー層       推定層            制御層         出力層    │
│  ┌─────────┐    ┌──────────┐    ┌──────────┐    ┌────────┐ │
│  │IMU(6軸) │    │カルマン    │    │ PID 制御 │    │  PWM/  │ │
│  │GPS      │──→│フィルター  │──→│ 位置→速度 │──→│ DShot  │ │
│  │気圧計    │    │(EKF2/3)  │    │ →姿勢→角速度│    │  ESC   │ │
│  │地磁気    │    │センサー   │    │ →ミキサー  │    │ モーター│ │
│  │         │    │フュージョン│    │          │    │        │ │
│  └─────────┘    └──────────┘    └──────────┘    └────────┘ │
│                                                             │
│  通信: MAVLink ←→ QGroundControl / ROS2 / コンパニオンPC     │
└────────────────────────────────────────────────────────────┘

2. Pixhawk — オープンソース飛行制御機の標準

2.1 Pixhawkとは

Pixhawkは特定の製品ではなく、オープンハードウェア標準である。Dronecode Foundation（Linux Foundation傘下）が管理しており、世界中で100万台以上のPixhawkベースのデバイスが運用されている。

2.2 FMUバージョン履歴

2.3 Pixhawk 6X (FMUv6X) 詳細仕様

プロセッサ：

• FMU: STM32H753 (Cortex-M7, 480MHz, 2MB Flash, 1MB RAM)
• IO: STM32F103 (Cortex-M3, 72MHz, 64KB SRAM)

搭載センサー（三重冗長）：

主要インターフェース：

• 16+ PWMサーボ出力（IO 8個 + FMU 8個）
• イーサネットPHY — ミッションコンピュータとの高速通信
• 4× UART, 3× SPI, 2× CAN, 2× I2C
• USB-C, RC入力（SBUS/CPPM/DSM）

モジュラー設計： IMU Board + FMU Board + Base Boardが100ピン/50ピンPixhawk Autopilot Busコネクタで分離

2.4 Pixhawk 6C (FMUv6C)

2.5 対応オートパイロットファームウェア

2.6 エコシステム

メーカー：Holybro, CUAV, ARK Electronics, ModalAI, NXP, mRo, Auterion ツール：QGroundControl（GCS）, MAVLink, MAVSDK, MAVROS, ROS2統合

3. 飛行制御システムアーキテクチャ

3.1 カスケード制御構造

PX4マルチコプター制御機は、カスケード位置-速度-姿勢-角速度ループを使用する。

[位置 SP] →[位置 P]→ [速度 PID] → [姿勢 P] → [角速度 K-PID] → [ミキサー] → [モーター]
  外部ループ              中間ループ       姿勢ループ       内部ループ
  ~50Hz                 ~50Hz          ~250Hz         ~1000Hz

3.2 PIDコントローラー

連続時間PID：

$u(t) = K_p \cdot e(t) + K_i \int_0^t e(\tau) d\tau + K_d \frac{de(t)}{dt}$

離散時間PID（飛行制御機実装）：

$u[k] = K_p \cdot e[k] + K_i \sum_{j=0}^{k} e[j] \cdot \Delta t + K_d \frac{e[k] - e[k-1]}{\Delta t}$

3.3 位置/速度コントローラー

位置コントローラー（P）：

$\vec{v}_{sp} = K_p^{pos} \cdot (\vec{p}_{sp} - \vec{p}_{est})$

• PX4パラメータ：MPC_XY_P, MPC_Z_P
• 速度飽和：MPC_XY_VEL_MAX

速度コントローラー（PID）： 速度誤差 → 加速度設定値、Anti-reset windup適用

3.4 姿勢/角速度コントローラー

姿勢コントローラー（P、クォータニオンベース）：

$\vec{\omega}_{sp} = K_p^{att} \cdot \vec{e}_{att}$

角速度コントローラー（K-PID）： 微分経路にローパスフィルターを適用しノイズ低減

ジャイロデータ処理パイプライン：

1. キャリブレーション補正 → 2. バイアス除去 → 3. ノッチフィルター → 4. ローパスフィルター

3.5 ミキサー（Control Allocation）

角速度コントローラーの出力を個別モーター指令に変換する。

クアッドコプターX構成の例：

$\begin{bmatrix} M_1 \\ M_2 \\ M_3 \\ M_4 \end{bmatrix} = \begin{bmatrix} 1 & -1 & 1 & 1 \\ 1 & 1 & -1 & 1 \\ 1 & 1 & 1 & -1 \\ 1 & -1 & -1 & -1 \end{bmatrix} \begin{bmatrix} T \\ \tau_x \\ \tau_y \\ \tau_z \end{bmatrix}$

ここで $T$=総推力、$\tau_x$=ロールトルク、$\tau_y$=ピッチトルク、$\tau_z$=ヨートルク

4. PWM信号とESCプロトコル

4.1 PWM（Pulse Width Modulation）の原理

PWMは、デジタル信号のデューティサイクルを変調することでアナログ値を伝達する手法である。

     ┌────┐              ┌────────┐
     │    │              │        │
─────┘    └──────────────┘        └──────────
     |<-->|              |<------>|
     1000μs              2000μs
     (0% スロットル)       (100% スロットル)
     |<-------------------->|
         20ms (50Hz 周期)

4.2 ESCプロトコル比較

4.3 DShotプロトコル詳細

DShotは2025年現在、事実上の標準ESCプロトコルである。

フレーム構造（16ビット）：

[11ビット スロットル (0-2047)] [1ビット テレメトリ要求] [4ビット CRC]

• スロットル値1-47：特殊コマンド予約（ビープ音、モーター方向反転、ESC設定）
• ビットエンコーディング：HIGH/LOW比率で0/1を区別（1=75% HIGH、0=37.5% HIGH）

双方向DShot（Bidirectional DShot）：

• ESCがeRPMテレメトリをFCに返信
• リアルタイムRPMデータでダイナミックノッチフィルター適用 → 振動除去性能が大幅向上
• 提供データ：RPM、電圧、電流、温度

4.4 PWM vs DShot 主要な違い

5. カルマンフィルター — 飛行制御の核心アルゴリズム

5.1 カルマンフィルターの基本原理

カルマンフィルターは、ノイズを含む複数センサーの測定値からシステムの状態を最適に推定する再帰的アルゴリズムである。

┌──────────────────────────────────────────────────────┐
│              カルマンフィルターサイクル                     │
│                                                       │
│  ┌──────────────────┐     ┌──────────────────┐       │
│  │  第1段階: 予測     │     │  第2段階: 更新     │       │
│  │  (Prediction)     │────►│  (Update)        │       │
│  │                  │     │                  │       │
│  │  x̂ = F·x + B·u  │     │  K = P·Hᵀ·S⁻¹   │       │
│  │  P = F·P·Fᵀ + Q │     │  x̂ = x̂ + K·(z-Hx̂)│       │
│  │                  │     │  P = (I-KH)·P    │       │
│  │ モーションモデルで │     │  測定値で補正      │       │
│  │ 予測              │     │                  │       │
│  └──────────────────┘     └────────┬─────────┘       │
│           ▲                        │                  │
│           └────────────────────────┘                  │
│                    繰り返し                             │
└──────────────────────────────────────────────────────┘

第1段階：予測（Time Update）

$\hat{x}_{k|k-1} = F_k \hat{x}_{k-1|k-1} + B_k u_k$

$P_{k|k-1} = F_k P_{k-1|k-1} F_k^T + Q_k$

第2段階：更新（Measurement Update）

$K_k = P_{k|k-1} H_k^T (H_k P_{k|k-1} H_k^T + R_k)^{-1}$

$\hat{x}_{k|k} = \hat{x}_{k|k-1} + K_k (z_k - H_k \hat{x}_{k|k-1})$

$P_{k|k} = (I - K_k H_k) P_{k|k-1}$

カルマンゲインの直感的理解：

• $K \to 1$：測定値をより信頼（測定ノイズが小さい）
• $K \to 0$：予測値をより信頼（モデルが正確）

5.2 拡張カルマンフィルター（EKF）

ドローンの力学は非線形であるため、標準カルマンフィルターを直接適用することができない。EKFは非線形関数を1次テイラー級数展開で線形化する。

非線形システム：

$x_k = f(x_{k-1}, u_k) + w_k \quad \text{（状態遷移）}$

$z_k = h(x_k) + v_k \quad \text{（観測）}$

EKF予測：

$\hat{x}_{k|k-1} = f(\hat{x}_{k-1|k-1}, u_k)$

$P_{k|k-1} = F_k P_{k-1|k-1} F_k^T + Q_k, \quad F_k = \frac{\partial f}{\partial x}\bigg|_{\hat{x}_{k-1}}$

EKF更新：

$K_k = P_{k|k-1} H_k^T (H_k P_{k|k-1} H_k^T + R_k)^{-1}, \quad H_k = \frac{\partial h}{\partial x}\bigg|_{\hat{x}_{k|k-1}}$

5.3 エラーステートカルマンフィルター（ESKF）

PX4のEKF2はError-State Kalman Filterを実装している。クォータニオン回転の不確実性推定において核心的な役割を果たす。

核心アイデア：

• クォータニオンを直接推定せず、誤差回転ベクトルを推定
• SO(3)の接線空間で3Dベクトルとして回転の不確実性を表現
• Nominal State（慣性航法方程式）とError State（カルマンフィルター）を分離

$\delta x = x_{true} - \hat{x}_{nominal}$

5.4 PX4 EKF2 (ECL EKF) — 24個の状態ベクトル

センサーフュージョンアーキテクチャ：

• 遅延フュージョン：センサーごとの時間遅延を吸収するためFIFOバッファに格納し、同一時点のデータをフュージョン
• IMUデータ：状態の予測にのみ使用し、観測値としては使用しない
• 複数EKFインスタンス：故障検知を強化（MAX(IMU数,1) × MAX(磁力計数,1)、最大16個）
• 多重仮説フィルター：ガウス和フィルターでヨー（Yaw）を推定、GPS速度のみでも可能

5.5 ArduPilot EKF2 vs EKF3

5.6 相補フィルター vs カルマンフィルター

$\theta_{est} = \alpha \cdot (\theta_{est} + \omega_{gyro} \cdot \Delta t) + (1-\alpha) \cdot \theta_{accel}$

ここで $\alpha = \frac{\tau}{\tau + \Delta t}$（通常0.96~0.98）

6. eVTOL（Electric Vertical Takeoff and Landing）

6.1 eVTOLとは

電動推進システムで垂直離着陸し、水平飛行する航空機である。都市型エアモビリティ（UAM）の核心として、「空飛ぶタクシー」時代を切り開いている。

6.2 市場動向

• 市場規模：2025年 約42億ドル → 2033年 約80億ドル（CAGR 37%）
• 2026年に商業運航開始予定：Joby Aviation, Archer Aviation

6.3 機体構成タイプ

マルチローター（Multirotor）

    ①        ②
     \      /
      ┌────┐
      │    │
      └────┘
     /      \
    ③        ④

• 4~8個のローターが揚力+推力を両方提供
• 長所：シンプル、安定したホバリング
• 短所：エネルギー効率が最悪（巡航時に非効率）
• 代表：EHang EH216-S, Volocopter VoloCity

リフト＋クルーズ（Lift + Cruise）

    垂直ローター  垂直ローター         後方プロペラ
      ↓          ↓                  ↓
    ┌──┐      ┌──┐    ═══════    ▶───
    └──┘      └──┘    翼

• 垂直離陸用ローター + 水平飛行用プロペラを分離
• 長所：各飛行段階を最適化
• 短所：垂直ローターが巡航時にデッドウェイト
• 代表：Archer Midnight, Vertical Aerospace VX4

ティルトローター（Tiltrotor）

  ホバリング:  →  巡航:
  ↑  ↑       →  →
  │  │       ╱  ╲
  ┌──┐      ┌──────┐
  └──┘      └──────┘

• ローターが垂直/水平方向にティルト
• 長所：単一推進システムで効率的
• 短所：ティルト機構の複雑さ
• 代表：Joby S4（6個ティルト）, Bell Nexus

ティルトウィング（Tiltwing）

• 翼自体がローターとともにティルト
• 高速・長距離能力
• 代表：Lilium Jet（36個の電動エンジンを翼に内蔵）

6.4 認証体系

FAA（米国）：

• eVTOLを**「Powered-Lift」**カテゴリに再分類
• AC 21.17-4（2025.07）：最大12,500 lbs、6席以下、バッテリー電動推進
• Joby：Stage 4認証70%完了（2025 Q3）
• Archer：55マイル最長有人飛行達成（2025.08）

EASA（欧州）：

• SC-VTOL（Special Condition - VTOL）発行
• FAAとの基準調和（harmonization）推進

6.5 バッテリー技術

全固体電池のブレークスルー：

• EHang + Inx：480 Wh/kg達成
• 世界初のeVTOL全固体電池飛行試験成功（48分10秒）
• 長所：高エネルギー密度、熱安定性、引火性低減

7. PX4オートパイロット

7.1 アーキテクチャ

PX4はマイクロカーネル哲学に従い、モジュール間通信に**uORB（Micro Object Request Broker）**パブリッシュ-サブスクライブバスを使用する。

┌──────────────────────────────────────────────────┐
│                PX4 Flight Stack                   │
│                                                   │
│  センサードライバー ──┐                              │
│  EKF2 推定器     ──┼──→ [uORB バス] ──→ MAVLink   │
│  制御モジュール   ──┤              ──→ ミキサー/    │
│  飛行モード      ──┘              │   アクチュエーター│
│                                  ──→ ロガー       │
└──────────────────────────────────────────────────┘

7.2 飛行モード

手動モード：

補助モード：

自律モード：

7.3 MAVLinkプロトコル

ドローン-地上局/コンパニオン間の軽量メッセージングプロトコル。

MAVLink v2メッセージ構造：

[STX][LEN][INC][CMP][SEQ][SYS_ID][COMP_ID][MSG_ID(3B)][PAYLOAD][CRC][SIGNATURE]

• Heartbeat：1Hz周期、機体タイプ・飛行モード・システム状態を含む
• QGroundControl：MAVLinkベースのオープンソース地上管制ステーション

8. ArduPilot

8.1 PX4 vs ArduPilot

8.2 対応機体

9. ROS2統合

9.1 2つの統合方式

┌──────────────────┐     ┌──────────────────┐
│ コンパニオンPC     │     │ Pixhawk (PX4)    │
│                  │     │                  │
│  [ROS2 ノード]    │     │  [PX4 Autopilot] │
│       │          │     │       │          │
│  [uXRCE-DDS     │◄───►│  [uXRCE-DDS     │  ← 方式1（推奨）
│   Agent]         │UART │   Client]        │
│       または       │     │                  │
│  [MAVROS]       │◄───►│  [MAVLink]       │  ← 方式2（レガシー）
└──────────────────┘     └──────────────────┘

方式1：uXRCE-DDS（推奨）

• PX4内蔵DDSクライアント → ROS2 DDSに直接参加
• uORBトピックがROS2トピックに直接マッピング
• MAVLinkを経由しないため低遅延、高帯域幅

方式2：MAVROS（レガシー）

• MAVLink → ROS2トピック/サービスブリッジ
• ArduPilotとの互換性あり

9.2 オフボード制御の例

import rclpy
from rclpy.node import Node
from px4_msgs.msg import (
    OffboardControlMode,
    TrajectorySetpoint,
    VehicleCommand
)

class OffboardControl(Node):
    def __init__(self):
        super().__init__('offboard_control')
        self.offboard_pub = self.create_publisher(
            OffboardControlMode, '/fmu/in/offboard_control_mode', 10)
        self.trajectory_pub = self.create_publisher(
            TrajectorySetpoint, '/fmu/in/trajectory_setpoint', 10)
        self.command_pub = self.create_publisher(
            VehicleCommand, '/fmu/in/vehicle_command', 10)

    def arm(self):
        msg = VehicleCommand()
        msg.command = VehicleCommand.VEHICLE_CMD_COMPONENT_ARM_DISARM
        msg.param1 = 1.0  # Arm
        self.command_pub.publish(msg)

    def set_position(self, x, y, z):
        msg = TrajectorySetpoint()
        msg.position = [x, y, z]  # NED座標
        self.trajectory_pub.publish(msg)

10. SITL/HITLシミュレーション

10.1 SITL（Software-In-The-Loop）

実際のハードウェアなしに開発PC上で飛行ファームウェアを実行しシミュレーションを行う。

# PX4 SITL + Gazebo
cd PX4-Autopilot
make px4_sitl gz_x500

# Micro XRCE-DDS Agent（別ターミナル）
MicroXRCEAgent udp4 -p 8888

# ArduPilot SITL + Gazebo
sim_vehicle.py -v ArduCopter -f gazebo-iris --console --map

• 実際のファームウェアと同一のコードを実行（シミュレーションドライバーのみ異なる）
• リスクなしにアルゴリズム検証、高速な反復開発が可能

10.2 HITL（Hardware-In-The-Loop）

実際のPixhawkハードウェア上で通常のファームウェアを実行し、シミュレーターがセンサーデータを提供する。

• 実際のハードウェアタイミング・性能の検証
• ハードウェア互換性問題の事前発見
• 実飛行前の最終検証段階

10.3 Gazebo統合

Gazebo Harmonic（現在推奨）：

• 物理エンジン、センサーシミュレーション、カメラ/LiDARレンダリング
• PX4とMAVLinkまたは直接プラグイン通信
• ROS2 Humble連携

11. 学習ロードマップ

11.1 基礎（1-2か月）

11.2 中級（2-4か月）

11.3 上級（4-6か月）

12. References

公式ドキュメント

1. PX4 User Guide
2. PX4 Dev Guide
3. ArduPilot Copter Docs
4. MAVLink Guide
5. QGroundControl User Guide
6. Pixhawk Open Standards

ハードウェア

7. Holybro Pixhawk 6X
8. Holybro Pixhawk 6C
9. Dronecode FMUv6 Family

制御および推定

10. PX4 Controller Diagrams
11. PX4 EKF2 Tuning Guide
12. ArduPilot EKF Overview
13. Kalman Filter Tutorial

ESCプロトコル

14. DShot Protocol - Oscar Liang
15. ESC Firmware and Protocols - Oscar Liang
16. ArduPilot PWM/DShot ESCs

eVTOL

17. eVTOL Guide - Dewesoft
18. eVTOL Market Analysis - MotorWatt
19. FAA eVTOL Certification
20. EHang Solid-State Battery Flight

ROS2統合

21. PX4 ROS2 Integration
22. PX4 uXRCE-DDS Bridge
23. MAVROS GitHub

GitHubリポジトリ

24. PX4/PX4-Autopilot
25. ArduPilot/ardupilot
26. px4-offboard (ROS2サンプル)
27. MAVSDK