4、模式切换优先级与仲裁：PX4内部模式切换逻辑、优先级规则及冲突处理

PX4飞控系统的模式切换并非简单的“用户按一下遥控器开关，飞控就立即响应”的线性过程。在内部，每一次模式变更都要经过一套严密的仲裁逻辑，涉及指令来源的合法性校验、当前飞行状态的约束条件、以及多路指令同时到达时的优先级裁决。理解这套内部仲裁机制，是安全飞行的基础，也是排查“切不过去”“一切就炸”等疑难故障的关键。本章将深入PX4的Commander模块与Navigator模块，拆解其模式切换的优先级规则与冲突处理策略。

上图展示了PX4模式切换的整体架构。所有外部指令（遥控器、地面站、机载计算机）首先进入Commander模块进行统一仲裁。Commander根据预设的优先级规则和当前飞行状态，决定是否接受该指令，并将最终有效的模式指令下发给Navigator或直接作用于执行机构。下面我们将从核心原理、判断方法、实战案例和常见误区四个维度展开。

4.1 核心原理：Commander状态机与优先级矩阵

PX4的Commander模块本质上是一个有限状态机（FSM），它维护着飞控当前的主状态（如手动模式、任务模式、降落模式、失效保护模式等）。所有模式切换请求都必须经过这个状态机的“门卫”检查。其内部逻辑可以概括为三个层次：指令来源优先级、状态转换合法性、紧急指令抢占。

指令来源优先级是仲裁的第一道关卡。PX4将指令来源分为三个等级：最高级为遥控器（RC）直接操作，包括遥控器上的模式开关、摇杆动作以及急停开关；次高级为地面站（GCS）通过MAVLink发送的指令，例如QGroundControl中点击“任务开始”或“立即降落”；最低级为机载计算机（Onboard Computer）通过MAVLink或uORB发送的Offboard指令。当多个来源同时请求切换时，高优先级来源的请求会覆盖低优先级来源的请求。例如，当机载计算机正在执行Offboard模式时，如果用户拨动遥控器模式开关切换到“定高模式”，飞控会立即响应遥控器指令，退出Offboard模式。

状态转换合法性是第二道关卡。即使指令来源优先级很高，如果当前飞行状态不允许直接转换到目标模式，该指令也会被拒绝或延迟。例如，在固定翼飞机高速俯冲时，直接切换到“手动模式”是允许的，但切换到“任务模式”则要求飞机必须满足一定的姿态和位置条件（如已解锁、GPS信号良好、高度在安全范围内）。PX4通过commander_state_machine中的条件判断函数（如is_armed()、is_landed()、is_rotary_wing()）来执行这些校验。

紧急指令抢占是第三道关卡，也是最高优先级的仲裁逻辑。当检测到RC信号丢失、电池电压过低、姿态超限等失效保护条件时，Commander会强制将模式切换到预设的失效保护模式（如降落或返航），此时任何用户指令（包括遥控器模式开关）都无法阻止，除非用户主动取消失效保护（例如通过特定摇杆动作）。这种设计确保了在极端情况下，飞控优先保障安全。

优先级	指令来源	典型指令	仲裁规则
P0（最高）	失效保护 / 急停	RC信号丢失、电压过低、急停开关	无条件抢占，不可被用户指令覆盖
P1	遥控器（RC）	模式开关、摇杆姿态/油门	可覆盖P2/P3指令，但受状态合法性校验
P2	地面站（GCS）	任务开始、返航、降落指令	可覆盖P3指令，但受RC优先级压制
P3（最低）	机载计算机（Offboard）	位置/速度/姿态设定值	仅在无更高优先级指令时生效

4.2 判断方法：如何通过日志与参数识别仲裁结果

在实际调试中，我们往往需要判断“为什么模式切换没有生效”或“为什么模式被意外切换”。PX4提供了丰富的日志和参数来辅助分析。最直接的方法是查看飞行日志中的commander_state和vehicle_status消息。

在QGroundControl的日志分析工具中，可以找到vehicle_status.nav_state字段，它记录了飞控当前的实际模式。同时，commander_state.current_state记录了状态机的内部状态。当一次模式切换请求被拒绝时，日志中通常会有对应的commander_state变化记录，但nav_state不会改变。此外，PX4还会输出vehicle_status.arming_state和vehicle_status.failsafe字段，用于判断是否处于失效保护状态。

另一个重要的判断方法是检查参数COM_RC_OVERRIDE和COM_OB_L_ACT。其中COM_RC_OVERRIDE定义了当RC信号与Offboard指令冲突时的行为（默认值为1，表示允许RC覆盖）；COM_OB_L_ACT定义了Offboard模式失去RC信号时的动作（默认值为0，表示降落）。通过调整这些参数，可以改变仲裁的宽松程度。

# 查看当前模式切换相关的关键参数
param show COM_RC_OVERRIDE
param show COM_OB_L_ACT
param show COM_FAIL_ACT

# 在飞行日志中提取模式切换事件（使用pyulog工具）
ulog_info flight.ulg | grep "commander_state"
ulog_messages flight.ulg | grep "Mode"

当遇到模式切换异常时，建议按以下流程排查：

1. 确认指令是否到达飞控：检查日志中是否有对应的MAVLink指令接收记录（mavlink_received）。
2. 确认Commander是否接受：查看commander_state是否发生跳转，如果未跳转，则说明被状态机拒绝。
3. 确认执行层是否响应：查看vehicle_status.nav_state是否改变，如果改变，则说明切换成功。
4. 检查失效保护标志：确认vehicle_status.failsafe是否为真，如果是，则说明是紧急抢占。

4.3 案例拆解：Offboard模式被遥控器意外抢占的完整分析

下面通过一个实际工程案例来展示优先级仲裁的完整过程。某无人机团队使用PX4进行视觉导航实验，机载计算机通过Offboard模式发送位置设定值，飞机悬停在空中。在一次测试中，飞手为了保险，将遥控器模式开关拨到了“定高模式”，结果飞机立即退出Offboard模式，进入定高模式，导致视觉导航程序中断。

背景与约束：飞机为四旋翼，PX4版本1.13.3，机载计算机通过串口发送MAVLink指令。遥控器为FrSky X9D，模式开关映射到通道5。飞手在实验前未被告知Offboard模式会被RC覆盖。

初始现象：飞机在Offboard模式下悬停正常，飞手拨动遥控器模式开关后，飞机轻微抖动，然后进入定高模式，视觉导航程序报错退出。

关键数据：飞行日志显示，在拨动开关的瞬间，vehicle_status.nav_state从4（Offboard）跳变为2（定高模式），commander_state.current_state从OFFBOARD跳变为ALTCTL。同时，日志中记录了一条INFO消息：Commander: Mode change to ALTCTL。

分析判断：根据优先级规则，遥控器指令（P1）高于机载计算机指令（P3）。当飞手拨动开关时，Commander检测到RC模式通道变化，立即执行切换。由于定高模式是合法的飞行模式，且当前飞机状态（悬停）满足切换条件，因此切换被接受。整个过程没有失效保护触发，failsafe字段为false。

实际操作步骤：为了解决这个问题，团队采取了以下措施：

1. 修改参数COM_RC_OVERRIDE为2（仅允许RC在特定条件下覆盖），但发现这会影响其他实验的灵活性。
2. 更优的解决方案是：在机载计算机程序中增加对RC状态的监测，当检测到RC模式开关不在Offboard位置时，主动暂停视觉导航程序，而不是让飞控被动切换。
3. 同时，在飞手培训中明确强调：在Offboard实验期间，除非紧急情况，否则不要拨动模式开关。

结果对比：修改后，即使飞手误拨开关，机载计算机也能立即感知并安全退出，避免了程序崩溃。后续实验未再出现类似问题。

风险与代价：该方案增加了机载计算机的代码复杂度，且需要飞手与开发人员紧密配合。但相比飞控被意外抢占导致的任务失败，这种代价是值得的。

4.4 常见误区与总结复盘

在理解PX4模式切换优先级时，初学者常犯以下错误：

• 误区一：认为Offboard模式是“独占”的。实际上，Offboard模式只是优先级最低的一种模式，任何RC或GCS指令都可以随时打断它。
• 误区二：忽视状态合法性校验。即使优先级再高，如果飞机当前处于“未解锁”或“已降落”状态，切换到“任务模式”的请求也会被拒绝。例如，在地面上未解锁时，拨动模式开关到“任务”不会生效。
• 误区三：混淆“模式切换”与“控制权切换”。模式切换是指飞控内部状态机的变化，而控制权切换是指由谁（飞手或机载计算机）来生成期望值。PX4中，即使模式没有切换，也可以通过参数设置改变控制权（如COM_RC_OVERRIDE）。
• 误区四：忽略失效保护的抢占性。当失效保护触发时，飞控会强制切换到预设模式，此时任何用户指令都会被忽略，直到失效保护条件解除。很多新手在飞丢RC信号后，试图通过地面站发送“返航”指令，但发现无效，原因就是失效保护已经接管了控制权。

总结来看，PX4的模式切换仲裁是一个“来源优先级 + 状态合法性 + 紧急抢占”的三层过滤机制。在实际工程中，我们不仅要理解这个机制，还要学会通过日志和参数来验证仲裁结果。对于开发者而言，设计机载计算机程序时，应主动适应这种仲裁规则，而不是试图绕过它。对于飞手而言，理解“遥控器永远优先”是安全飞行的第一课。