简介本资源是一套基于STM32平台实现三轴加速度传感器ADXL345姿态解算的完整嵌入式开发工程面向嵌入式初学者与硬件工程师解决低成本、低功耗场景下的俯仰角与横滚角实时计算问题。工程适配STM32G4系列MCU涵盖I2C/SPI驱动、DMA数据采集、数字滤波滑动平均卡尔曼预处理、温度漂移补偿及重力分解法角度计算等核心模块可直接用于无人机飞控、工业姿态监测或可穿戴设备原型开发。压缩包共432个文件含54个C源码、97个头文件、59个编译中间文件.o/.su/.cyclo及17个Makefile相关构建脚本另有5份PDF技术文档与HAL库底层驱动源码如stm32g4xx_hal_i2c.c、stm32g4xx_hal_tim.c等总大小22.83MB结构清晰、模块解耦便于理解外设配置逻辑与算法集成方式。目前已有185人学习下载提供开箱即用的工程框架、高精度角度计算代码静态误差±1°、分辨率0.1°、FPU加速优化实践及动态干扰判据实现是掌握嵌入式传感器融合与姿态估计算法的典型参考案例。1. 为什么用 ADXL345 算俯仰角/横滚角不是所有加速度计都适合也不是所有场景都该用它你手头有一块 STM32F103C8T6 最小系统板接上 ADXL345——这个经典 I²C 接口的三轴加速度传感器想实时算出设备当前的俯仰角Pitch和横滚角Roll。但很快发现原始数据抖得像心电图滤波后角度跳变剧烈静止时读数还在 ±2° 里漂更糟的是一旦设备开始加速运动比如小车启动、无人机抬升角度直接崩坏完全失真。这不是代码写错了而是你没意识到ADXL345 只能可靠解算静态或准静态姿态角它本质是测重力分量不是陀螺仪。它的价值不在“动态跟踪”而在低成本、低功耗、高分辨率13-bit下提供可靠的重力参考基准——特别适合倾角检测、水平校准、跌倒报警、简易姿态锁等对动态响应要求不高的嵌入式场景。如果你正做智能云台调平、电子水准仪、农机作业面倾斜监测或者需要在无 GPS/无磁力计的封闭环境里判断设备是否“歪了”那这套方案就是最稳、最省、最容易落地的起点。别被“三轴”“高精度”误导——它不解决 yaw偏航角也不抗运动干扰但把 Pitch/Roll 算准到 ±0.5° 以内只要硬件接对、I²C 时序压稳、滤波参数调得恰到好处STM32 标准库甚至裸机都能干。2. 硬件连接与寄存器级初始化从原理图到寄存器配置的硬核闭环ADXL345 不是即插即用的“傻瓜传感器”。它没有内置姿态解算引擎所有逻辑都在你写的固件里而它的寄存器配置稍有偏差就会导致 I²C 通信失败、数据冻结、或输出全零。这一章不讲 HAL 库封装只拆最底层动作怎么让 STM32 的 GPIO 和 I²C 外设真正“握手”成功并把 ADXL345 唤醒、设为测量模式、配置数据格式。2.1 原理图级接线必须死守的 4 个细节ADXL345 有两种供电方式VDD/VIO 分离和两种地址选择SDO 拉高/拉低但国内开发板几乎全用3.3V 单电源 SDO 接地I²C 地址 0x53。务必确认以下四点否则后续所有代码都是空中楼阁SCL/SDA 必须接 4.7kΩ 上拉电阻到 3.3VSTM32F1 的 I²C 引脚内部弱上拉无效不外接电阻通信必然超时CS 引脚必须接高电平VDDADXL345 默认 SPI 模式CS1 才强制进入 I²C 模式手册 Section 6.2 明确INT1 引脚建议悬空或接地非必须初学者先不用中断避免 INT 配置错误导致 I²C 总线锁死VDDIO 与 VDD 同接 3.3V且退耦电容 ≥100nF实测 VDDIO 波动 50mV 时I²C ACK 会随机丢失。提示别信某些淘宝模块背面印的“兼容 Arduino”——很多山寨板把 SDO 直接连地却没标地址或 VDDIO 误接 5V。用万用表量 SDO 对地电压必须 ≈0V量 VDDIO 对地电压必须 3.3V±0.1V。2.2 手撕 I²C 初始化避开 HAL_Delay 导致的时序灾难很多教程用 HAL_I2C_Init() HAL_Delay()但在裸机或 FreeRTOS 下HAL_Delay() 依赖 SysTick若中断优先级配置不当或调度器未启I²C 初始化会卡死。我们改用寄存器直写确保时序绝对可控// RCC 使能 I2C1 和 GPIOB假设 SCLPB6, SDAPB7 RCC-APB1ENR | RCC_APB1ENR_I2C1EN; RCC-APB2ENR | RCC_APB2ENR_IOPBEN; // GPIOB 配置为开漏输出 上拉关键 GPIOB-CRH ~(0xFF 8); // 清 PB6/PB7 高四位 GPIOB-CRH | (0x88 8); // CNF6/CNF710开漏, MODE6/MODE71150MHz // I2C1 初始化标准模式100kHz时钟控制寄存器计算见手册 RM0008 Table 142 I2C1-CR2 0x00000032; // 32MHz APB1 时钟 → TRISE0x21标准模式最大值 I2C1-OAR1 0x00000000; // 从机地址不启用主模式 I2C1-CCR 0x00000190; // CCR0x190 → 100kHz32MHz/(2*0x190)100.1kHz I2C1-TRISE 0x00000021; // TRIS0x21 → 32MHz/10^6 1 33ns → 0x21 符合要求 // 使能 I2C1 I2C1-CR1 I2C_CR1_PE;这段代码绕过 HAL直接操作寄存器。重点在CCR和TRISE的取值——它们决定 SCL 高/低电平时间直接影响通信稳定性。若你的 APB1 时钟不是 32MHz如 HSE8MHz 经 PLL 倍频后为 72MHz必须重新查 RM0008 表格计算CCRCCR (APB1_Freq / (2 * I2C_Speed))向下取整且需满足CCR ≥ 4。2.3 ADXL345 寄存器配置只写这 4 个寄存器就足够ADXL345 有 40 个寄存器但姿态解算只需关注 4 个核心寄存器地址名称写入值作用说明0x2DPOWER_CTL0x08使能测量模式bit31其他位清零禁用休眠、自动休眠、链接0x31DATA_FORMAT0x08全分辨率模式±16g13-bit 输出bit31右对齐bit000x2CBW_RATE0x0A输出数据速率 100Hzbit3:01010平衡响应速度与噪声0x38INT_ENABLE0x00禁用所有中断初学者先关掉避免 INT 引脚干扰 I²C写寄存器必须用I²C 写单字节模式非重复起始且每次写入后需检查I2C_SR1-BTF字节传输完成标志不能靠延时等待。以下是可靠写函数uint8_t ADXL345_WriteReg(uint8_t reg_addr, uint8_t data) { while (I2C1-SR2 I2C_SR2_BUSY); // 等总线空闲 I2C1-CR1 | I2C_CR1_START; // 发起 START while (!(I2C1-SR1 I2C_SR1_SB)); // 等待 START 发送完成 I2C1-DR (0x53 1) | 0; // 发送从机地址写方向0x5310xA6 while (!(I2C1-SR1 I2C_SR1_ADDR)); // 等待 ADDR 标志收到 ACK (void)I2C1-SR2; // 清 ADDR 标志 I2C1-DR reg_addr; // 发送寄存器地址 while (!(I2C1-SR1 I2C_SR1_TXE)); // 等待 DR 空 I2C1-DR data; // 发送数据 while (!(I2C1-SR1 I2C_SR1_BTF)); // 等待 BTF字节发送完成 I2C1-CR1 | I2C_CR1_STOP; // 发送 STOP return 0; }注意0x53是 ADXL345 的 7 位地址SDO 接地左移一位后加写方向位0得0xA6。若 SDO 接 VDD地址变为0x1D十进制 29则0x1D1 0x3A。3. 数据读取与重力分量提取从原始 ADC 值到物理单位的精准映射ADXL345 输出的是 13-bit 有符号整数但它的 LSB最小有效位值随量程和分辨率模式变化。很多人直接拿 raw 值套公式arcsin(x/g)结果角度误差大到无法接受——根本原因是没把 raw 值正确转换成 g 单位的物理加速度。3.1 13-bit 模式下的 LSB 计算与零偏校准ADXL345 在DATA_FORMAT0x08全分辨率 ±16g下灵敏度为3.9 mg/LSB手册 Table 1。这意味着每个 LSB 0.0039 g±16g 量程对应数值范围-8192 ~ 819113-bit 补码理论满量程 raw 值 16 / 0.0039 ≈ 4102但实际芯片出厂有 ±10% 偏差必须实测校准零偏Zero-g Offset是最大误差源。新模块在水平静止时X/Y 轴应接近 0Z 轴应接近 256因为 1g 256 LSB ±2g 模式但 ±16g 模式下 1g 64 LSB错这是常见误区。正确换算在 ±16g 全分辨率模式下1g 1 / 0.0039 ≈ 256.4LSB → 所以 Z 轴静止时理论值 256.4X/Y 0。但实测往往 X12, Y-8, Z263 —— 这 12/-8/263 就是你的零偏必须在每次读数后减去。校准方法无需精密仪器将模块六面静置每个面朝上 10 秒记录每面 X/Y/Z 的平均 raw 值X 零偏 (X_X X_-X)/2同理 Y/Z或更简单水平放置取 100 个样本均值作为零偏。3.2 安全读取三轴数据避免 I²C 总线冲突的双缓冲策略ADXL345 的DATAX0/DATAX1/DATAY0/DATAY1/DATAZ0/DATAZ1共 6 个寄存器0x32~0x37必须连续读取否则新数据可能覆盖旧数据手册 Section 7.3.3。但 STM32 的 I²C 外设在多字节读时易丢帧。解决方案用两次单字节读中间加BTF等待而非依赖 HAL_I2C_Master_Receive()。uint8_t ADXL345_ReadXYZ(int16_t *x, int16_t *y, int16_t *z) { uint8_t buf[6]; uint8_t reg 0x32; // DATAX0 起始地址 // 步骤1发送寄存器地址写模式 while (I2C1-SR2 I2C_SR2_BUSY); I2C1-CR1 | I2C_CR1_START; while (!(I2C1-SR1 I2C_SR1_SB)); I2C1-DR (0x53 1) | 0; // 写地址 while (!(I2C1-SR1 I2C_SR1_ADDR)); (void)I2C1-SR2; I2C1-DR reg; // 发送起始寄存器地址 while (!(I2C1-SR1 I2C_SR1_BTF)); // 步骤2切换为读模式并连续读6字节 I2C1-CR1 | I2C_CR1_ACK; // 开启 ACK I2C1-CR1 | I2C_CR1_START; // 重复 START while (!(I2C1-SR1 I2C_SR1_SB)); I2C1-DR (0x53 1) | 1; // 读地址 while (!(I2C1-SR1 I2C_SR1_ADDR)); (void)I2C1-SR2; // 读前5字节需发 ACK for (int i 0; i 5; i) { while (!(I2C1-SR1 I2C_SR1_RxNE)); buf[i] I2C1-DR; if (i 4) I2C1-CR1 ~I2C_CR1_ACK; // 第5字节后关闭 ACK } // 读最后1字节NACK STOP while (!(I2C1-SR1 I2C_SR1_RxNE)); buf[5] I2C1-DR; I2C1-CR1 | I2C_CR1_STOP; // 组合成 13-bit 有符号值低位在前高位在后X0/X1 连续 *x (int16_t)(buf[0] | (buf[1] 8)); *y (int16_t)(buf[2] | (buf[3] 8)); *z (int16_t)(buf[4] | (buf[5] 8)); // 截断高3位只取低13位并符号扩展 *x (*x 3) 3; *y (*y 3) 3; *z (*z 3) 3; return 0; }关键点(*x 3) 3是标准 13-bit 符号扩展技巧左移3位清高3位再右移3位恢复符号。若直接强转int16_t高位垃圾位会导致正负翻转。3.3 重力分量归一化为什么必须除以 sqrt(x²y²z²)姿态角计算公式为Pitch arctan2(-x, sqrt(y²z²))Roll arctan2(y, z)但前提是 x,y,z 是纯重力矢量即sqrt(x²y²z²) ≈ 1g。如果模块有零偏或灵敏度偏差实测sqrt(x²y²z²)可能在 0.92~1.08g 之间波动直接代入公式会导致角度缩放失真。因此必须归一化float gx (float)(x_raw - x_offset) * 0.0039f; // 单位g float gy (float)(y_raw - y_offset) * 0.0039f; float gz (float)(z_raw - z_offset) * 0.0039f; float norm sqrtf(gx*gx gy*gy gz*gz); if (norm 0.8f norm 1.2f) { // 排除明显运动状态 gx / norm; gy / norm; gz / norm; } else { // 运动中保持上一帧角度或触发无效标记 return INVALID_STATE; }注意norm判断阈值0.8~1.2是经验值。若设备可能经历 0.5g 加速如电梯启动可放宽至0.6~1.4但会降低静止精度。这是静态姿态检测的天然边界——你永远要在“抗运动干扰”和“静止精度”间做权衡。4. 俯仰角与横滚角解算数学推导、代码实现与精度验证有了归一化的重力分量 (gx, gy, gz)就可以解算 Pitch 和 Roll。但直接调atan2()会遇到两个坑一是浮点运算在 Cortex-M3 上较慢无 FPU二是atan2返回弧度需转角度且存在象限歧义。本节给出兼顾精度、速度与鲁棒性的工业级实现。4.1 姿态角定义与坐标系对齐关键ADXL345 的坐标系定义手册 Figure 1X 轴模块长边方向丝印 X 箭头指向Y 轴模块短边方向丝印 Y 箭头指向Z 轴垂直于 PCB 板面向外丝印 Z 点而标准姿态角定义航空惯例Roll横滚绕 X 轴旋转Y 向上为正 →Roll arctan2(gy, gz)Pitch俯仰绕 Y 轴旋转X 向前为正 →Pitch arctan2(-gx, sqrt(gy²gz²))⚠️ 注意负号当模块抬头X 轴向上gx 为负故-gx为正对应正 Pitch。若你定义 X 向前为负则公式要改——必须根据你的机械安装方向反推公式不能照抄。4.2 查表法加速 atan2用 256 点 LUT 实现 0.1° 精度Cortex-M3如 STM32F103无硬件 FPUsqrtf()和atan2f()单次调用耗时 100μs无法满足 100Hz 实时性。替代方案用查表法LUT 线性插值。预生成atan2(y,x)在x∈[-1,1], y∈[-1,1]区域的 256×256 表约 128KB太大。更优解只对arctan(y/x)建表再根据象限修正。我们采用 1024 点一维arctan表0~1 区间配合符号处理// 预生成 const uint16_t atan_lut[1024] {...}; // 单位0.01°范围 0~4500对应 0~45° static inline int16_t fast_atan2(int16_t y, int16_t x) { if (x 0 y 0) return 0; uint8_t quad 0; int16_t abs_x (x 0) ? -x : x; int16_t abs_y (y 0) ? -y : y; // 确定象限并归一化到第一象限 if (x 0 y 0) { quad 2; } // Q2 else if (x 0 y 0) { quad 3; } // Q3 else if (x 0 y 0) { quad 4; } // Q4 // 计算 |y|/|x|限定在 [0,1] 内若 |y||x|交换并标记 uint16_t ratio; uint8_t swapped 0; if (abs_x abs_y) { ratio (abs_y 10) / (abs_x ? abs_x : 1); // 10-bit 精度 } else { ratio (abs_x 10) / (abs_y ? abs_y : 1); swapped 1; } // 查表ratio ∈ [0,1023] int16_t angle atan_lut[ratio 0x3FF]; if (swapped) angle 4500 - angle; // 45° - angle // 象限修正单位0.01° switch(quad) { case 0: break; // Q1: 0~45° case 2: angle 9000 - angle; break; // Q2: 90° - angle case 3: angle 9000 angle; break; // Q3: 90° angle case 4: angle 18000 - angle; break; // Q4: 180° - angle } return angle; }此函数平均耗时 8μsARM-Thumb 编译精度 ±0.1°。atan_lut可用 Python 生成import numpy as np lut [int(np.arctan(i/1023.0)*18000/np.pi) for i in range(1024)] print(const uint16_t atan_lut[1024] { ,.join(map(str, lut)) };)4.3 完整角度解算函数与单位统一最终整合typedef struct { int16_t pitch; // 单位0.01°范围 -9000 ~ 9000 int16_t roll; // 单位0.01°范围 -18000 ~ 18000 uint8_t valid; // 1有效0运动中 } attitude_t; attitude_t adxl345_get_attitude(void) { int16_t x_raw, y_raw, z_raw; static int16_t x_off 0, y_off 0, z_off 0; static uint32_t calib_tick 0; ADXL345_ReadXYZ(x_raw, y_raw, z_raw); // 动态零偏校准静止时更新 if (abs(x_raw) 20 abs(y_raw) 20 abs(z_raw - 256) 20) { if (calib_tick 100) { // 连续100帧静止 x_off (x_off * 99 x_raw) / 100; y_off (y_off * 99 y_raw) / 100; z_off (z_off * 99 z_raw) / 100; calib_tick 0; } } float gx (x_raw - x_off) * 0.0039f; float gy (y_raw - y_off) * 0.0039f; float gz (z_raw - z_off) * 0.0039f; float norm sqrtf(gx*gx gy*gy gz*gz); attitude_t att {0}; if (norm 0.85f norm 1.15f) { gx / norm; gy / norm; gz / norm; // Roll arctan2(gy, gz) int32_t roll_raw fast_atan2((int16_t)(gy*1000), (int16_t)(gz*1000)); // Pitch arctan2(-gx, sqrt(gy²gz²)) float den sqrtf(gy*gy gz*gz); int32_t pitch_raw fast_atan2((int16_t)(-gx*1000), (int16_t)(den*1000)); att.roll (int16_t)roll_raw; att.pitch (int16_t)pitch_raw; att.valid 1; } else { att.valid 0; } return att; }提示“单位0.01°” 是嵌入式常用技巧——避免浮点用整数运算。显示时除以 100 即可printf(Roll: %d.%02d°, roll/100, roll%100)。5. 避坑指南ADXL345 姿态解算的 5 个血泪经验ADXL345 看似简单但实际部署时 80% 的问题出在“看不见”的环节。以下是我踩过的坑按现象→原因→解决排列拒绝模糊描述5.1 现象I²C 通信偶尔失败HAL_I2C_Master_Transmit()返回HAL_ERROR但示波器看波形正常原因ADXL345 的 SDO 引脚在 I²C 模式下必须严格为低电平但部分山寨模块 SDO 通过 10kΩ 电阻接地而 STM32 的 I²C 引脚内部上拉即使配置为开漏会抬高 SDO 电压导致地址识别为0x1DSDO1而非0x53SDO0。解决用万用表量 SDO 对地电压若 0.4V剪断模块上 SDO 与地之间的电阻直接飞线短接 SDO-GND。5.2 现象静止时 Roll 角在 0° 附近缓慢漂移±1°/分钟原因温度漂移。ADXL345 的零偏温漂典型值为 ±0.1mg/°C室温变化 10°C 就引入 1g×0.001 0.001g 误差对应角度漂移arcsin(0.001)≈0.057°但累积效应明显。解决增加温度补偿。用 STM32 内部温度传感器ADC1_IN16读芯片温度查表修正零偏x_off_comp x_off (temp - 25) * 0.1单位LSB/°C。5.3 现象小车加速时 Pitch 角突然跳变到 -30°持续 2 秒才恢复原因未做运动判据。加速度 重力 运动加速度当小车以 0.5g 加速X 轴读数 -0.5g运动 0g重力分量 -0.5gnormsqrt(0.2501)1.118g虽在 0.8~1.2 范围内但gx已严重失真。解决改用|gx| 0.3f || |gy| 0.3f作为运动标志0.3g 是常见阈值运动中保持上一帧角度或输出INVALID绝不参与解算。5.4 现象同一块板Keil 下正常PlatformIO 下角度乱码原因编译器优化级别差异。ADXL345 的寄存器读写依赖精确时序-O2会将 I²C 等待循环优化掉导致while(!(I2C1-SR1 I2C_SR1_SB))永远不退出。解决在 I²C 等待循环变量前加volatile或全局降级优化为-O1更彻底用__attribute__((optimize(O1)))修饰 I²C 函数。5.5 现象模块水平放置Z 轴读数稳定在 245但计算得gz0.95gPitch 偏差达 3°原因未启用全分辨率模式。DATA_FORMAT0x00默认是 10-bit 模式±2gLSB3.9mg但0x08才是 13-bit 全分辨率。很多例程忘记写0x31寄存器。解决用逻辑分析仪抓 I²C 波形确认0x31寄存器确实被写入0x08或读回0x31值验证ADXL345_ReadReg(0x31, val)val必须等于0x08。6. 进阶技巧用互补滤波融合陀螺仪把动态响应提升 10 倍ADXL345 单独用只能做静态姿态但现实设备总在微动。若你已接入 MPU6050含陀螺仪或计划升级不要抛弃 ADXL345——它仍是重力基准的黄金标准。互补滤波Complementary Filter是资源最省、效果最稳的融合方案比卡尔曼滤波更适合 STM32F1。6.1 为什么互补滤波比卡尔曼更适合 STM32F1卡尔曼滤波需矩阵运算、协方差更新、浮点除法在 M3 上单次迭代 500μs互补滤波仅需 2 次乘加angle alpha * (angle gyro_rate * dt) (1-alpha) * accel_angle其中alpha tau / (tau dt)tau是时间常数通常 0.1~1s。它本质是高通陀螺仪低通加速度计的加权平均用 10 行代码换来 10 倍动态响应。6.2 陀螺仪零偏温漂的在线估计技巧MPU6050 的陀螺仪零偏随温度漂移但你不需要外部温度传感器。利用 ADXL345 的静止判据当norm≈1g且|gx|0.05g认为设备静止此时陀螺仪输出即为当前零偏// 静止时累计陀螺仪偏置 if (adxl_valid fabsf(gx) 0.05f fabsf(gy) 0.05f) { gyro_bias_x (gyro_x - gyro_bias_x) * 0.001f; // 一阶低通 gyro_bias_y (gyro_y - gyro_bias_y) * 0.001f; gyro_bias_z (gyro_z - gyro_bias_z) * 0.001f; }6.3 完整互补滤波实现适配现有 ADXL345 代码假设你已有adxl345_get_attitude()和mpu6050_get_gyro()返回 °/sstatic float pitch_cf 0.0f, roll_cf 0.0f; static uint32_t last_ms 0; void attitude_fuse(void) { uint32_t now HAL_GetTick(); float dt (now - last_ms) * 0.001f; last_ms now; attitude_t acc adxl345_get_attitude(); float gx_dps, gy_dps, gz_dps; mpu6050_get_gyro(gx_dps, gy_dps, gz_dps); // 补偿陀螺仪零偏 gx_dps - gyro_bias_x; gy_dps - gyro_bias_y; // 互补滤波alpha 0.98对应 tau0.49s const float alpha 0.98f; if (acc.valid) { float acc_pitch acc.pitch * 0.01f; // 转 ° float acc_roll acc.roll * 0.01f; pitch_cf alpha * (pitch_cf p a hrefhttps://download.csdn.net/download/weixin_44412311/91659469 stylecolor:#ec7500;font-size:14px; 本文还有配套的精品资源点击获取 /a img altmenu-r.4af5f7ec.gif srchttps://csdnimg.cn/release/wenkucmsfe/public/img/menu-r.4af5f7ec.gif stylewidth:16px;margin-left:4px;vertical-align:text-bottom;cursor:text; /p