QGroundControl中"前往位置"功能失效问题分析与解决方案

问题背景

在使用QGroundControl地面站软件配合Pixhawk 6C控制器运行ArduPilot固件时，用户报告在飞行视图中无法使用"前往位置"(Go to location)功能。根据文档描述，该功能应在起飞后通过点击地图激活，但实际仅显示设置家和估计器原点的选项。

问题分析

经过深入调查，发现该问题与飞行状态检测机制有关。QGroundControl通过特定的MAVLink消息来判断设备是否处于飞行状态，而这一机制在特定情况下会出现异常。

技术细节

1. 飞行状态检测机制：

   • QGroundControl通常使用MAVLINK_MSG_ID_EXTENDED_SYS_STATE消息来判断飞行状态
   • 但ArduPilot固件不支持此消息
   • 因此软件回退到使用HEARTBEAT.system_status进行判断

2. 问题根源：

   • 当设备初始处于故障保护(failsafe)状态时
   • 系统从未接收到MAV_STATE_ACTIVE状态
   • 导致飞行状态检测失败
   • 进而使"前往位置"功能无法激活

3. 典型触发场景：

   • 用户尝试不使用RC遥控器，仅通过无线电遥测进行控制
   • 这种情况下控制器会进入故障保护模式
   • 系统状态直接变为MAV_STATE_CRITICAL或EMERGENCY
   • 跳过了正常的ACTIVE状态

解决方案

开发团队已针对此问题提出了修复方案：

1. 逻辑优化：

   • 修改飞行状态判断逻辑
   • 不再依赖初始状态
   • 将任何ACTIVE/CRITICAL/EMERGENCY状态都视为飞行状态

2. 实现说明：

   if (vehicle->armed()) {
       flying = heartbeat.system_status == MAV_STATE_ACTIVE;
       if (!flying && vehicle->flying()) {
           flying = heartbeat.system_status == MAV_STATE_CRITICAL || 
                   heartbeat.system_status == MAV_STATE_EMERGENCY;
       }
   }
   vehicle->_setFlying(flying);
   

3. 兼容性考虑：

   • 虽然这不是100%完美的解决方案
   • 但在ArduPilot不支持EXTENDED_SYS_STATE的情况下
   • 这已经是最接近实际情况的判断方式

用户建议

对于遇到类似问题的用户，可以采取以下措施：

1. 确保正常飞行模式：

   • 使用RC遥控器进行标准控制操作
   • 避免直接进入故障保护状态

2. 软件版本选择：

   • 使用包含此修复的QGroundControl每日构建版本
   • 或等待下一个稳定版本发布

3. 替代方案：

   • 在任务规划视图中预先设置航点
   • 使用自动任务模式代替手动"前往位置"功能

总结

这一问题展示了开源控制生态系统中不同组件间的兼容性挑战。QGroundControl团队通过深入分析MAVLink通信机制和飞行状态判断逻辑，提出了针对ArduPilot固件的优化方案。这既解决了当前问题，也为未来类似兼容性问题提供了参考解决思路。

对于高级用户而言，理解这些底层机制有助于更好地诊断和解决控制中的异常情况，确保任务顺利进行。