[发明专利]一种航向平滑方法

摘要

本发明提供了一种航向平滑方法，所述方法包括：实时获取陀螺仪输出角速率；获取当前时刻角加速度εk；对n个当前时刻角加速度εk进行平滑处理获取平滑后的角加速度基于待平滑的航向ψref、上一时刻平滑后的航向ψk‑1、陀螺仪输出角速率的输出周期T、平滑后的角加速度上一时刻平滑后的航向角速率ω2，k‑1、当前时刻陀螺仪输出角速率ω1，k获取当前时刻平滑后的航向角速率ω2，k；基于待平滑的航向ψref、上一时刻平滑后的航向ψk‑1、陀螺仪输出角速率的输出周期T、当前时刻平滑后的航向角速率ω2，k获取当前时刻平滑后的航向ψk。本发明的技术方案对航向进行平滑，平滑后的航向较好地跟踪了真实航向变化，且测量噪声大幅降低，在受干扰时段仍然保持了良好的航向精度；还使航向保持了优良的动态性能。