STM32与BMI160 IMU运动追踪开发指南

STM32BMI160IMU

于 2026-07-07 13:47:32 修改

·本内容遵循CC 4.0 BY-SA版权协议

1. 项目背景与硬件选型

在运动追踪和姿态检测领域，六轴惯性测量单元(IMU)已成为核心传感器。Bosch BMI160作为一款集成了3轴加速度计和3轴陀螺仪的MEMS传感器，具有低功耗(典型值950μA)、高精度(16位输出)和智能算法集成等特点。STM32F373RC则是STMicroelectronics推出的Cortex-M4内核微控制器，内置硬件浮点运算单元和丰富的外设接口，特别适合实时传感器数据处理。

这套组合的独特优势在于：

BMI160支持±2g~±16g加速度量程和±125°/s~±2000°/s陀螺仪量程的可编程配置
内置1024字节FIFO缓冲区，减轻主控数据读取压力
STM32F373RC的硬件CRC校验单元可确保传感器数据完整性
微控制器内置3个高速ADC(16位分辨率)可扩展其他模拟传感器

2. 硬件连接与接口配置

2.1 物理连接方案

BMI160与STM32的标准连接方式：

TEXT

BMI160 STM32F373RC

VCC → 3.3V

GND → GND

SCL → PB6(I2C1_SCL)

SDA → PB7(I2C1_SDA)

INT1 → PC8(可配置外部中断)

关键提示：BMI160的SDO引脚需接GND(I2C地址0x68)或VCC(0x69)，该配置必须与软件设置一致。若使用中断功能，建议在INT引脚添加4.7kΩ上拉电阻。

2.2 I2C接口初始化代码

void BMI160_I2C_Init(void) {

GPIO_InitTypeDef GPIO_InitStruct = {0};

I2C_HandleTypeDef hi2c1;

__HAL_RCC_GPIOB_CLK_ENABLE();

__HAL_RCC_I2C1_CLK_ENABLE();

// I2C SCL/SDA引脚配置

GPIO_InitStruct.Pin = GPIO_PIN_6|GPIO_PIN_7;

GPIO_InitStruct.Mode = GPIO_MODE_AF_OD;

GPIO_InitStruct.Pull = GPIO_PULLUP;

GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_HIGH;

GPIO_InitStruct.Alternate = GPIO_AF4_I2C1;

HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);

// I2C参数配置

hi2c1.Instance = I2C1;

hi2c1.Init.ClockSpeed = 400000; // 400kHz标准模式

hi2c1.Init.DutyCycle = I2C_DUTYCYCLE_2;

hi2c1.Init.OwnAddress1 = 0;

hi2c1.Init.AddressingMode = I2C_ADDRESSINGMODE_7BIT;

hi2c1.Init.DualAddressMode = I2C_DUALADDRESS_DISABLE;

hi2c1.Init.OwnAddress2 = 0;

hi2c1.Init.GeneralCallMode = I2C_GENERALCALL_DISABLE;

hi2c1.Init.NoStretchMode = I2C_NOSTRETCH_DISABLE;

HAL_I2C_Init(&hi2c1);

}

3. BMI160传感器配置

3.1 初始化流程

完整的传感器初始化应包含以下步骤：

软复位(写入0xB6到CMD寄存器)
等待至少1ms让传感器完成初始化
配置加速度和陀螺仪的量程、输出数据速率(ODR)
设置传感器模式为正常模式
配置中断引脚参数(如需要)

# define BMI160_ADDR 0x68 << 1 // I2C地址左移1位

uint8_t BMI160_Init(void) {

uint8_t data[2];

// 软复位

data[0] = 0x7E; // CMD寄存器地址

data[1] = 0xB6; // 软复位命令

HAL_I2C_Master_Transmit(&hi2c1, BMI160_ADDR, data, 2, 100);

HAL_Delay(50); // 等待复位完成

// 检查芯片ID(应为0xD1)

uint8_t chip_id;

data[0] = 0x00; // CHIP_ID地址

HAL_I2C_Master_Transmit(&hi2c1, BMI160_ADDR, data, 1, 100);

HAL_I2C_Master_Receive(&hi2c1, BMI160_ADDR, &chip_id, 1, 100);

if(chip_id != 0xD1) return 0;

// 配置加速度计: ±4g范围, 100Hz ODR

data[0] = 0x40; // ACCEL_CONFIG地址

data[1] = (0x05 << 4) | 0x0A; // 范围+ODR

HAL_I2C_Master_Transmit(&hi2c1, BMI160_ADDR, data, 2, 100);

// 配置陀螺仪: ±500°/s范围, 100Hz ODR

data[0] = 0x42; // GYRO_CONFIG地址

data[1] = (0x04 << 4) | 0x0A;

HAL_I2C_Master_Transmit(&hi2c1, BMI160_ADDR, data, 2, 100);

return 1; // 初始化成功

}

3.2 数据读取优化技巧

利用BMI160的FIFO功能可大幅降低主控负担：

void BMI160_EnableFIFO(void) {

uint8_t data[2];

// 配置FIFO存储加速度和陀螺仪数据

data[0] = 0x47; // FIFO_CONFIG_1地址

data[1] = 0x03; // 使能ACCEL和GYRO

HAL_I2C_Master_Transmit(&hi2c1, BMI160_ADDR, data, 2, 100);

// 设置FIFO模式

data[0] = 0x46; // FIFO_CONFIG_0地址

data[1] = 0x80; // FIFO模式使能

HAL_I2C_Master_Transmit(&hi2c1, BMI160_ADDR, data, 2, 100);

}

void BMI160_ReadFIFO(int16_t *accel, int16_t *gyro, uint8_t *count) {

uint8_t fifo_len[2];

uint8_t buffer[12]; // 每组数据12字节(2字节*6轴)

// 读取FIFO长度

fifo_len[0] = 0x24; // FIFO_LENGTH地址

HAL_I2C_Master_Transmit(&hi2c1, BMI160_ADDR, fifo_len, 1, 100);

HAL_I2C_Master_Receive(&hi2c1, BMI160_ADDR, fifo_len, 2, 100);

uint16_t length = (fifo_len[1] << 8) | fifo_len[0];

*count = length / 12; // 计算完整数据包数量

// 读取FIFO数据

uint8_t cmd = 0x26; // FIFO_DATA地址

HAL_I2C_Master_Transmit(&hi2c1, BMI160_ADDR, &cmd, 1, 100);

HAL_I2C_Master_Receive(&hi2c1, BMI160_ADDR, buffer, length, 100);

// 解析最新一组数据

for(int i=0; i<3; i++) {

accel[i] = (buffer[length-12+i*2+1] << 8) | buffer[length-12+i*2];

gyro[i] = (buffer[length-6+i*2+1] << 8) | buffer[length-6+i*2];

}

4. 运动数据处理算法

4.1 传感器数据校准

消除零偏误差的校准方法：

typedef struct {

float accel_offset[3];

float gyro_offset[3];

} CalibrationParams;

void BMI160_Calibrate(CalibrationParams *params) {

int32_t accel_sum[3] = {0}, gyro_sum[3] = {0};

int16_t raw[6];

const uint16_t samples = 500;

for(uint16_t i=0; i<samples; i++) {

BMI160_ReadRawData(raw);

for(int j=0; j<3; j++) {

accel_sum[j] += raw[j];

gyro_sum[j] += raw[j+3];

}

HAL_Delay(10);

}

for(int j=0; j<3; j++) {

params->accel_offset[j] = (float)accel_sum[j] / samples;

params->gyro_offset[j] = (float)gyro_sum[j] / samples;

}

4.2 姿态解算实现

采用互补滤波融合加速度计和陀螺仪数据：

void UpdateOrientation(float *pitch, float *roll,

const int16_t *accel, const int16_t *gyro,

const CalibrationParams *calib, float dt) {

// 加速度计姿态计算(单位:g)

float ax = (accel[0] - calib->accel_offset[0]) / 16384.0f;

float ay = (accel[1] - calib->accel_offset[1]) / 16384.0f;

float az = (accel[2] - calib->accel_offset[2]) / 16384.0f;

// 陀螺仪角速度计算(单位:°/s)

float gx = (gyro[0] - calib->gyro_offset[0]) / 131.0f;

float gy = (gyro[1] - calib->gyro_offset[1]) / 131.0f;

// 加速度计姿态角

float acc_pitch = atan2f(ay, sqrtf(ax*ax + az*az)) * 180.0f / M_PI;

float acc_roll = atan2f(-ax, sqrtf(ay*ay + az*az)) * 180.0f / M_PI;

// 互补滤波系数(0.98取陀螺仪，0.02取加速度计)

const float alpha = 0.98f;

// 更新姿态

*pitch = alpha * (*pitch + gx * dt) + (1-alpha) * acc_pitch;

*roll = alpha * (*roll + gy * dt) + (1-alpha) * acc_roll;

}

5. 性能优化技巧

5.1 实时性保障措施

中断驱动设计：

// 配置BMI160的任意运动中断

void BMI160_ConfigMotionInterrupt(void) {

uint8_t data[2];

// 设置加速度阈值(约0.5g)

data[0] = 0x11; // INT_MOTION_1地址

data[1] = 0x08; // 阈值=0x08*3.91mg=49mg

HAL_I2C_Master_Transmit(&hi2c1, BMI160_ADDR, data, 2, 100);

// 设置持续时间(约100ms)

data[0] = 0x12; // INT_MOTION_2地址

data[1] = 0x03; // 持续时间=0x03*20ms=60ms

HAL_I2C_Master_Transmit(&hi2c1, BMI160_ADDR, data, 2, 100);

// 使能任意运动中断

data[0] = 0x19; // INT_EN_1地址

data[1] = 0x10; // 使能任意运动检测

HAL_I2C_Master_Transmit(&hi2c1, BMI160_ADDR, data, 2, 100);

// 映射到INT1引脚

data[0] = 0x1A; // INT_OUT_CTRL地址

data[1] = 0x08; // INT1输出使能

HAL_I2C_Master_Transmit(&hi2c1, BMI160_ADDR, data, 2, 100);

}

DMA传输配置：

void I2C_DMA_Config(void) {

__HAL_RCC_DMA1_CLK_ENABLE();

// 配置I2C RX DMA

hdma_i2c1_rx.Instance = DMA1_Channel3;

hdma_i2c1_rx.Init.Direction = DMA_PERIPH_TO_MEMORY;

hdma_i2c1_rx.Init.PeriphInc = DMA_PINC_DISABLE;

hdma_i2c1_rx.Init.MemInc = DMA_MINC_ENABLE;

hdma_i2c1_rx.Init.PeriphDataAlignment = DMA_PDATAALIGN_BYTE;

hdma_i2c1_rx.Init.MemDataAlignment = DMA_MDATAALIGN_BYTE;

hdma_i2c1_rx.Init.Mode = DMA_NORMAL;

hdma_i2c1_rx.Init.Priority = DMA_PRIORITY_HIGH;

HAL_DMA_Init(&hdma_i2c1_rx);

__HAL_LINKDMA(&hi2c1, hdmarx, hdma_i2c1_rx);

}

5.2 低功耗优化

BMI160电源模式配置：

void BMI160_SetLowPowerMode(void) {

uint8_t data[2];

// 设置加速度计为低功耗模式(25Hz)

data[0] = 0x40; // ACCEL_CONFIG地址

data[1] = 0x25; // 低功耗模式+25Hz

HAL_I2C_Master_Transmit(&hi2c1, BMI160_ADDR, data, 2, 100);

// 设置陀螺仪为挂起模式

data[0] = 0x42; // GYRO_CONFIG地址

data[1] = 0x14; // 挂起模式

HAL_I2C_Master_Transmit(&hi2c1, BMI160_ADDR, data, 2, 100);

// 启用加速度计低功耗模式

data[0] = 0x7E; // CMD寄存器地址

data[1] = 0x12; // 加速度计低功耗模式命令

HAL_I2C_Master_Transmit(&hi2c1, BMI160_ADDR, data, 2, 100);

}

STM32时钟配置优化：

void SystemClock_Config_LowPower(void) {

RCC_OscInitTypeDef RCC_OscInitStruct = {0};

RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};

// 配置内部MSI振荡器(4MHz)

RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_MSI;

RCC_OscInitStruct.MSIState = RCC_MSI_ON;

RCC_OscInitStruct.MSICalibrationValue = RCC_MSICALIBRATION_DEFAULT;

RCC_OscInitStruct.MSIClockRange = RCC_MSIRANGE_6; // 4MHz

HAL_RCC_OscConfig(&RCC_OscInitStruct);

// 配置时钟树

RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK

|RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;

RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_MSI;

RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;

RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV1;

RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;

HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_0);

}

6. 实际应用案例

6.1 计步器实现

利用BMI160内置的计步算法：

typedef struct {

uint32_t total_steps;

uint16_t current_steps;

uint8_t cadence; // 步频(步/分钟)

} StepCounter;

void StepCounter_Update(StepCounter *counter) {

uint8_t data[3];

// 读取步数(2字节)

data[0] = 0x0B; // STEP_CNT_L地址

HAL_I2C_Master_Transmit(&hi2c1, BMI160_ADDR, data, 1, 100);

HAL_I2C_Master_Receive(&hi2c1, BMI160_ADDR, data, 2, 100);

uint16_t new_steps = (data[1] << 8) | data[0];

// 计算步频(假设每1秒调用一次)

if(new_steps > counter->current_steps) {

counter->cadence = (new_steps - counter->current_steps) * 60;

counter->total_steps += new_steps - counter->current_steps;

counter->current_steps = new_steps;

}

6.2 运动强度检测

基于加速度数据的RMS值计算：

float CalculateActivityLevel(const int16_t *accel, const CalibrationParams *calib) {

float ax = (accel[0] - calib->accel_offset[0]) / 16384.0f;

float ay = (accel[1] - calib->accel_offset[1]) / 16384.0f;

float az = (accel[2] - calib->accel_offset[2]) / 16384.0f;

// 移除重力分量(假设设备垂直放置)

az -= 1.0f;

// 计算向量幅度

float magnitude = sqrtf(ax*ax + ay*ay + az*az);

// 活动等级分类

if(magnitude < 0.05f) return 0.0f; // 静止

else if(magnitude < 0.2f) return 1.0f; // 低强度

else if(magnitude < 0.5f) return 2.0f; // 中强度

else return 3.0f; // 高强度

}

7. 调试与问题排查

7.1 常见问题解决方案

I2C通信失败：
- 检查上拉电阻(通常4.7kΩ)
- 确认I2C地址设置正确(SDO引脚电平)
- 用逻辑分析仪捕获I2C波形
数据异常跳动：
- 进行传感器校准
- 检查电源稳定性(建议添加0.1μF去耦电容)
- 验证SPI/I2C时钟速率是否过高
计步器不准确：
- 确保设备佩戴位置正确(腰部最佳)
- 调整计步算法参数(灵敏度、时间窗口)
- 启用BMI160内置的计步算法优化

7.2 调试工具推荐

STM32CubeMonitor：
- 实时图形化显示传感器数据
- 支持变量监控和修改
- 可记录数据用于离线分析
BMI160评估软件：
- Bosch提供的官方调试工具
- 可视化传感器原始数据
- 支持寄存器实时配置
自定义串口协议：

void SendSensorData(UART_HandleTypeDef *huart,

const int16_t *accel, const int16_t *gyro) {

uint8_t buffer[20];

// 帧头

buffer[0] = 0xAA;

buffer[1] = 0x55;

// 加速度数据

buffer[2] = accel[0] >> 8;

buffer[3] = accel[0] & 0xFF;

// ...其他轴数据类似

// 校验和

uint8_t checksum = 0;

for(int i=0; i<18; i++) checksum += buffer[i];

buffer[18] = checksum;

HAL_UART_Transmit(huart, buffer, 19, 100);

}