Skip to content
返回搜索结果

姿态航向参考系统 (AHRS)

提出者
Aviation heritage
年份
1940s
类型
System
类别
Attitude Estimation

本文为机器翻译,尚未经过审校。 阅读英文原文

字号

它有什么作用?

姿态航向参考系统 (AHRS) 是一种完整的惯性导航子系统,用于估计和输出飞行器或平台的三个维度上的姿态和航向。AHRS 通过传感器融合算法(通常是卡尔曼滤波器或互补滤波器)结合加速度计、陀螺仪和磁力计的测量值,提供无漂移、快速的姿态估计。AHRS 在航空、航海导航和现代自主系统中是标准配置。

方法背后的直觉

陀螺仪直接测量角速度,在短时间尺度(秒级)内精度高,但会随时间漂移(噪声和偏差积分)。加速度计感知重力,长期稳定但噪声大,无法直接测量水平旋转。罗盘(磁力计)测量相对于地球磁场的航向,但易受局部干扰。AHRS 融合这三者,利用各自的优势:陀螺仪用于即时响应,加速度计和罗盘用于长期稳定性。

历史学

使用机械陀螺仪的飞机姿态参考可以追溯到 1920 年代(Sperry)。现代电子 AHRS 出现于 1970–1980 年代,随着固态传感器的出现。1990–2000 年代微机电系统 (MEMS) 陀螺仪、加速度计和磁力计的集成使得紧凑、低功耗的 AHRS 成为可能。2010 年代的算法进步(Madgwick 滤波器、Mahony 滤波器)使得在计算成本极低的情况下实现精确姿态成为可能,从而促进了其在消费电子产品和无人机中的应用。

何时使用

当需要实时、无漂移的姿态和航向信息时,请使用 AHRS。对于飞机自动驾驶仪、航海导航系统、无人机、机器人和移动设备至关重要。AHRS 是飞行控制、稳定和导航系统的基础。当单个传感器测量值(仅陀螺仪、仅罗盘)因漂移或噪声不足时,请部署 AHRS。适用于所有天气和光照条件(与基于视觉的姿态不同)。

局限与注意事项

  • 磁力计干扰;局部磁异常(钢结构、电气系统、车辆电子设备)会降低航向精度;需要补偿或重新校准。
  • 大幅度加速度;在机动过程中,加速度计会同时测量重力和惯性加速度,导致俯仰/横滚误差;滤波器必须使用运动模型来缓解。
  • 欧拉角中的万向节锁;90 度俯仰时的奇点需要仔细的数值处理;四元数表示可避免此问题。
  • 初始化;系统在启动时必须保持静止(或以已知运动)才能初始化姿态;动态初始化很复杂。

来源中的条件不能替代独立的科学审查或分析引擎的验证。

优势

  • 长期无漂移;融合了稳定但噪声大的传感器(加速度计、罗盘)与易漂移但响应快的传感器(陀螺仪),可获得稳定、响应迅速的姿态估计。
  • 实时计算;滤波器以传感器速率(100+ Hz)运行,支持紧密的控制回路。
  • 无需外部参考;独立运行,室内外、昼夜均可工作。
  • 对瞬态传感器噪声鲁棒;滤波器在保持响应的同时自然地平滑测量尖峰。

应用

  • 飞机自动驾驶仪和飞行控制:维持飞机姿态和航向;为自动驾驶仪算法提供输入。
  • 无人机 (UAV) 稳定:实现多旋翼和固定翼无人机的飞行控制。
  • 航海导航和稳定:为自动驾驶仪和导航提供船舶航向参考;为防摇稳定提供输入。
  • 移动机器人和轮式车辆导航:为地形导航提供航向和俯仰/横滚信息。
  • 智能手机和可穿戴增强现实:实现 AR 显示和手势识别的定向跟踪。

使用方式

使用方式

1

从 9 自由度 (9-DOF) 惯性测量单元 (IMU) 收集高采样率测量值:3 轴加速度计、3 轴陀螺仪和 3 轴磁力计,通常采样率为 50–200 Hz。

2

使用静态或已知运动校准来校准传感器偏差、比例因子和不对准;消除或补偿磁场干扰;精确标记测量时间戳。

3

使用基于观测器的滤波器(互补滤波器或卡尔曼滤波器)融合加速度计和磁力计(矢量测量)与陀螺仪(速率测量),以估计四元数姿态;计算欧拉角(横滚、俯仰、偏航)或直接余弦矩阵表示。

公式
\vec{q}(t+dt) = \vec{q}(t) + \frac{1}{2}\vec{\omega} \times \vec{q}(t) \cdot dt
4

维护状态估计(四元数或 DCM)和协方差;通过陀螺仪积分传播状态;使用按噪声协方差和动力学模型加权的加速度计和罗盘测量值进行更新。

5

输出实时姿态(俯仰、横滚、偏航或四元数)和航向(磁航向或经过磁偏角校正后的真航向);报告置信度或精度指标;标记磁场干扰或传感器故障。

常见陷阱

  • 忽略磁场校准;未校准的磁力计会导致 5–10 度或更大的航向误差;务必在操作环境中进行校准。
  • 不良的滤波器增益调优;过快的校正会导致航向抖动;过慢的校正会导致漂移;需要经验调优或自适应方法。
  • 混淆磁航向和真航向;磁偏角因地点而异;为应用输出正确的变体。
  • 假设加速度计始终指向下方;在快速机动期间,加速度计会倾斜,无法用于姿态确定;滤波器必须适应。

常见问题

什么是万向节锁,如何避免?

当俯仰角达到 90 度时(例如,机头笔直向上或向下),就会发生万向节锁;在此奇点处,横滚和偏航变得相关,丢失了一个自由度。使用四元数表示而不是欧拉角进行内部计算来避免;仅在显示时转换为欧拉角。四元数没有奇点。

如何在动态运动中初始化 AHRS 姿态?

静态初始化(保持静止 1–2 秒)最简单。对于动态初始化,使用更长的观测窗口(5–10 秒)和假设已知机动或低加速度的运动模型。一些系统使用 GPS 速度来检测运动模式并应用适当的初始化。

互补滤波器和卡尔曼滤波器在 AHRS 中的区别是什么?

互补滤波器是启发式的,调优更简单;它对陀螺仪速率进行高通滤波,对加速度计/罗盘进行低通滤波。卡尔曼滤波器对于线性系统是最优的,并且能自然地处理不同的传感器不确定性。卡尔曼滤波器更鲁棒但计算量更大。对于大多数应用,互补滤波器就足够了。

如何检测和纠正 AHRS 中的磁场干扰?

监测磁力计读数是否存在异常(幅度变化、与预期场偏差)。将罗盘航向与惯性估计进行比较;大的不一致表明存在干扰。缓解措施:在干扰期间使用 GPS 速度的航向估计,应用软铁/硬铁校准,或减小滤波器中罗盘的权重。

相关方法

参考文献

  1. Savage, P. G. (2007). Strapdown Inertial Integration Technology (2nd ed.). Strapdown Associates.

    打开出版物文献
    已复制。
  2. Titterton, D. H., & Weston, J. L. (2004). Strapdown Inertial Navigation Technology (2nd ed.). Institution of Engineering and Technology.

    打开 DOI 文献
    已复制。
  3. Madgwick, S. O. H., Harrison, A. J. L., & Vaidyanathan, R. (2011). Estimation of IMU and MARG orientation using a gradient descent algorithm. IEEE International Conference on Rehabilitation Robotics (ICORR), 1–7.

    打开出版物文献
    已复制。