第2章传感器选型与驱动

第2章：传感器选型与驱动：MEMS陀螺仪与加速度计选型、SPI/I2C驱动开发、传感器数据手册解读

好，咱们接着聊。上一章我们把惯性导航的总体框架搭起来了，这一章要落地了——选传感器，写驱动。

说实话，传感器选型这块，我踩过的坑比写过的代码还多。你想想看，弹载环境，温度从-40℃到+85℃是家常便饭，振动冲击动不动几十个g。选错了传感器，后面算法写得再漂亮也是白搭。

2.1 MEMS陀螺仪与加速度计选型要点

选型这事儿，说白了就是找平衡。精度、带宽、量程、功耗、成本，这五个维度你得自己掂量。

核心指标我列一下：

零偏稳定性：陀螺仪一般看°/h，加速度计看mg。弹载惯导，陀螺零偏稳定性最好在10°/h以内，加速度计在1mg以内。我见过有人用消费级的IMU做导航，零偏漂移得跟喝醉了似的，根本没法用。
角度随机游走：这个指标决定了你的积分误差增长有多快。单位是°/√h。越小越好。
量程：弹体旋转速率可能很高，尤其是滚转通道。陀螺仪量程至少±2000°/s，加速度计量程至少±16g。别问我怎么知道的——有一次我选了个±250°/s的陀螺，结果半程就饱和了，数据直接飞了。
带宽：弹载环境振动频率高，带宽至少100Hz以上。太低的话，高频振动会混叠到低频，产生虚假角速度。
抗冲击能力：这个必须看数据手册里的"Shock Survivability"参数。弹载环境，10000g的冲击是常事。

重要提醒： 选型时别只看典型值，要看全温范围内的最大值。我有个项目，室温下零偏稳定性标称5°/h，结果高温下飙到50°/h，整个导航系统直接废了。

市面上常见的MEMS IMU芯片：

型号	厂商	陀螺零偏稳定性	加速度计零偏	量程	接口
ADIS16470	ADI	8°/h	1mg	±2000°/s, ±40g	SPI
BMI088	Bosch	10°/h	2mg	±2000°/s, ±24g	SPI/I2C
ICM-20948	InvenSense	15°/h	3mg	±2000°/s, ±16g	SPI/I2C

我个人习惯优先选ADI的片子，虽然贵，但抗冲击和温度稳定性确实好。BMI088性价比高，很多无人机都在用。ICM-20948功耗低，适合电池供电的场景。

2.2 数据手册解读——别只看首页

很多工程师拿到数据手册，翻到首页看看参数，然后就开始写代码了。嗯，这是个坑。

数据手册里必须仔细看的几个部分：

时序图：SPI的时钟极性(CPOL)和时钟相位(CPHA)必须看对。我见过有人把模式0和模式3搞混，读出来的数据全是0xFF。
寄存器映射：每个寄存器的地址、读写属性、复位值、位定义。尤其是状态寄存器，你得知道哪个位表示数据准备好了。
上电时序：芯片从复位到正常工作需要多长时间？有些芯片需要等待几百毫秒才能开始读取数据。
滤波器配置：内部数字滤波器的截止频率怎么设置？带宽和延迟的trade-off怎么选？
校准参数：有些芯片出厂时内置了校准系数，存在OTP里。你得知道怎么读取和应用这些系数。

我的小技巧： 拿到数据手册后，先画一张寄存器访问流程图。把初始化流程、数据读取流程、中断配置流程都画出来。这样写驱动的时候思路特别清晰。

2.3 SPI/I2C驱动开发实战

好，到了动手环节。我们以ADIS16470为例，写一个SPI驱动。

为什么选SPI而不是I2C？

弹载环境对实时性要求高。SPI是全双工，速率可以跑到10MHz以上。I2C有地址应答，速率一般不超过400kHz。而且SPI的时序更简单，不容易出问题。

SPI驱动核心代码：

/* ADIS16470 SPI驱动 - 基于STM32 HAL库 */

/* 寄存器读写宏 */
#define ADIS_SPI_READ  0x00  /* 读操作，最高位为0 */
#define ADIS_SPI_WRITE 0x80  /* 写操作，最高位为1 */

/* 读取16位寄存器值 */
uint16_t ADIS_ReadReg(uint16_t reg_addr)
{
    uint8_t tx_data[2];
    uint8_t rx_data[2];
    uint16_t result;

    /* 构造命令：高字节为地址，低字节为0 */
    tx_data[0] = (reg_addr & 0x7F) | ADIS_SPI_READ;
    tx_data[1] = 0x00;

    /* CS拉低 */
    HAL_GPIO_WritePin(ADIS_CS_GPIO_Port, ADIS_CS_Pin, GPIO_PIN_RESET);

    /* SPI收发 */
    HAL_SPI_TransmitReceive(&hspi1, tx_data, rx_data, 2, 100);

    /* CS拉高 */
    HAL_GPIO_WritePin(ADIS_CS_GPIO_Port, ADIS_CS_Pin, GPIO_PIN_SET);

    /* 组合结果：大端模式 */
    result = ((uint16_t)rx_data[0] << 8) | rx_data[1];

    return result;
}

/* 写入16位寄存器值 */
void ADIS_WriteReg(uint16_t reg_addr, uint16_t value)
{
    uint8_t tx_data[2];

    /* 构造命令 */
    tx_data[0] = (reg_addr & 0x7F) | ADIS_SPI_WRITE;
    tx_data[1] = (uint8_t)(value & 0xFF);

    /* CS拉低 */
    HAL_GPIO_WritePin(ADIS_CS_GPIO_Port, ADIS_CS_Pin, GPIO_PIN_RESET);

    /* SPI发送 */
    HAL_SPI_Transmit(&hspi1, tx_data, 2, 100);

    /* CS拉高 */
    HAL_GPIO_WritePin(ADIS_CS_GPIO_Port, ADIS_CS_Pin, GPIO_PIN_SET);
}

注意： ADIS16470的SPI时序要求CS拉低后至少等待50ns才能开始时钟信号。有些MCU的GPIO翻转速度不够快，需要在CS操作后加几个NOP延时。我曾经因为这个原因，读出来的数据总是错位，排查了两天才发现是时序问题。

初始化流程：

/* ADIS16470初始化函数 */
uint8_t ADIS_Init(void)
{
    uint16_t prod_id;

    /* 1. 等待芯片上电稳定 */
    HAL_Delay(100);

    /* 2. 读取产品ID确认通信正常 */
    prod_id = ADIS_ReadReg(ADIS_REG_PROD_ID);
    if (prod_id != 0x4070)  /* ADIS16470的产品ID */
    {
        return 1;  /* 初始化失败 */
    }

    /* 3. 配置滤波器：设置内部低通滤波器截止频率 */
    ADIS_WriteReg(ADIS_REG_FILT_CTRL, 0x0004);  /* 设置带宽约330Hz */

    /* 4. 设置量程 */
    ADIS_WriteReg(ADIS_REG_SENS_AVG, 0x0404);  /* 陀螺±2000°/s, 加速度计±40g */

    /* 5. 使能数据就绪中断（可选） */
    ADIS_WriteReg(ADIS_REG_MSC_CTRL, 0x0006);  /* 使能DIO1作为数据就绪输出 */

    return 0;  /* 初始化成功 */
}

2.4 数据读取与校验

传感器数据读回来了，但你不能直接用。为什么？因为可能有错误。

数据校验三板斧：

CRC校验：很多工业级IMU支持CRC。每次读取数据时，计算CRC并与芯片返回的CRC比较。不一致就丢弃这帧数据。
范围检查：陀螺仪输出如果突然跳到±2000°/s，而弹体明明在平稳飞行，那肯定是异常数据。设置一个合理的阈值，超出就标记为无效。
连续性检查：相邻两帧数据的变化量不能太大。如果角速度从10°/s突然变成1000°/s，大概率是通信错误。

核心原则： 宁可丢帧，不用坏帧。导航系统对错误数据的容忍度极低，一个错误数据可能让整个导航结果发散。

数据读取示例：

/* 读取陀螺仪和加速度计数据 */
void ADIS_ReadSensorData(IMU_Data_t *data)
{
    int16_t raw_gyro_x, raw_gyro_y, raw_gyro_z;
    int16_t raw_accel_x, raw_accel_y, raw_accel_z;

    /* 批量读取6个寄存器 */
    raw_gyro_x   = (int16_t)ADIS_ReadReg(ADIS_REG_GYRO_X);
    raw_gyro_y   = (int16_t)ADIS_ReadReg(ADIS_REG_GYRO_Y);
    raw_gyro_z   = (int16_t)ADIS_ReadReg(ADIS_REG_GYRO_Z);
    raw_accel_x  = (int16_t)ADIS_ReadReg(ADIS_REG_ACCEL_X);
    raw_accel_y  = (int16_t)ADIS_ReadReg(ADIS_REG_ACCEL_Y);
    raw_accel_z  = (int16_t)ADIS_ReadReg(ADIS_REG_ACCEL_Z);

    /* 转换为物理量 */
    /* ADIS16470: 陀螺灵敏度 0.05°/s/LSB, 加速度计灵敏度 1.25mg/LSB */
    data->gyro_x  = (float)raw_gyro_x  * 0.05f;
    data->gyro_y  = (float)raw_gyro_y  * 0.05f;
    data->gyro_z  = (float)raw_gyro_z  * 0.05f;
    data->accel_x = (float)raw_accel_x * 1.25f / 1000.0f;  /* 转换为g */
    data->accel_y = (float)raw_accel_y * 1.25f / 1000.0f;
    data->accel_z = (float)raw_accel_z * 1.25f / 1000.0f;

    /* 范围检查 */
    if (fabs(data->gyro_x) > 2000.0f || fabs(data->gyro_y) > 2000.0f || fabs(data->gyro_z) > 2000.0f)
    {
        data->valid = 0;  /* 数据无效 */
    }
    else
    {
        data->valid = 1;
    }
}

2.5 避坑指南——我踩过的那些坑

最后，分享几个实战中容易踩的坑：

SPI速率别拉太高：我曾经为了追求速度，把SPI时钟设到20MHz。结果线缆一长，信号反射严重，数据全是错的。弹载环境线缆长度有限，但建议控制在10MHz以内。
注意电源纹波：MEMS传感器对电源质量很敏感。电源纹波大的时候，输出噪声会明显增大。我建议在传感器电源引脚附近加10μF和0.1μF的去耦电容。
温度补偿不能省：很多MEMS芯片内部有温度传感器，可以用来做零偏补偿。别偷懒，把温度补偿算法写进去，能显著提高精度。
多读几次状态寄存器：有些芯片的状态寄存器需要连续读两次才能得到稳定值。第一次读可能是旧数据，第二次才是最新的。

嗯，这一章内容不少。传感器选型和驱动开发是惯导系统的基础，基础不牢，地动山摇。下一章我们讲传感器校准，到时候会用到今天写的驱动代码。

记住：硬件是骨架，驱动是肌肉，算法才是灵魂。但骨架歪了，肌肉再发达也没用。

📚 课程目录