PX4实战（十一）：PX4运动规划模块（flight mode manager）详解

PX4实战（十一）：PX4运动规划模块（flight mode manager）详解

• 引言
• 1. 理论基础与架构定位
• • 1.1 分层控制架构中的制导层 (Guidance Layer)
  • 1.2 反应式系统设计 (Reactive System Design)
  • 1.3 TrajectorySetpoint 消息的完备性
• 2. 代码深度剖析：类层次结构与模块实现
• • 2.1 抽象基类 FlightTask 的设计契约
  • 2.2 手动控制分支 (The Manual Branch)
  • • 2.2.1 FlightTaskManual (基类)
    • 2.2.2 FlightTaskManualPosition
    • 2.2.3 FlightTaskManualPositionSmoothVel
  • 2.3 自动与盘旋控制分支
• 3. 核心算法深研：轨迹生成与平滑数学模型
• • 3.1 速度平滑算法 (Velocity Smoothing Algorithm)
  • 3.2 刹车逻辑的物理建模
  • 3.3 盘旋模式中的控制反转问题 (Code Analysis)
• 4. 实战经验：参数调优与飞行手感
• • 4.1 针对航拍/巡检的“电影感”调优
  • 4.2 针对穿越/竞速的“响应感”调优
  • 4.3 垂直通道的特殊性
• 5. v1.14 版本特性的关键变迁：动态控制分配与故障保护
• • 5.1 动态控制分配 (Dynamic Control Allocation) 的引入
  • 5.2 集中式故障保护状态机 (Centralized Failsafe State Machine)
• 6. 与外部控制 (Offboard) 的交互
• • 6.1 心跳机制与模式回退
  • 6.2 消息字段的严格校验
• 7. 结论