基于陀螺仪、加速度计、地磁计的九轴姿态融合算法代码，花了一点时间整理出来分享，其中有关键算法的讲解，每一步清晰的分析助你玩转九轴或六轴

关于上次提到的四元数是啥的描述解释

基于四元数和卡尔曼滤波的两轮车姿态稳定方法

设计了一款基于嵌入式处理器STM32的四旋翼飞行器，利用低成本传感器测量加速度和机体的角速率，提出一种结合算法，从而实现飞行器姿态的精确测量。采用四元数法描述飞行器的姿态，在测量过程中结合互补滤波算法进行测量数据的矫正；同时针对出现的随机噪声干扰，采用卡尔曼滤波算法，实现姿态的准确测量，最终在实际的飞行器平台上得到了验证。

1.PDF格式的PPT只读文档 1. 四元数的定义 2. 四元数的运算 3. 用四元数表示旋转 4. 四元数到其他旋转表示的转换

miniAHRS程序，内有使用加速度传感器陀螺仪和磁力计得出四元数的代码。

提供一个向量（或一组向量）关于另一个向量（或一组向量）的旋转的实现。 当多个向量围绕其他向量旋转时，集合的大小必须相同。 最少的错误检查，但已优化以在处理大量向量时加快执行速度。

用四元数法的捷联惯性导航姿态解算程序，很有用的

利用numpy和scipy,我们可以很容易根据欧拉角求出旋转矩阵,这里的旋转轴我们你理解成四元数里面的旋转轴 import numpy as np import scipy.linalg as linalg import math #参数分别是旋转轴和旋转弧度值 def rotate_mat(self, axis, radian): rot_matrix = linalg.expm(np.cross(np.eye(3), axis / linalg.norm(axis) * radian)) axis_x, axis_y, axis_z = [1,0,0],

四元数算法输出的是三个量 Pitch、Roll 和 Yaw，运算量很大。而像平衡小车这样的例子只需要一个角（Pitch 或 Roll ）就可以满足工作要求，个人觉得做平衡小车最好不用四元数法。