iNavFlight项目中光学流量传感器与高度保持功能的问题分析

光学流量传感器安装后的高度保持异常

在iNavFlight 8.0.0版本中，用户报告了一个关于光学流量传感器(MTF-01)安装后导致高度保持功能异常的问题。该问题表现为：在2米以下高度时功能正常，但在更高高度时失效。经过一系列测试和分析，发现了几个关键的技术要点。

问题现象与初步诊断

用户最初观察到以下现象：

• 高度保持功能在安装光学流量传感器前工作正常
• 安装后仅在2米以下高度正常工作
• 在约16米高度时，测距仪报告零高度值，但表面可靠性显示为1000

通过黑匣子日志分析，发现测距仪数据在超过一定高度后变得不可靠。具体表现为：

• 在120cm高度时测距数据可靠
• 在3米高度时数据开始出现异常
• 在16米高度时完全失效

技术深入分析

测距仪工作原理与限制

测距仪(特别是光学类型)通常有以下特性：

1. 测量范围有限，超出最大有效距离后读数不可靠
2. 具有广角探测特性(接近180度)，容易受到周围物体反射干扰
3. 在灰尘或雾天环境下可能产生错误读数

iNavFlight中的相关参数

系统中有几个关键参数影响高度保持行为：

• nav_max_terrain_follow_alt：表面模式下允许的最大飞行高度
• inav_max_surface_altitude：测距仪读数可信的最大高度
• inav_w_z_surface_p和inav_w_z_surface_v：控制测距仪数据在Z轴位置估计中的权重

表面模式与MSL模式

系统提供两种高度参考模式：

1. 表面模式(Surface Mode)：使用测距仪数据作为主要高度参考
2. MSL模式(平均海平面模式)：使用气压计作为主要高度参考

当表面模式关闭时，系统理论上不应使用测距仪数据，但实际实现中仍可能在某些情况下(如自动降落)使用。

问题根源与解决方案

最终发现问题的根本原因是测距仪安装不当。由于光学测距仪的广角特性，任何进入其视野的物体(即使不在正下方)都可能干扰测量结果，特别是在高高度时主信号变弱的情况下。

解决方案包括：

1. 重新安装测距仪，确保其下方和周围没有干扰物
2. 合理设置测距仪可信高度范围(inav_max_surface_altitude)
3. 在不需要测距仪的场景下，可以通过设置inav_w_z_surface_p和inav_w_z_surface_v为零来完全禁用其对位置估计的影响

最佳实践建议

基于此案例，为使用iNavFlight系统的开发者提供以下建议：

1. 仔细选择测距仪安装位置，避免周围干扰
2. 根据实际测距仪性能设置可信高度范围
3. 在不需要精确地面高度保持的场景，考虑使用MSL模式
4. 定期检查测距仪读数可靠性，特别是在环境条件变化时
5. 对于光学测距仪，注意其在灰尘、雾等条件下的性能下降

通过正确配置和使用测距仪，可以充分发挥iNavFlight系统的高度保持功能，同时避免因传感器问题导致的飞行异常。