简介：面向使用LIS2DH12TR、LIS3DH等低g三轴加速度计进行倾角检测的嵌入式与传感器应用开发者，这份应用笔记聚焦设备相对本地水平面的倾斜角测量问题，可服务于屏幕旋转、汽车安全报警及电子罗盘倾斜补偿等场景。压缩包仅含1个PDF文件，约619KB，篇幅精炼，适合作为查阅型技术文档。已有1763人学习。内容从重力分量与加速度读数关系入手，依次说明单轴、双轴和三轴倾斜检测的原理、适用边界与灵敏度差异，对单轴检测在±1g附近灵敏度下降、双轴方法存在方向歧义等限制也给出说明，并讨论噪声、温度变化、非线性响应和重力矢量偏移等非理想因素的补偿思路；配以单轴360°旋转、双轴/三轴倾斜灵敏度等图示，便于读者建立角度计算模型、规划校准与滤波方案，并对照数据手册完成传感器应用设计。
1. 一块贴歪的板子，让我重新翻了这份加速度计倾斜笔记
某消费电子项目做屏幕自动旋转，样机在桌面上静止时，界面偶尔自己横过来。查到最后不是算法抖动，而是加速度计贴装偏了 2.3°，0° 附近的角度读数本来就贴着 0 线来回蹭，越过了判定阈值。那段时间我把 LIS2DH12TR 和 LIS3DH 的倾斜度测量应用笔记来回翻了几遍，才发现很多坑在文档的灵敏度表里其实写得很清楚，只是当时没当回事。这份笔记讲的是低 g 三轴加速度计怎么用重力投影算倾角，单轴、双轴、三轴三种解法各有适用边界，也讲了量程、分辨率、量化误差怎么影响最终精度。做屏幕旋转、云台水平校正、电子罗盘倾斜补偿、车载报警姿态检测的人，都能直接拿去改。
2. 倾斜的数学账：单轴、双轴、三轴差在哪
2.1 重力在轴上的投影与那条正弦曲线
静止状态下，加速度计感受到的只有重力矢量，大小约 1 g，方向永远指向地心。感应轴与水平面成 α 角时，重力在轴上的投影就是 g·sinα，反解得到 α = arcsin(A/g)。这条公式简单到一行代码就能写完，问题全在定义域和灵敏度上。
正弦函数在 0° 附近最陡，在 90° 附近最平。把 1° 的角度变化换算成加速度变化，就是所谓的倾斜灵敏度：
| 倾角 | 加速度读数 | 每度变化量 |
|---|---|---|
| 0° | 0.000 g | 17.45 mg/° |
| 15° | 0.259 g | 16.82 mg/° |
| 30° | 0.500 g | 15.04 mg/° |
| 45° | 0.707 g | 12.23 mg/° |
| 60° | 0.866 g | 8.59 mg/° |
| 75° | 0.966 g | 4.38 mg/° |
| 90° | 1.000 g | 0.15 mg/° |
这张表是后面所有选型讨论的基础。0° 到 45° 区间线性度尚可，每度十几个 mg；到了 75° 以上，1° 只对应 4 mg 出头，90° 附近更是只剩 0.15 mg/°，任何一点噪声都能让角度跳好几度。很多人口中的“加速度计算角度不准”，八成是工作点选在了灵敏度塌陷区。
2.2 双轴的死区：为什么 30° 和 150° 读数一样
两轴方案看起来能省一个通道，实际上有两个硬伤。绕某个轴倾斜时，一个轴的灵敏度高、另一个轴低，交叉点在 45° 附近；更要命的是正弦函数的对称性，X 轴读到 0.5 g 时，设备可能在 30°，也可能在 150°，光靠 X、Y 两轴分不出来。
常见做法是按正交轴判断：β 小于 45° 时以 X 轴为主算角度，β 大于 45° 时改用 Y 轴。这个切换逻辑写起来不难，但切换点附近两轴灵敏度此消彼长，噪声权重也跟着变，实测角度曲线会有一个小台阶。如果没有第三轴做象限判断，双轴方案本质上只能覆盖 ±90° 的一个半区，超过就得多加约束条件。
提示：双轴方案在屏幕旋转这类只需要判断“横还是竖”的场景够用，但只要涉及连续角度输出，就别省那颗 Z 轴。
2.3 三轴的两种解法与灵敏度曲线
三轴的第一种解法是各轴独立反解：α = arcsin(Ax/g)，β = arcsin(Ay/g)，γ = arcsin(Az/g)。三个角度分开算，代码直白，但每个角都继承了单轴的正弦特性，端点附近灵敏度同样塌陷，而且三个角之间不满足旋转矩阵的约束，拼出来的姿态在数学上并不自洽。
第二种解法用俯仰和滚转表达：pitch = arctan(Ax / √(Ay² + Az²))，roll = arctan(Ay / Az)，工程实现时统一换成 atan2。这样做的价值在于，整个 360° 旋转过程中至少有一个轴处在高灵敏度区，分母里的合成量始终跟着主分量走，灵敏度不会掉到零。
笔记里那张灵敏度对比图画了三条曲线：Arcsin(X)、Arccos(Z)、Arctan(X/Z)。前两条在 0° 到 90° 之间一个从高往低走、一个从低往高走，正好互补；Arctan(X/Z) 则在两端都能维持可用灵敏度。实际写代码时，可以用“主分量判断 + 换函数”的方式拼接，也可以直接用 atan2 一把梭。后者代码更短，边界也更干净。
2.4 量程与分辨率：先把 LSB 算清楚再谈精度
LIS2DH12TR 和 LIS3DH 都支持 ±2 g、±4 g、±8 g、±16 g 四档量程，高分辨率模式下是 12 位输出。同样的 12 位分配到不同量程，每个 LSB 代表的加速度完全不同：
| 量程 | 12 位模式下 LSB | 0° 附近 1° 对应 LSB 数 | 量化误差折算角度 |
|---|---|---|---|
| ±2 g | 1 mg | 约 17.5 | 约 0.06° |
| ±4 g | 2 mg | 约 8.7 | 约 0.12° |
| ±8 g | 4 mg | 约 4.4 | 约 0.23° |
| ±16 g | 12 mg | 约 1.5 | 约 0.69° |
倾斜测量是静态或准静态应用，重力永远只有 1 g，选 ±16 g 除了浪费分辨率没有任何好处。我在一个车载项目里见过有人为了“抗冲击”直接上 ±16 g，结果水平校准的重复性只有 ±0.8°，怎么调滤波都救不回来，换成 ±2 g 之后立刻降到 ±0.15°。冲击保护应该靠机械限位和软件饱和判断，不该拿量程去换。
还有一点容易忽略：±2 g 量程意味着输入超过 2 g 就会削顶，设备跌落或猛烈碰撞时读数会卡在满量程。做姿态判定时最好同时看合成模值 |A|，明显偏离 1 g 就标记为动态区间，暂时不输出角度。
3. 寄存器配置：LIS2DH12TR / LIS3DH 最小可用读取链
3.1 上电到出数：CTRL_REG1 到 CTRL_REG4 的配置顺序
这两颗器件的寄存器布局基本兼容，关键控制位集中在 0x20 到 0x25 这一段。上电后默认处于掉电模式，不出数，必须先写 CTRL_REG1 打开轴使能和输出数据率，再写 CTRL_REG4 设定量程、分辨率和块数据更新保护。
顺序上有讲究：先配 CTRL_REG4 再配 CTRL_REG1 更稳妥，避免器件已经按默认量程开始采样、中途改量程导致前几帧数据对不上量程。配置完成后要等至少几个 ODR 周期，让内部滤波器和电荷放大器稳定下来，手册里一般给的是毫秒级，我习惯直接延时 10 ms 再读第一帧。
#include <stdint.h> #define REG_WHO_AM_I 0x0F #define REG_CTRL_REG1 0x20 #define REG_CTRL_REG2 0x21 #define REG_CTRL_REG3 0x22 #define REG_CTRL_REG4 0x23 #define REG_CTRL_REG5 0x24 #define REG_CTRL_REG6 0x25 #define REG_OUT_X_L 0x28 /* 平台相关，换成自己的 I2C/SPI 实现 */ extern int i2c_write_reg(uint8_t bus, uint8_t addr, uint8_t reg, const uint8_t *val, uint16_t len); extern int i2c_read_regs(uint8_t bus, uint8_t addr, uint8_t reg, uint8_t *buf, uint16_t len); extern void delay_ms(uint32_t ms); typedef struct { uint8_t bus; uint8_t addr; /* 7 位地址，SDO 接地时通常为 0x18 */ float lsb_mg; /* 每 LSB 对应多少 mg */ } acc_dev_t; int acc_init(acc_dev_t *dev) { uint8_t id = 0; uint8_t v; if (i2c_read_regs(dev->bus, dev->addr, REG_WHO_AM_I, &id, 1) != 0) return -1; if (id != 0x33) /* 两颗器件的 WHO_AM_I 都是 0x33，靠 BOM 区分 */ return -2; /* 关闭高通滤波，倾斜测量要保留重力直流分量 */ v = 0x00; i2c_write_reg(dev->bus, dev->addr, REG_CTRL_REG2, &v, 1); /* 不启用中断 */ v = 0x00; i2c_write_reg(dev->bus, dev->addr, REG_CTRL_REG3, &v, 1); i2c_write_reg(dev->bus, dev->addr, REG_CTRL_REG5, &v, 1); i2c_write_reg(dev->bus, dev->addr, REG_CTRL_REG6, &v, 1); /* CTRL_REG4: BDU=1, HR=1, FS=00(±2g) -> 0x88 */ v = 0x88; i2c_write_reg(dev->bus, dev->addr, REG_CTRL_REG4, &v, 1); dev->lsb_mg = 1.0f; /* CTRL_REG1: ODR=0101(100Hz), LPen=0, XYZ 使能 -> 0x57 */ v = 0x57; i2c_write_reg(dev->bus, dev->addr, REG_CTRL_REG1, &v, 1); delay_ms(10); /* 等滤波器稳定，再读第一帧 */ return 0; }这段代码里三个参数值得展开。CTRL_REG4 的 BDU 位打开后，高低字节在读取期间被锁存，防止读的过程中数据更新造成撕裂；HR 位决定 12 位高分辨率模式，关掉就退化成 10 位或 8 位，白丢精度；FS 两位选 ±2 g，对应的 lsb_mg 是 1.0。CTRL_REG1 的 ODR 字段选 100 Hz，对静态倾角足够，再高只是把噪声也一起采进来。
3.2 多字节读取与 12 位左对齐还原
数据寄存器从 0x28 开始，X、Y、Z 各两个字节，一共 6 个。器件支持地址自动递增，读的时候把寄存器地址的最高位置 1，也就是 0x28 | 0x80，一次连续读 6 字节，避免分三次读导致三个轴不是同一时刻的采样。
12 位数据在 16 位寄存器里是左对齐的，低 4 位无效。还原时必须先拼成有符号 16 位再右移，顺序反了会把符号位一起移掉。
int acc_read_raw(acc_dev_t *dev, int16_t out[3]) { uint8_t buf[6]; if (i2c_read_regs(dev->bus, dev->addr, REG_OUT_X_L | 0x80, buf, 6) != 0) return -1; for (int i = 0; i < 3; i++) { int16_t v = (int16_t)((buf[2 * i + 1] << 8) | buf[2 * i]); out[i] = v >> 4; /* 算术右移，保留符号，得到 12 位有符号值 */ } return 0; }注意v >> 4这里用的是有符号右移，C 标准里对负数右移是实现定义行为，但主流编译器都做算术右移。如果换到某些严格模式的工具链，可以先转 int32_t 再移，或者用v / 16替代，结果一致但更保险。读回来的原始值单位是 LSB，乘以 dev->lsb_mg 换成 mg，再除以 1000 换成 g，才能进三角函数。
3.3 ODR 与 FIFO：采样率不是越高越好
静态倾斜测量对带宽的要求很低。人手晃动的频率在 5 Hz 以内，设备安装后的缓慢姿态变化更低，ODR 选 10 Hz 到 50 Hz 通常够用。选高了有两个副作用：一是噪声带宽变宽，角度抖动变大；二是功耗上升，对电池供电的穿戴设备很敏感。
如果主控不能及时取数，可以开 FIFO，让器件内部缓存若干帧，主控一次读走。FIFO 模式下要注意水位中断和数据覆盖，读慢了旧数据会被新数据挤掉，表现出来就是角度曲线出现时间上的跳变。我一般只在水位不超过一半时读取，留出余量。
LIS2DH12TR 和 LIS3DH 在低功耗模式下的噪声表现不同，同样的 ODR 下低功耗模式的底噪明显更高。倾斜测量不需要低功耗模式，CTRL_REG1 的 LPen 位保持 0 就行，除非产品对静态功耗有硬指标。
4. 角度解算：arcsin、arccos、atan2 的边界写法
4.1 单轴 arcsin 的可用区间与输入保护
单轴公式 α = arcsin(A/g) 的定义域是 [-1, 1]，而实际读数乘上灵敏度之后，稍有噪声或零偏就可能跑到 1.0002 这种值，直接进 asin 会返回 NaN，后面整条姿态链路全崩。所以进三角函数之前必须裁剪。
#include <math.h> #define RAD2DEG 57.2957795f static float clampf(float v, float lo, float hi) { if (v < lo) return lo; if (v > hi) return hi; return v; } /* 单轴：raw 为 12 位原始值，lsb_mg 为每 LSB 的 mg 数 */ float tilt_single_axis(int16_t raw, float lsb_mg) { float a_g = raw * lsb_mg / 1000.0f; float s = clampf(a_g, -1.0f, 1.0f); /* 防 NaN */ return asinf(s) * RAD2DEG; }裁剪本身会引入饱和误差，1.0002 被压到 1.0，角度就是 90°，看起来合理，实际可能已经过载。所以裁剪之外还要看原始值有没有顶到满量程，±2 g 量程对应的 12 位满量程是 ±2048，接近这个数就该报警而不是继续输出角度。
单轴方案还有一个隐含假设：另外两个轴严格水平。实际安装总有偏差，几度的倾斜就会让单轴读数带上一个与角度相关的误差项，在 0° 附近尤其明显。
4.2 三轴基本公式与归一化
三轴基本公式把每个轴除以合成模值，消掉灵敏度绝对值和轻微的量程误差：
$$ \alpha = \arcsin\left(\frac{A_x}{\sqrt{A_x^2 + A_y^2 + A_z^2}}\right) $$
三个轴各算一次，得到的是三个方向与水平面的夹角。这样做的好处是不依赖 g 的标称值，坏处是仍然继承了 arcsin 在端点附近的灵敏度塌陷，而且三个角之间彼此独立，不能直接拿去做旋转矩阵。
void acc_to_angles_basic(const int16_t raw[3], float lsb_mg, float out[3]) { float a[3]; for (int i = 0; i < 3; i++) a[i] = raw[i] * lsb_mg / 1000.0f; float norm = sqrtf(a[0]*a[0] + a[1]*a[1] + a[2]*a[2]); if (norm < 0.1f) { /* 自由落体或严重异常，拒绝输出 */ out[0] = out[1] = out[2] = NAN; return; } for (int i = 0; i < 3; i++) out[i] = asinf(clampf(a[i] / norm, -1.0f, 1.0f)) * RAD2DEG; }norm < 0.1f这个判断是血泪经验：设备跌落时合成模值会短暂接近 0，此时任何角度都没有意义，强行算出来就是一堆随机数。加了这个门限之后，跌落期间的角度输出会被上层忽略，恢复静止后自动回到正常。
4.3 atan2 实现全周恒定灵敏度
俯仰和滚转用 atan2 写，整个 360° 范围内灵敏度分布均匀得多：
void acc_to_pitch_roll(const int16_t raw[3], float lsb_mg, float *pitch, float *roll) { float ax = raw[0] * lsb_mg / 1000.0f; float ay = raw[1] * lsb_mg / 1000.0f; float az = raw[2] * lsb_mg / 1000.0f; /* pitch: 绕 Y 轴，范围 -90 ~ +90 */ *pitch = atan2f(ax, sqrtf(ay * ay + az * az)) * RAD2DEG; /* roll: 绕 X 轴，范围 -180 ~ +180 */ *roll = atan2f(ay, az) * RAD2DEG; }atan2f(ax, sqrtf(ay*ay + az*az))的分母永远非负，ax 再大也不会出现除零；atan2f(ay, az)在 ay、az 同时接近 0 时仍然有定义，返回 0 或 ±180°，不会抛异常。这两个性质让 atan2 版本在工程上比 arcsin 版本稳得多。
需要提醒的是旋转顺序。pitch 和 roll 的定义依赖于先绕哪个轴转，ZYX 和 ZXY 顺序下同一组数据算出来的角度不一样。代码里的公式默认是“先滚转后俯仰”，如果机械安装方向或者上层姿态融合用的是另一套约定，必须把轴向和符号一起改，不能只改公式不改映射。我在一个云台项目里就吃过这个亏，算法和机械对不上，水平时输出 90°，查了两天才发现是 Y、Z 轴接反。
4.4 数值保护：NaN、除零与符号
三角函数链路上有三个地方必须加保护。第一是 asin/acos 的输入裁剪，前面已经写了。第二是归一化时的模值下限，防止自由落体期间除零。第三是输出有效性标记，NaN 不能直接传给显示层或者 PID 控制器，很多控制环拿到 NaN 之后会输出一个极大的错误值，直接把执行机构顶到限位。
我的习惯是在角度结构体里加一个 valid 字段，解算函数负责置位，上层只处理 valid 为真的数据。这样即使传感器短暂异常，控制环也不会被污染。
5. 避坑与排查：五个把角度算歪的现场问题
5.1 现象：角度输出全是 NaN，或者偶尔蹦出 -90°
原因：12 位数据没有右移 4 位，原始值被当成 16 位有符号数直接乘灵敏度，数值放大 16 倍，送进 asin 的输入远超 1.0。
解决：确认读取链路里v >> 4没有被优化掉，或者量程换算系数写错。用调试器抓一帧原始值，静止水平放置时 X、Y 应接近 0，Z 应接近 ±1024（±2 g、12 位、左对齐右移后的值），如果看到 ±16384 这个量级，就是没移位。
5.2 现象：缓慢翻转设备，角度在 45° 附近出现小台阶，或者 30° 和 150° 输出一样
原因：用了双轴公式，且在 45° 附近硬切换主轴；或者只用了单轴 arcsin，没有象限判断。
解决：换成三轴 atan2 解算，用第三轴提供象限信息。如果硬件确实只有两轴，切换点加迟滞，并接受 ±90° 以外的角度不可分辨这一事实，在上层用其他传感器补。
5.3 现象：水平校准重复性差，同一位置多次上电角度差 1° 以上
原因：量程选了 ±8 g 或 ±16 g，量化误差折算到角度上已经超过 0.5°；或者 ODR 过高，噪声带宽太宽。
解决：量程改回 ±2 g，ODR 降到 50 Hz 以内，配合 8 到 16 点的滑动平均。改完再测，重复性一般能进到 ±0.2° 以内。
5.4 现象：角度曲线上偶发单点尖峰，隔几十帧出现一次
原因：没有开 BDU，读高字节和低字节之间数据更新，拼出来的值跳变；或者多字节读没有用地址自动递增，三个轴不是同一时刻的采样。
解决：CTRL_REG4 的 BDU 位置 1，读取时用REG_OUT_X_L | 0x80一次连续读 6 字节。改完之后尖峰应该完全消失，如果还有，检查 I2C 总线上有没有其他设备抢占总线导致读超时。
5.5 现象：静止时角度很稳，一装到设备上就漂，手一碰跳好几度
原因：动态加速度混进了重力分量，设备的振动、电机转动、人手触碰都会让合成模值偏离 1 g，此时算出来的“倾角”其实是重力与动态加速度的合矢量方向。
解决：加 |A| 判据，合成模值偏离 1 g 超过 ±0.1 g 时标记为动态区间，角度输出保持上一帧或者冻结；同时加一阶低通，截止频率设在 2 到 5 Hz，把高频振动滤掉。低通系数不要设得太小，否则真实姿态变化会有明显滞后。
注意：零偏和安装倾斜是两回事。零偏靠校准能修，安装倾斜要靠机械基准或者出厂标定矩阵，混在一起调会把灵敏度也带偏。
6. 精度进阶：零偏校准、温度漂移与实测验证
零偏校准最省事的做法是六面法：把设备分别以 ±X、±Y、±Z 六个面朝下静置，每个姿态采 200 帧取均值，然后按下面的关系算每轴的零偏和灵敏度。
import numpy as np # plus/minus: 六个姿态下的原始均值，单位 LSB plus_x, minus_x = 1012.0, -988.0 plus_y, minus_y = 995.0, -1005.0 plus_z, minus_z = 1020.0, -980.0 offset_x = (plus_x + minus_x) / 2.0 gain_x = (plus_x - minus_x) / 2.0 # 对应 1g 的 LSB 数 offset_y = (plus_y + minus_y) / 2.0 gain_y = (plus_y - minus_y) / 2.0 offset_z = (plus_z + minus_z) / 2.0 gain_z = (plus_z - minus_z) / 2.0 print(f"offset = ({offset_x:.1f}, {offset_y:.1f}, {offset_z:.1f}) LSB") print(f"gain = ({gain_x:.1f}, {gain_y:.1f}, {gain_z:.1f}) LSB/g")理想情况下每个 gain 都应该接近 1000 LSB/g（±2 g、12 位、1 mg/LSB），偏差超过 5% 说明焊接应力或者贴装角度有问题。offset 超过 ±50 LSB 就要怀疑器件有没有受潮或者回流焊温度曲线不对。
温度漂移没法靠一次校准解决。零偏随温度大致呈线性，可以在高低温箱里打几个温度点，拟合一条 offset(T) 曲线，运行时用片上温度传感器或者环境温度做补偿。消费级产品做这一步的少，工业级产品基本跑不掉。
验证环节我一般用角度块或者带刻度的小转台，在 0°、15°、30°、45°、60°、75°、90° 七个点各采 100 帧，记录均值和标准差，做一张误差表。均值减标称值看系统误差，标准差看噪声。系统误差超过 0.5° 回头查校准和安装，噪声超过 0.3° 回头查 ODR 和滤波。
从那以后我每次拿到新的加速度计板子，都会先做三件事：抓一帧原始值确认移位和量程没搞错，跑一遍六面法看 gain 和 offset，再用角度块打七个点出误差表。这三步走完，后面写姿态算法心里才有底。希望帮到你。
本文还有配套的精品资源，点击获取
