企业官网建设流程全解析

简介：这份压缩包提供的是专为Energia平台设计的MPU6050库及配套示例，面向使用TI微控制器（MSP430、LPC系列）的硬件开发者与无人机、机器人、运动追踪等项目的爱好者，目标是解决在Arduino风格API下快速接入六轴IMU、读取加速度与角速度数据并完成姿态解算的难题。资源共6个文件，包含两个ino示例、库文件h/cpp、README说明与library.properties配置，整体仅5KB，结构十分精简。目前已有401人学习下载。库封装了I2C引脚配置与Wire通信、陀螺仪和加速度计量程及数字低通滤波设置、原始数据的偏移校正与单位换算，并支持借助内部DMP直接输出欧拉角等更高阶姿态数据；同时提供GetAllData与GetAngle两个示例，分别演示原始数据流获取和角度解算的典型调用流程。开发者可对照README快速完成硬件接线与库安装，再基于示例扩展运动检测、倾倒报警、平衡控制等实际应用，有效缩短基于MSP430的惯性传感项目开发周期。

1. MPU6050_tockn.zip 是什么：一个能少写几百行寄存器代码的姿态读取库

某开发者第一次拿到 MPU6050 模块时，照着数据手册读了半个下午的寄存器，写出来的加速度值还是乱跳，角度就更没法看。后来换用 MPU6050_tockn 这个 Arduino 库，几十行代码就把俯仰、横滚、偏航读出来了，这块六轴传感器才算真正进入「能用」的状态。MPU6050_tockn.zip 是这款开源库的压缩包，通过 Arduino IDE 的「导入 .zip 库」功能一键装进环境。它把 I2C 读写、偏移校准和卡尔曼滤波全部封装好，适合手上有一块 MPU6050、想尽快拿到稳定姿态数据的新手，也适合熟手在做原型验证时省掉重复造轮子的时间。看完这篇，你会知道它内部做了什么、怎么装、参数怎么调、哪些地方最容易翻车。

2. 拆开 zip 之前先搞懂数据流：加速度、陀螺仪、卡尔曼滤波与 tockn 的设计取舍

MPU6050_tockn 这个库不是把寄存器读出来就完事，它内部做了一整套数据加工。你要用好它，至少得知道它加工了什么、为什么要这么加工。这一章把数据流从前到后捋一遍，顺带说清楚为什么在众多 MPU6050 方案里我会推荐它做快速验证。

2.1 六轴数据从哪来：加速度计、陀螺仪和温度传感器的分工

MPU6050 内部其实集成了一颗三轴加速度计、一颗三轴陀螺仪和一个温度传感器。加速度计输出的是「比力」，单位是 g，静止平放时 Z 轴读到的加速度大约接近 1g，X 和 Y 接近 0。陀螺仪输出的是角速度，单位是 dps（度每秒），静止时理论上三个轴都接近 0。温度传感器则用来做内部补偿，一般只用来读环境温度，不参与姿态计算。

加速度计和陀螺仪各有各的毛病。加速度计对振动极其敏感，电机一开、手一抖，数据就像心电图；但它没有积分漂移，长时间看均值是准的。陀螺仪短时间内的角速度读得很准，响应快，可一旦积分成角度，误差会随时间累积，几秒钟看不出，几分钟后角度就不知道歪到哪去了。这也是为什么任何姿态解算都要做数据融合：用陀螺仪的短期精度补加速度计的高频噪声，用加速度计的低频稳定性压住陀螺仪的漂移。

tockn 库内部就是这套思路。它先通过 I2C 从寄存器里把六个轴的数据和温度读出来，然后用加速度计估算一个「参考角度」，再用卡尔曼滤波把陀螺仪积分出的角度和这个参考角度按权重融合。最终你通过 getAngleX、getAngleY、getAngleZ 拿到的，是融合后的角度，不是某个轴的原始值。理解这一点很重要，后面调卡尔曼滤波系数时，你调的就是两者之间的信任度。

2.2 三条技术路线：为什么 tockn 适合快速验证

用 MPU6050 读姿态，常见的有三条路。第一条是自己看寄存器手册，手动配电源管理寄存器、陀螺仪配置寄存器、加速度计配置寄存器，然后自己写数据融合。这条路对学习最有用，但产出速度最慢，一个不小心中断配置错了就得从头查，我最早就是这么干的，折腾了一天半才让数据稳定下来。

第二条是用基于 DMP 的经典开源库。MPU6050 内部有个数字运动处理器 DMP，硬件直接输出四元数，主控不用跑卡尔曼滤波，还能省掉不少主频开销。但 DMP 方案的库通常体积大、配置步骤多，文件中包含一堆 MotionApps 源码，新手稍不注意就把中断引脚接错，数据直接不出来，而且 DMP 固件属于闭源黑匣子，出了问题不太好查。

第三条就是 tockn 这类轻量库。它不用 DMP，纯靠主控做卡尔曼滤波，整个库就一个类，API 十几个方法，没有复杂的中断要求，只要 SDA、SCL 接对就能跑。下面是三条路线的对比。

tockn 的边界也很清楚：它输出的是欧拉角，不是四元数；不做磁场融合，偏航角 Z 轴只能靠陀螺仪积分，时间长了会漂，这是所有不带磁力计方案的物理限制。如果你的项目要在户外长时间跑航向角，该考虑的是九轴方案，不是换库。但如果你只是做倾角测量、摔倒检测、机械臂姿态反馈这类应用，tockn 的精度和稳定性足够用了。

2.3 打开 zip 看结构：从文件布局读懂这个库的 API

导入前先看一眼 zip 里的内容，能省掉很多安装后的困惑。MPU6050_tockn.zip 解压后是一个标准的 Arduino 库目录，通常包含头文件、实现文件、一个用于语法高亮的 keywords.txt、一个描述库信息的 library.properties，以及 examples 示例目录。你在 Arduino IDE 的「导入 .zip 库」时，它会自动识别 library.properties 里的库名，所以解压后目录名不能乱改，否则 IDE 会认不出。

这个库的核心是一个名为 MPU6050 的类，构造函数接收一个 TwoWire 对象，实际使用时传 Wire 就行。常用的方法就这么几个：begin 负责初始化通信和传感器；calcOffset 在静止状态下计算偏移量；setOffset 手动设置已知的固定偏移；update 读取最新数据并更新内部姿态角；getAccX、getAccY、getAccZ 返回当前加速度；getGyroX、getGyroY、getGyroZ 返回角速度；getAngleX、getAngleY、getAngleZ 返回滤波后的角度。后面几章的所有代码都是围绕这几个方法展开的。

有一点要知道的是 update 方法内部有采样间隔控制。它不希望你每次 loop 都去读一次 I2C，那既浪费时间又容易把数据读乱。它内部会记录上一次更新的时间，没到间隔就空转返回，到了间隔才真正去读寄存器。所以你在 loop 里调用 update 的频率只要比采样间隔快就行，不用刻意加 delay 去限频，加了反而会让姿态角输出得稀稀拉拉，给人「数据卡顿」的错觉。

3. 安装、接线和第一段代码：把 MPU6050_tockn 跑起来的三个步骤

这一章全程跟着做，从导入压缩包到串口画出角度曲线，应该十分钟内能完成。前提是你手上有一块 MPU6050 模块、一块 Arduino 开发板、几根杜邦线，以及已经装好 Arduino IDE 的电脑。

3.1 在 Arduino IDE 里导入 zip：菜单路径与安装确认

Arduino IDE 导入 zip 库是一个标准操作，路径在菜单栏的「项目 / Sketch」下拉里。老版本在 Sketch > Include Library > Add .ZIP Library，新版本 IDE 可能叫「项目 > 加载库 > 添加 .ZIP 库」。点开后选中你下载的 MPU6050_tockn.zip，IDE 会把它解压并复制到本机的库目录里，期间没有任何弹窗提示成功，所以你只能通过菜单检查是否装好。

确认方式是打开「项目 > 加载库 > 管理库」旁边的下拉列表，找到「Include Library」子菜单，看里面是否出现了 MPU6050_tockn 的名字。出现了就说明安装成功。这时不要手动去改库目录里的文件名，尤其是把文件夹改名成带版本号的名字，一旦 IDE 在 library.properties 里找不到对应项，导入操作就白做了。

常见的安装翻车现场是把 zip 解压后直接把文件夹拖进 libraries 目录，结果 IDE 认不出；或者下载时浏览器自动二次解压，你选了一个已经解压的文件夹而不是 zip 原文件。这两种情况都能通过路径检查看出来：导入后库目录里应该有一个名为 MPU6050_tockn 的文件夹，里面有 .cpp 和 .h 文件。如果名字对不上，删掉重新导一次。

3.2 接线与供电：SDA、SCL 不能反，VCC 别接 5V

MPU6050 模块一般是四个引脚：VCC、GND、SCL、SDA，部分模块还有 AD0 和 XDA、XCL 这种扩展引脚。AD0 是用来改 I2C 地址的，悬空时地址是 0x68，接高电平变成 0x69；如果总线上已经有一个 0x68 的设备，把 AD0 接 3.3V 就能避开冲突。XDA 和 XCL 是从模式接口，前几年有人用它外接磁力计做九轴，普通应用不接。

接线按下面这张表来，不同开发板的 I2C 引脚位置差异很大，接之前先查你板子的引脚图。

供电这里我踩过坑。很多 MPU6050 模块上的稳压芯片声称支持 3V 到 5V，但 5V 供电时模块发热明显，而且 I2C 上拉电平会被拉到 5V，主控的 I2C 引脚如果不是电平转换设计，长期跑容易出问题。我现在的习惯是 VCC 一律接 3.3V，不管板子上有没有 5V 引脚，这能省掉一大半疑难杂症。另外模块上的 I2C 上拉电阻一般是自带的，不需要额外加；如果你用面包板飞线，线长超过 20cm 还读不到数据，优先怀疑线序和接触，别急着加电阻。

3.3 最小代码：串口打印角度并画曲线

接线确认无误后，新建一个 Arduino 工程，把下面的代码整段拷进去编译上传。这段代码做了四件事：初始化 I2C、初始化传感器、上电时做一次静态偏移校准、循环打印三个轴的角度。

#include <Wire.h> #include <MPU6050_tockn.h> MPU6050 mpu6050(Wire); void setup() { Serial.begin(115200); Wire.begin(); mpu6050.begin(); // 上电后保持模块静止，库内部会采样多次取平均作为偏移基准 mpu6050.calcOffset(); Serial.println("MPU6050 ready"); } void loop() { mpu6050.update(); Serial.print("X: "); Serial.print(mpu6050.getAngleX()); Serial.print(" Y: "); Serial.print(mpu6050.getAngleY()); Serial.print(" Z: "); Serial.println(mpu6050.getAngleZ()); }

代码的逻辑很直白：setup 里初始化后调用 calcOffset，此时模块必须静止，最好放在桌面上等两三秒；loop 里每次先 update 再取角度，getAngleX 对应俯仰、getAngleY 对应横滚、getAngleZ 对应偏航。update 内部做了采样间隔控制，所以这里没有额外 delay，你不需要也不应该再加 delay 去限制循环速度。

编译上传前记得把开发板型号和端口选对。如果编译报错找不到 MPU6050_tockn.h，回头检查 3.1 节的安装步骤；如果编译能过但串口没数据，先把波特率调成 115200，再看串口监视器底部是不是设成了换行符模式。数据显示正常后，打开 Arduino IDE 自带的串口绘图器，把模块往左右倾斜，你会看到三条曲线，X 和 Y 会跟着转动变化，Z 在静止时缓慢漂移，这是正常现象，具体原因在第 5 章展开。

4. 校准与参数调优：偏移补偿、Q/R 系数和量程的实战设置

能读到角度只是第一步，数据准不准才是关键。同一块 MPU6050，有人拿回来随便一放就能用，有人折腾一晚上还是歪的，差别基本都出在校准和滤波系数上。这一章把这三个最影响数据的部分讲透。

4.1 为什么必须做偏移校准：静止时角度不为 0 的根源

MPU6050 出厂前做过一定校准，但焊接应力、装配角度、温度变化都会引入额外的零偏。最典型的表现是模块平放在桌上，读 getAngleX 却显示 3 度或者 -5 度；更隐蔽的是陀螺仪的零偏，它静止时读到的角速度不是 0，而是某个固定小值，这个值积分起来就会让角度慢慢漂走。tockn 的 calcOffset 方法就是为了消除这两类误差。

calcOffset 内部会在你调用它的时候读一批样本，取平均作为零偏，之后库再把读到的原始值减去这个零偏再参与运算。它要求调用时模块保持绝对静止，我一般会把模块放在桌面或固定夹具上，调完等 2 秒再让代码继续跑。如果上电后你直接手拿着调用 calcOffset，采到的平均值里混入了手的抖动，校准完的角度反而更飘。

如果你的设备是固定在一个倾斜面上的，比如机器人底盘、光伏板支架，安装面本身就不是水平的，校准后这些角度会被当作零位。这时不一定非要找水平面，直接把设备放在实际安装姿态下校准，得到的角度就是「相对于安装位置的偏差」，很多场景反而更好用。另外 calcOffset 不能频繁调用，每调一次它就覆盖掉旧偏移，正常使用一次上电调一次够了；如果设备长期在温度变化大的环境里跑，可以考虑每次上电都保留 10 秒静止自校准流程。

手动补偿也有用。有些模块的加速度计零偏比较固定，比如 X 轴总是偏 -0.05g 左右，你可以先跑一次 calcOffset，把计算出的偏移记录下来写死在代码里，下次上电直接用 setOffset 设置，省掉静止等待的过程。但要注意 setOffset 设置的是角度偏移而不是加速度偏移，写之前先确认库版本的参数含义，不同版本的语义有差别。

4.2 卡尔曼滤波系数 Q 和 R：角度响应的快慢与抖动怎么权衡

tockn 的卡尔曼滤波只维护两个系数：过程噪声协方差 Q 和测量噪声协方差 R。这两个词听起来吓人，实际上就是两个信任度旋钮。Q 控制你对陀螺仪积分结果的信任程度，Q 越大，滤波器越相信角速度变化，响应越快，但对噪声也更敏感；R 控制你对加速度计参考角度的信任程度，R 越大，滤波器越不相信加速度计，角度越平滑，但响应越迟钝。

库提供了 setFilterConstants 方法设置这两个值。我常用的起步值是 Q 取 0.001、R 取 0.1，在这个值附近角度曲线已经比较干净。如果你的角度响应太肉，倾斜模块后要一两秒才跟上，说明 Q 太小，把 Q 逐步加大到 0.005、0.01；如果你的角度静止时还在明显抖动，说明 R 太小，把 R 加大到 0.5、1.0。

我建议一次只改一个参数，改完倾斜几下模块看实时曲线再决定下一步。两个参数同时乱调，你会发现角度变成了一根随机波浪线，完全没法判断是谁的问题。还有一个经验是体位变化大的场景，比如手持设备、无人机，Q 可以给大一点让响应更跟手；固定安装的场景，比如倾角监测、平台调平，R 给大一点换更平滑的输出。

setFilterConstants 不一定要写在 setup 里，你完全可以在 loop 里根据运动状态动态切换。比如检测到模块加速度模长接近 1g 时，说明它处于静止或匀速状态，这时减小 R 让加速度计多起作用；一旦检测到加速度模长明显偏离 1g，说明模块在剧烈运动，加速度计已经被线性加速度污染，增大 R 让它少捣乱。这就是后面进阶章会用的自适应滤波思路。

4.3 量程和采样率：默认值够用，但别忽视换算关系

MPU6050 的加速度计有 ±2g、±4g、±8g、±16g 四档，陀螺仪有 ±250、±500、±1000、±2000 dps 四档。tockn 库默认把量程设在 ±2g 和 ±250dps，也就是说模块最大只能测 2g 的加速度和每秒 250 度的旋转。这个默认值对大多数桌面级应用是够的，但如果你拿着模块快速甩动或者装在小车上急转弯，陀螺仪读数会撞到量程上限，角度输出直接飞掉。

问题在于 tockn 把量程相关的换算系数写死在内部实现里，它假设你始终在用默认量程。如果你通过其他库或者直接写寄存器把量程改成了 ±500dps，再回头用 tockn 读数据，它拿 250dps 的换算系数去算 500dps 的原始值，出来的角度会偏小一半。所以我一般不建议在 tockn 里改量程，除非你确实知道怎么同步修改内部换算系数。

采样率方面，tockn 的 update 内部默认采样间隔能满足大部分场景，你不需要通过修改 Wire 速率去压榨性能。Fast Mode 的 400kHz I2C 速度对 10ms 级别的采样间隔反而容易产生总线竞争，尤其你总线上还挂了 OLED、存储芯片这些设备时。老老实实保持默认 I2C 速率，把精力放在滤波系数上，收益更大。

如果你的应用确实需要高角速度测量，我的做法是换用支持量程配置的传感器库，或者自己直接操作寄存器，而不是硬改 tockn。做姿态解算的底层量程和换算系数是绑定的，任何一步改漏了，最终姿态角都是错的，这是逃不掉的工程约束。

5. 避坑：MPU6050_tockn 的五个翻车现场与排查手段

这一章是血泪经验汇总。以下五个问题占了我过去调试 MPU6050 遇到的八成故障，每一个都按「现象 → 原因 → 解决」的顺序写，你可以直接对着排查。

5.1 串口数据全是 0 或 -1：I2C 总线上根本没找到设备

现象：烧录后串口没有任何输出，或者 getAngle 返回的全是 0、-1、65535 这类异常值。用 I2C 扫描工具看，总线上一个设备都扫不到。

原因八成出在接线。不是 SDA 和 SCL 接反，就是杜邦线没插紧，偶尔是模块本身焊盘有问题。我见过一个特别隐蔽的案例：模块的 SDA 引脚和旁边一个引脚因为助焊剂残留轻微短路，万用表量不出问题，但 I2C 时序就是不对，最后换了个模块才解决。

排查手段是先跑一段 I2C 扫描代码，把总线上所有地址打印出来。正常情况 MPU6050 的 AD0 悬空，地址是 0x68，你只需要确认扫描结果里有 0x68 就行。

#include <Wire.h> void setup() { Serial.begin(115200); Wire.begin(); Serial.println("I2C Scanner start"); } void loop() { byte error, address; int deviceCount = 0; for (address = 1; address < 127; address++) { Wire.beginTransmission(address); error = Wire.endTransmission(); if (error == 0) { Serial.print("Found at 0x"); if (address < 16) Serial.print("0"); Serial.println(address, HEX); deviceCount++; } } if (deviceCount == 0) { Serial.println("No device found, check SDA/SCL wiring"); } delay(2000); }

这段代码会从地址 1 扫到 126，逐个发起 I2C 通信并检查应答。逻辑很简单，但能帮你区分问题在接线还是模块。扫描不到时，先交换 SDA 和 SCL，再换一组 GPIO 重新试；如果换引脚能扫到，说明原引脚有硬件冲突，查数据手册换一对空闲引脚就行。如果扫描到 0x69 而没扫到 0x68，那是 AD0 被拉高了，检查模块背面有没有跳线或焊桥。

5.2 静态角度漂移：每个上电周期都是薛定谔的零位

现象：模块静止放在桌上，getAngleX 不是稳定的 0，而是慢慢从 0 漂到 3 度、5 度，重启后漂移方向还可能不一样。Z 轴漂得最凶，有时候一分钟能走掉十几度。

原因有两层。第一层是上电后没有及时校准，陀螺仪零偏随时间在变，尤其模块刚上电的前几分钟，内部温度还在上升，零偏漂移非常明显。第二层是卡尔曼滤波里对陀螺仪的信任度过高，也就是 Q 设得太大，或者 R 设得太小，漂移没有被加速度计及时拉回来。

解决方法是养成「热机后再校准」的习惯。我现在的标准流程是上电后先等 3 到 5 分钟再触发校准，或者至少等模块温度稳定；校准期间必须保证模块绝对静止。如果设备上电后无法等待，就在 setup 里延迟几秒再调 calcOffset，这样至少能避开上电瞬间的电压波动。另外把 4.2 节的 Q 值调小一点，让漂移被加速度计更快修正，静止稳定性会明显改善。

5.3 角度抖动像心电图：供电纹波和滤波系数在打架

现象：模块静止时 getAngleX 输出的曲线不是一条直线，而是带毛刺的高频抖动，幅度能达到两三度。用手摸一下模块外壳，抖动反而变小，这基本可以锁定供电问题。

原因通常是 VCC 上的纹波太大。Arduino 板载的 3.3V 稳压器本身噪声不小，加上面包板长线、USB 供电波动，加速度计读到的数据会混入高频噪声，卡尔曼滤波压不住。有些模块板载稳压电容很小，对纹波几乎没有抑制作用。

解决方法是给模块供电加滤波电容。我习惯在模块 VCC 和 GND 之间并联一个 100uF 电解电容和一个 0.1uF 陶瓷电容，直接焊在模块背面或者插在面包板上。如果加了电容还是抖，再去调 4.2 节的 R 值，把测量噪声的信任度调低，也就是增大 R，角度会平滑很多。先解决供电，再调滤波，顺序反了你会在两个变量之间来回折腾。

5.4 VCC 接 5V 后模块发热：还能用，但数据已经不可信

现象：模块摸起来发烫，部分板载稳压芯片温度高到手不能长时间停留，I2C 偶尔还能读到数据，但角度时不时跳变。

原因是模块上的稳压芯片要么质量一般，要么设计时就没考虑 5V 长时间供电的压差和功耗。发热意味着芯片内部已经工作在接近极限的状态，温度升高又会进一步加大陀螺仪零偏漂移，数据质量自然变差。

解决方法是把 VCC 改接 3.3V。如果只留了一个 5V 电源轨，就在 VCC 和 5V 之间接一个低压差稳压芯片，比如常见的 AMS1117-3.3，但注意这类芯片本身也需要散热空间。模块到手先看板子上的丝印，写着 3-5V 的也别盲目信，3.3V 永远是最稳的选择。

5.5 Z 轴角度一直缓慢增加：不是故障，是物理规律

现象：模块水平放在桌上不动，X 和 Y 都稳定在 0 附近，唯独 Z 轴角度像秒表一样匀速增长，几分钟后偏了四五十度。

原因是 Z 轴对应偏航角，它只能由陀螺仪积分得到。加速度计测量的是重力方向，重力方向与 Z 轴平行，所以加速度计能修正 X 和 Y（横滚和俯仰），却永远无法感知 Z 轴的转动。没有磁力计提供绝对航向参考，Z 轴的漂移是物理上不可消除的，任何不带磁力计的姿态解算方案都这样，不是 tockn 的问题。

解决方法是接受这个限制，并针对场景做处理。如果你只做倾角监测，完全不看 Z 轴就行；如果你需要短时间内的相对航向，比如做一个机械臂关节的转动角度测量，可以在每次开始测量前重新校准零位，把 Z 轴漂移清零，让它在短时间内相对准确。真正要长期稳定的航向角，要么加一颗磁力计做九轴融合，要么换带地磁的模块，这不是调参能解决的问题。

6. 进阶：让姿态数据流起来——串口协议、手势判断和滤波系数自适应

跑通基本读取之后，你要做的下一件事是让数据为实际功能服务。这一章给三个能用上的技巧，覆盖数据输出、应用判定和滤波自适应的方向。

先说数据输出。串口监视器打印的裸文本只适合调试，不适合传给上位机或其他 MCU。实际项目中我一般会把角度打包成带帧头的结构化数据，最常见的格式是 JSON 或者二进制帧。JSON 方便调试和对接上位机，缺点是解析成本高；二进制帧适合单片机之间传输，省资源。下面是一段 JSON 输出的例子：

void loop() { mpu6050.update(); Serial.print("{\"x\":"); Serial.print(mpu6050.getAngleX(), 2); Serial.print(",\"y\":"); Serial.print(mpu6050.getAngleY(), 2); Serial.print(",\"z\":"); Serial.print(mpu6050.getAngleZ(), 2); Serial.println("}"); }

JSON 字符串里每个 key 都用转义引号包起来，这是因为 Arduino 的串口输出没有格式化能力，只能自己拼字符串。如果你要传给另一个 MCU，我更推荐固定长度的二进制帧，比如帧头 0xAA、数据区六个 float，再加一个校验字节，接收端解析固定长度比切割字符串简单得多。

第二个技巧是手势判断或姿态判定。用角度阈值做应用逻辑时要注意一个坑：直接拿瞬时角度做阈值判断，会在阈值附近反复跳动。比如你设定倾斜超过 45 度就触发报警，实际输出会在 44 度和 46 度之间抖动，触发和解除反复横跳。正确做法是加滞回区间：超过 50 度触发，回到 40 度以下才解除。

第三个技巧是滤波系数自适应，这也是我最近在某模拟项目X里面用到的做法。思路很简单：静止或匀速时增大加速度计的权重，运动时减小它的权重。实现上就是前面 4.2 提到的，用加速度模长来判断运动状态。三个加速度分量的平方和开根号，接近 1g 时设备处于平稳状态，把 setFilterConstants 的参数调成更信任加速度计；明显偏离 1g 时说明模块在加速运动，调成更信任陀螺仪。

这里分享一个我做姿态监测时的教训。有一回为了图省事，把所有设备都跳过静态校准直接上电运行，结果同一批设备里有一半的角度零位偏了四五度。我花了一个下午查代码，最后发现是设备在流水线上被机械臂安装过，安装瞬间的振动被当成了校准样本。从那以后我把校准逻辑改成每次上电后先检测运动状态，加速度模长稳定接近 1g 才允许进入校准流程，否则一直等待。这个习惯帮我省掉了大量返工，也希望帮到你。

本文还有配套的精品资源，点击获取