姿态角解算误差分析与消除

📚 共计 30 章节

姿态角解算概述

姿态角定义（横滚、俯仰、偏航）· 坐标系定义（导航系、机体系）· 应用场景（无人机、机器人、VR/AR）

基础坐标系

传感器基础

加速度计原理与输出模型 · 陀螺仪原理与输出模型 · 磁力计原理与输出模型 · 传感器噪声特性分析

姿态表示方法

欧拉角 · 旋转矩阵 · 四元数 · 三种表示方法优缺点对比

表示法四元数

欧拉角与旋转矩阵

欧拉角定义与旋转顺序 · 旋转矩阵推导 · 欧拉角转旋转矩阵 · 旋转矩阵转欧拉角

四元数基础

四元数定义与运算法则 · 四元数与旋转 · 四元数乘法与旋转合成 · 共轭与逆

四元数旋转

四元数与欧拉角转换

四元数转欧拉角 · 欧拉角转四元数 · 万向锁问题 · 工程转换注意事项

万向锁工程

姿态解算核心方程

姿态微分方程（欧拉角/四元数）· 离散化（一阶龙格库塔）· 角速度积分与姿态更新

微分方程离散

加速度计姿态解算

利用加速度计计算横滚与俯仰 · 静态解算公式 · 动态加速度干扰局限性

加速度计静态

磁力计姿态解算

地磁场模型与磁偏角 · 磁力计计算偏航 · 硬铁/软铁校准 · 磁力计局限性

磁力计校准

陀螺仪姿态解算

纯陀螺仪积分更新 · 漂移误差累积 · 积分误差发散 · 纯陀螺仪局限性

陀螺仪漂移

误差源分析（上）

传感器噪声（白噪声、随机游走）· 温度漂移 · 零偏与刻度因子 · 安装与轴对准误差

误差源分析（下）

振动与运动加速度干扰 · 磁干扰与地磁异常 · 时间同步误差 · 量化误差与采样率

互补滤波原理

频域互补思想 · 一阶/二阶互补滤波 · 系数选择与调参

互补滤波频域

互补滤波实现

加速度计+陀螺仪互补 · 磁力计+陀螺仪互补 · Mahony算法 · 优缺点

卡尔曼滤波基础

状态空间模型 · 预测与更新 · 卡尔曼增益 · 假设条件

卡尔曼基础

线性卡尔曼滤波姿态解算

状态向量设计 · 观测向量 · 状态转移与观测矩阵 · 姿态估计流程

扩展卡尔曼滤波（EKF）

非线性系统线性化 · 雅可比矩阵 · EKF姿态解算 · 优缺点

无迹卡尔曼滤波（UKF）

无迹变换 · Sigma点选取 · UKF姿态解算 · 与EKF对比

梯度下降法姿态解算

目标函数构建（加速度/磁力计误差）· 梯度下降迭代 · Madgwick原理 · 与互补滤波对比

梯度下降Madgwick

Madgwick算法详解

算法流程与框架 · β参数含义与调节 · 收敛性与精度 · 工程实现

传感器校准方法（上）

六面法校准加速度计 · 椭球拟合校准磁力计 · 陀螺仪零偏在线估计 · 温度补偿模型

校准六面法

传感器校准方法（下）

多位置静态校准 · 转台动态校准 · 运动约束自校准 · 精度评估指标

转台自校准

多传感器融合策略

松耦合与紧耦合 · 残差检测故障隔离 · 自适应融合权重 · 传感器失效降级

时间同步与延迟补偿

传感器时间戳对齐 · 数据插值与外推 · 传输延迟补偿 · 多速率融合

振动与运动干扰抑制

低通滤波预处理 · 自适应陷波滤波器 · 加速度幅值运动检测 · 动态解算策略

磁干扰检测与补偿

磁异常检测（残差/幅值）· 磁干扰下偏航估计 · 视觉/卫星辅助磁力计

磁干扰辅助

姿态解算性能评估

静态/动态精度评估 · 响应时间与带宽 · 误差统计指标（RMSE、MAE、标准差）

工程实现与优化

嵌入式资源优化 · 定点/浮点运算 · 算法效率优化 · 代码健壮性与异常处理

嵌入式优化

典型应用案例分析

四旋翼无人机 · 两轮自平衡车 · 手机/VR头显 · 水下机器人姿态解算

案例无人机

前沿技术与趋势

深度学习姿态估计 · 视觉-惯性融合(VIO) · 多源信息融合 · 芯片级IMU与未来