电子产品世界 » 论坛首页 » DIY与开源设计 » 电子DIY » 【let'sdo边缘AI电机状态检测】驱动三轴传感器

共1条 1/1 1 跳转至页

【let'sdo边缘AI电机状态检测】驱动三轴传感器

工程师
2026-11-16 23:22:20     打赏

一、为什么选 IS3DH 加 Grove 扩展板

在嵌入式项目里做姿态感知、振动检测或运动唤醒时,选型通常卡在两点:能否在低功耗条件下稳定采样,以及硬件改造的成本有多高。IS3DH 是 ST 推出的一款成熟的三轴数字加速度计,支持 I²C 和 SPI 双接口、内置 FIFO、支持中断与自由落体/单击/双击识别,量程可配置在 ±2g、±4g、±8g、±16g,很适合电池供电的可穿戴与结构监测场景。Grove 平台的评估扩展板把这件事变得更简单:板载了电平转换与稳压,对外只留一根四线 Grove 排线(VCC、GND、SDA、SCL),默认走 I²C,直接插到 Grove 扩展底座即可上电。这意味着驱动开发的注意力可以全部放在寄存器时序与数据处理上,不必先折腾飞线、上拉电阻和地址跳线。

二、硬件与通信基础

2.1 连接与时序

Grove 接口下 IS3DH 的 7 位从机地址为 0x18(SDA/SA0 引脚接地时),部分模块会通过电阻改到 0x19,第一次接触时建议先扫一次总线确认。上电后器件默认处于掉电状态,需要先写 CTRL_REG1 的 ODR 位进入正常模式,等一个 ODR 周期再读数据,否则会读到全零。I²C 访问的重点在自动地址递增:通过 CTRL_REG1 的 bit4(地址自动自增使能),连续读 XYZ 三个输出寄存器时不必每次重发地址,一次突发读六个字节即可,既省时序也避免三轴数据跨帧不一致。

2.2 关键寄存器速览

寄存器地址作用
WHO_AM_I0x0F固定返回 0x33,用于探测器件
CTRL_REG10x20ODR 与低功耗模式、轴使能、自增
CTRL_REG20x21高通滤波配置
CTRL_REG30x22中断引脚映射(1/2)
CTRL_REG40x23量程、分辨率、字节序
CTRL_REG50x24FIFO 使能、中断锁存
INT1_CFG0x30中断触发条件
OUT_X_L 起0x28–0x2D三轴数据(低字节在前)
量程配置要跟着应用走:手持摇摆检测取 ±2g 足够(灵敏度 1 mg/digit),跌落或冲击检测则建议 ±8g 以上,避免削波。若开启高分辨率模式,输出为 12 位左对齐,右移 4 位后再乘灵敏度系数才是实际 mg 值。

三、驱动分层的设计思路

驱动按三层拆开,便于在不同 MCU 间移植:
  1. 总线层:只暴露 i2c_write(reg, data) 和 i2c_read(reg, buf, len) 两个函数指针,由平台适配;SPI 版本只需替换这一层。

  2. 器件层:负责初始化序列、量程/ODR 配置、原始数据批量读取、中断配置。

  3. 应用层:把 mg 值转成 g、做角度换算、滤波与阈值判定。

这种分法最直接的好处是:换芯片不用改寄存器逻辑,换个传感器也只需换器件层。

四、初始化与读数实现

初始化顺序建议固定为:读 WHO_AM_I 校验 → 软复位(CTRL_REG5 bit6)→ 短暂延时 → 配 ODR 与轴使能 → 配量程与高分辨率 → (可选)配 FIFO 与中断。

批量读数代码的骨架大致如下(以 C 为例,抽象掉总线层):

#define IS3DH_ADDR      0x18
#define REG_WHO_AM_I    0x0F
#define REG_CTRL_REG1   0x20
#define REG_CTRL_REG4   0x23
#define REG_OUT_X_L     0x28

static int is3dh_probe(is3dh_t *dev)
{
    uint8_t id = 0;
    if (dev->read(REG_WHO_AM_I, &id, 1) < 0) return -1;
    return (id == 0x33) ? 0 : -2;
}

static void is3dh_init(is3dh_t *dev, uint8_t odr_code, uint8_t fs_code)
{
    is3dh_probe(dev);

    uint8_t c1 = 0;
    dev->read(REG_CTRL_REG1, &c1, 1);
    c1 &= ~(0x0F);                    /* 清 ODR */
    c1 |= (odr_code << 4);            /* ODR 编码 */
    c1 |= 0x08;                       /* 低功耗模式 */
    c1 |= 0x07;                       /* 使能 XYZ */
    c1 |= 0x10;                       /* 地址自动自增 */
    dev->write(REG_CTRL_REG1, c1);

    uint8_t c4 = fs_code << 4;        /* 量程 */
    c4 |= 0x08;                       /* 高分辨率 */
    c4 |= 0x80;                       /* BDU:防跨帧撕裂 */
    dev->write(REG_CTRL_REG4, c4);
}

static void is3dh_read_raw(is3dh_t *dev, int16_t xyz[3])
{
    uint8_t b[6];
    dev->read(REG_OUT_X_L | 0x80, b, 6);   /* 0x80 置位开启自增 */
    xyz[0] = (int16_t)((b[1] << 8) | b[0]) >> 4;
    xyz[1] = (int16_t)((b[3] << 8) | b[2]) >> 4;
    xyz[2] = (int16_t)((b[5] << 8) | b[4]) >> 4;
}

两点容易踩的坑:一是 CTRL_REG4 的 BDU 位一定要置位,否则低字节可能来自新一次采样、高字节来自上一次,读数会出现偶发跳变;二是读 OUT_X_L 时在寄存器地址上置 bit7,这是 IS3DH 支持的多字节读写法,等价于打开自增。

五、数据换算与实用功能

拿到 12 位原始值后,乘以灵敏度系数即得 mg(±2g 时为 1,±4g 为 2,±8g 为 4,±16g 为 12)。再除以 1000 得到 g 值。若需要倾角,可用重力分量做反正切:静止状态下 X 轴倾角为 atan2(y, z) 换算成角度,但注意存在 ±90° 的取值区间限制,多轴联动时需做象限修正。几个可以直接启用的内置能力:
  • 自由落体检测:配置 INT1_CFG 为低 g 事件,阈值寄存器设约 350 mg、持续时间设短一些,中断到来即判定失重。

  • 单击/双击识别:CLICK_CFG 选定轴,CLICK_THS 与 TIME_LIMIT 调整手感,适合按键替代方案。

  • FIFO 缓冲:FIFO_CTRL_REG 选择 Stream 或 Bypass 模式,主控休眠时由器件累积样本,唤醒后一次性读出,能显著降低平均功耗。

不过现在只通过I2C读取数据,有一些东西只能作为一个扩展功能。

六、实物连接

我们这里除了把传感器连接到开发板上,我们还需要实现的和电机的硬连接:

5641b06c-dd1e-46d8-963b-1452c200ca31.png

串口打印效果:

5ace9e9e-ffc3-424d-9566-05a418c1ba71.png





关键词: 三轴     传感器    

共1条 1/1 1 跳转至页

回复

匿名不能发帖!请先 [ 登陆 注册 ]