死亡推算故障安全系统

Copter 包括 Dead Reckoning Failsafe(惯性导航故障保护功能),它允许载具在失去 GPS(或更准确地说,在失去基于 GPS、OpticalFlow 等的位置估计时)时返航(或部分返航)。

备注

Copter-4.3 (及更高版本)中提供了此故障保护功能

设置

何时触发?

遇难自动装置将在相同条件下触发。 EKF 故障安全.也就是说,当罗盘、位置或速度的任何两个 EKF "方差 "都大于 FS_EKF_THRESH 参数 1 秒钟。在实际操作中,预计通常是 GPS 丢失触发故障安全。

触发故障安全保护后会发生什么?

  • GPS 丢失后,飞行器将继续正常飞行 7 至 10 秒钟。

  • GCS 上将显示 "惯性导航开始",载具将切换到 RTL 模式,开始飞回家

  • 如果载具在 FS_DR_TIMEOUT 秒,则 EKF 故障安全 将触发,载具将切换到 土地 模式

  • 即使 GPS 在载具返航时恢复,载具仍将保持 RTL 状态

测试

按照以下说明在模拟器或真实载具上进行测试。如果在真实载具上测试,请准备好在人工模式下重新获得控制权(例如 稳定AltHold)

  • 设置 RC9_OPTION 调至 65,以便禁用 GPS。 辅助开关 (可使用任何 RC 输入通道)

  • 在任何需要 GPS 的模式下上膛和飞行飞行器(例如 位置悬停, 指导, 载具等)。

  • 通过检查地面站中的 "wind_dir "和/或 "wind_vel",确保 EKF 已计算出风速估计值(请参阅 "实时查看风速和风向 "章节)。 本页)

  • 将辅助开关调高以禁用 GPS

  • 在 7 至 10 秒内,GCS 上应显示 "Dead Reckoning started"(惯性导航开始),并且载具应切换到 "Dead Reckoning started"(惯性导航开始)。 RTL 模式,开始飞回家

  • 之后 FS_DR_TIMEOUT 秒钟 EKF 故障安全 将触发,载具将切换到 陆地模式

  • 如果载具位置偏移过大,切换到 AltHold 模式,以恢复对载具的控制

  • 随时放下辅助开关以重新启用 GPS

  • 测试后,降低或升高 FS_DR_TIMEOUT 参数,以反映载具在没有 GPS 的情况下保持控制的最长秒数。

视频