STM32与BNO055串口通信实战：从零搭建姿态传感器数据采集系统

在机器人、无人机和各类运动控制项目中，姿态感知是决定系统能否精准、稳定运行的核心。过去，开发者往往需要分别集成加速度计、陀螺仪和磁力计，再耗费大量精力编写复杂的传感器融合算法。如今，像博世BNO055这样的智能9轴惯性测量单元（IMU）将硬件和算法封装于一体，通过串口直接输出融合后的姿态数据，极大地简化了开发流程。然而，将这颗“黑盒”传感器与STM32这样的主流微控制器稳定、高效地连接起来，并构建一套可靠的数据采集系统，其中涉及的细节远比简单的连线发送指令要复杂。

你是否遇到过传感器上电后数据全为零的尴尬？或者在连续读取时，数据包偶尔出现错位、丢失？又或者，面对传感器手册中密密麻麻的寄存器地址，不知从何下手进行个性化配置？这篇文章正是为你准备的。我们将抛开那些泛泛而谈的理论，直接切入STM32F4系列与BNO055通过USART通信的实战环节。我会结合自己多次在四轴飞行器和机械臂项目中的踩坑经验，为你梳理出一套从硬件连接到软件驱动、从数据解析到错误处理的完整方案。无论你是嵌入式新手，还是希望优化现有方案的工程师，这里都有你需要的干货。

1. 硬件连接与通信模式选择

在动手写代码之前，正确的硬件连接是成功的基石。BNO055支持I²C和UART两种通信模式，模式的选择通过PS1和PS0两个引脚的电平决定。对于串口通信，我们需要将PS1引脚拉高（接3.3V），PS0引脚拉低（接地）。这里有一个极易忽略的细节：许多现成的BNO055模块（如Adafruit的版本）可能已经在PCB上设置了默认的I²C模式跳线。如果你发现按照手册连接后，传感器发热异常或毫无反应，很可能就是这两个模式选择引脚被板载电路固定在了I²C状态。

注意：务必检查你的BNO055模块原理图。有些模块通过一个0欧姆电阻或焊盘跳线来连接PS1到GND。启用UART模式前，你需要用烙铁断开这个连接，让PS1引脚悬空（内部有上拉电阻）或直接连接到3.3V。

连接STM32F4与BNO055的串口线序非常简单，但电平匹配是关键。BNO055的UART接口是3.3V TTL电平，与STM32F4的USART引脚完全兼容。接线如下表所示：

BNO055引脚STM32F4引脚说明
VIN3.3V电源输入，确保电压稳定
GNDGND共地
SDA (TX)USARTx_RX (如PA3)BNO055发送，STM32接收
SCL (RX)USARTx_TX (如PA2)BNO055接收，STM32发送

这里SDA和SCL在UART模式下被复用为TX和RX，不要被I²C的命名迷惑。我建议使用STM32的USART1或USART2，因为它们通常有较好的库支持和示例代码。确保在STM32的CubeMX或标准库初始化中，将对应GPIO引脚配置为复用推挽输出（TX）和浮空输入（RX）。

关于波特率，BNO055的UART模式固定支持115200 bps，数据格式为8位数据位、1位停止位、无校验位。这个配置在STM32端必须完全匹配，否则收到的将是乱码。我曾因为一个项目中将停止位误设为2位，调试了整整一个下午才找到问题。

2. STM32 USART外设的配置与驱动层封装

硬件连接无误后，我们进入软件层面。首先需要在STM32上初始化USART外设。无论你使用HAL库、LL库还是标准库，核心配置项都是一致的。下面以STM32CubeIDE的HAL库为例，展示一个可靠的初始化流程，并重点讲解几个容易出错的配置点。

// bno055_usart.h
#ifndef __BNO055_USART_H
#define __BNO055_USART_H

#include "main.h"
#include "stm32f4xx_hal.h"

// 定义使用的USART句柄，例如 huart1
extern UART_HandleTypeDef huart1;

// 接收缓冲区及相关变量
#define BNO055_REC_BUF_SIZE 64
extern uint8_t BNO055_REC_BUF[BNO055_REC_BUF_SIZE];
extern volatile uint16_t BNO055_REC_LEN;
extern volatile uint8_t  BNO055_REC_FLAG;

void BNO055_USART_Config(void);
void BNO055_USART_Send(uint8_t *pData, uint16_t Size);
void BNO055_USART_Receive_IT(void);

#endif

头文件定义了必要的变量和函数接口。接下来是具体的实现，关键在于接收逻辑的设计。BNO055的通信是主从式的，STM32发送命令后，传感器才会回复数据。因此，我们不能依赖简单的轮询接收，而应该使用中断或DMA来及时捕获传感器的响应，避免数据覆盖。

// bno055_usart.c
#include "bno055_usart.h"

uint8_t BNO055_REC_BUF[BNO055_REC_BUF_SIZE];
volatile uint16_t BNO055_REC_LEN = 0;
volatile uint8_t  BNO055_REC_FLAG = 0;

void BNO055_USART_Config(void) {
    // 此函数内容通常由CubeMX自动生成，核心是配置USART参数
    // huart1.Instance = USART1;
    // huart1.Init.BaudRate = 115200;
    // huart1.Init.WordLength = UART_WORDLENGTH_8B;
    // huart1.Init.StopBits = UART_STOPBITS_1;
    // huart1.Init.Parity = UART_PARITY_NONE;
    // huart1.Init.Mode = UART_MODE_TX_RX;
    // huart1.Init.HwFlowCtl = UART_HWCONTROL_NONE;
    // huart1.Init.OverSampling = UART_OVERSAMPLING_16;
    // if (HAL_UART_Init(&huart1) != HAL_OK) {
    //     Error_Handler();
    // }

    // 启动空闲中断接收
    __HAL_UART_ENABLE_IT(&huart1, UART_IT_IDLE);
    HAL_UART_Receive_IT(&huart1, BNO055_REC_BUF, 1); // 先启动接收一个字节
}

// 发送函数
void BNO055_USART_Send(uint8_t *pData, uint16_t Size) {
    // 发送前最好清空接收缓冲区，防止旧数据干扰
    BNO055_REC_LEN = 0;
    BNO055_REC_FLAG = 0;
    HAL_UART_Transmit(&huart1, pData, Size, 100); // 100ms超时
}

// USART全局中断服务函数（在stm32f4xx_it.c中）
void USART1_IRQHandler(void) {
    HAL_UART_IRQHandler(&huart1);
}

// HAL库的回调函数
void HAL_UART_RxCpltCallback(UART_HandleTypeDef *huart) {
    if (huart->Instance == USART1) {
        BNO055_REC_LEN++;
        // 防止缓冲区溢出
        if (BNO055_REC_LEN < BNO055_REC_BUF_SIZE) {
            // 继续接收下一个字节
            HAL_UART_Receive_IT(&huart1, &BNO055_REC_BUF[BNO055_REC_LEN], 1);
        } else {
            // 缓冲区满，可以设置标志位
            BNO055_REC_FLAG = 1;
        }
    }
}

// 空闲中断回调函数（需在HAL_UART_IRQHandler中处理IDLE标志后调用）
void HAL_UART_IdleCallback(UART_HandleTypeDef *huart) {
    if (huart->Instance == USART1) {
        // 收到空闲帧，表示一帧数据接收完毕
        BNO055_REC_FLAG = 1;
        // 停止本次DMA接收（如果使用DMA），或标记长度
        // 对于中断方式，我们通过计算已接收的字节数来确定长度
        // 注意：需要手动清除IDLE中断标志位
        __HAL_UART_CLEAR_IDLEFLAG(huart);
    }
}

这段代码实现了一个基于“空闲中断+接收中断”的接收机制。其工作流程是：每收到一个字节触发一次接收完成中断，在回调中递增接收长度并准备接收下一个字节；当总线空闲（超过一个字符时间的高电平）时，触发空闲中断，我们认为一包数据已经接收完毕，置位完成标志。这种方式比固定长度接收更灵活，能适应BNO055返回数据包长度可能变化的情况。

提示：对于追求极致效率的项目，可以考虑使用DMA配合空闲中断。将USART的RX配置为DMA循环模式，在空闲中断发生时，根据DMA的传输计数器计算出本次接收的数据长度。这能极大减轻CPU负担，尤其是在高频读取传感器数据时。

3. BNO055的寄存器配置与初始化流程

BNO055的强大之处在于其内置的传感器融合单元（Fusion Hub），但它并非上电即用。传感器内部有一个状态机，必须按照特定的顺序配置一系列寄存器，才能进入正常工作模式。很多初学者卡在这一步，发现读取任何数据寄存器都是0，根本原因就是初始化流程不对。

BNO055的寄存器分为两个页面（Page 0和Page 1）。Page 0主要存放传感器数据（如加速度、角速度）和系统状态寄存器；Page 1则用于配置传感器的工作参数，如量程、带宽、输出速率等。初始化流程的核心思想是：先复位，然后进入配置模式，接着在Page 1设置各传感器参数，最后切回Page 0并选择融合模式。

下面是一个经过验证的、可靠的初始化函数 BNO055_Init 的分步解析：

  1. 复位传感器：向 BNO055_SYS_TRIGGER_ADDR (0x3F) 寄存器写入 BNO055_SYS_RST (0x20)。这一步至关重要，它能确保传感器从一个已知的、干净的状态开始。写入后必须等待至少650ms（手册要求），让传感器完成内部自检和启动。
  2. 进入配置模式：向 BNO055_OPR_MODE_ADDR (0x3D) 寄存器写入 BNO055_OPERATION_MODE_CONFIG (0x00)。只有在配置模式下，才能修改Page 1中的传感器配置寄存器。
  3. 设置页面为1：向 BNO055_PAGE_ID_ADDR (0x07) 寄存器写入 BNO055_PAGE_1 (0x01)。
  4. 配置各传感器参数：这是性能调优的关键。你可以根据应用需求，设置加速度计的量程（例如4G）、磁力计的输出速率（例如20Hz）、陀螺仪的量程（例如2000dps）和带宽等。以下是一个配置表示例：
传感器配置寄存器地址推荐值（十六进制）含义
加速度计BNO055_ACCEL_CONFIG_ADDR (0x08)0x01量程 ±4G
磁力计BNO055_MAG_CONFIG_ADDR (0x09)0x05输出速率 20Hz，常规模式
陀螺仪BNO055_GYRO_CONFIG_ADDR (0x0A)0x00量程 ±2000 dps
陀螺仪功耗模式BNO055_GYRO_MODE_CONFIG_ADDR (0x0B)0x00正常模式
  1. 切回页面0：向 BNO055_PAGE_ID_ADDR 写入 BNO055_PAGE_0 (0x00)。
  2. 选择融合模式：向 BNO055_OPR_MODE_ADDR 写入目标模式。最常用的是 NDOF（0x0C） 模式，它融合了加速度计、陀螺仪和磁力计的数据，提供绝对方向的四元数、欧拉角等，并自动进行地磁校准和陀螺仪零漂校准。其他模式如IMU（仅用加速度计和陀螺仪）、COMPASS（仅用加速度计和磁力计）等，适用于不同场景。

在代码实现上，我们需要封装通用的读/写寄存器函数。BNO055的UART协议帧格式很简单：

  • 写命令：0xAA（帧头） + 0x00（写标识） + 寄存器地址 + 数据长度（固定为1） + 要写入的数据
  • 读命令：0xAA（帧头） + 0x01（读标识） + 起始寄存器地址 + 要读取的字节数
// 写寄存器函数示例
uint8_t BNO055_WriteReg(uint8_t reg_addr, uint8_t data) {
    uint8_t tx_buf[5] = {0xAA, 0x00, reg_addr, 0x01, data};
    BNO055_USART_Send(tx_buf, 5);
    // 等待并解析回复，回复格式为 0xEE + 0x01 + 寄存器地址
    // 需要处理超时和错误回复
    return check_response();
}

// 读寄存器函数示例（读取多个连续寄存器）
uint8_t BNO055_ReadReg(uint8_t start_addr, uint8_t length, uint8_t *rx_data) {
    uint8_t tx_buf[4] = {0xAA, 0x01, start_addr, length};
    BNO055_USART_Send(tx_buf, 4);
    // 等待回复，回复格式为 0xBB + length + data_bytes...
    // 将数据解析到rx_data数组
    return parse_response(rx_data);
}

初始化过程中，每执行一次写操作后，建议读取回复并验证。BNO055会回复 0xEE 0x01 [寄存器地址] 表示写成功，回复 0xEE 0x02 或 0xEE 0x03 等表示写失败或地址错误。加入这些检查能让你在调试时快速定位问题。

4. 数据读取、解析与传感器融合输出

初始化成功后，BNO055就开始源源不断地根据所选模式输出融合后的数据。我们的任务就是定期读取这些数据，并将其从原始的字节流转换为有物理意义的数值。

数据寄存器都位于Page 0。例如，加速度数据的X轴分量由两个8位寄存器组成：BNO055_ACCEL_DATA_X_LSB_ADDR (0x08) 和 BNO055_ACCEL_DATA_X_MSB_ADDR (0x09)。读取时，我们需要先发送读命令，指定起始地址和要读取的字节数（对于三轴加速度，需要读取6个字节：X_LSB, X_MSB, Y_LSB, Y_MSB, Z_LSB, Z_MSB）。

// 读取加速度计原始数据的函数
void BNO055_ReadAccelRaw(int16_t *accel_x, int16_t *accel_y, int16_t *accel_z) {
    uint8_t rx_data[6];
    if(BNO055_ReadReg(BNO055_ACCEL_DATA_X_LSB_ADDR, 6, rx_data) == BNO055_OK) {
        // 数据格式为小端序：LSB在前，MSB在后
        *accel_x = (int16_t)((rx_data[1] << 8) | rx_data[0]);
        *accel_y = (int16_t)((rx_data[3] << 8) | rx_data[2]);
        *accel_z = (int16_t)((rx_data[5] << 8) | rx_data[4]);
    }
}

得到原始数据（通常是16位有符号整数）后，需要根据之前设置的量程将其转换为物理值。例如，如果加速度计量程设置为±4G，那么对应的分辨率是 1 LSB = 1/1000 g。转换公式为：加速度 (m/s²) = (原始值 / 1000.0) * 9.80665。

对于融合数据（如四元数、欧拉角），读取方式类似，但解析更简单，因为BNO055已经完成了所有计算。以四元数为例，它由w, x, y, z四个分量组成，每个分量占用两个字节（共8字节），存储格式为Q14格式（即实际值 = 原始值 / 16384.0）。

// 读取四元数并转换为浮点数
void BNO055_ReadQuaternion(float *q) {
    uint8_t rx_data[8];
    if(BNO055_ReadReg(BNO055_QUATERNION_DATA_W_LSB_ADDR, 8, rx_data) == BNO055_OK) {
        int16_t w_raw = (int16_t)((rx_data[1] << 8) | rx_data[0]);
        int16_t x_raw = (int16_t)((rx_data[3] << 8) | rx_data[2]);
        int16_t y_raw = (int16_t)((rx_data[5] << 8) | rx_data[4]);
        int16_t z_raw = (int16_t)((rx_data[7] << 8) | rx_data[6]);

        q[0] = w_raw / 16384.0f; // w
        q[1] = x_raw / 16384.0f; // x
        q[2] = y_raw / 16384.0f; // y
        q[3] = z_raw / 16384.0f; // z
    }
}

校准状态是另一个必须关注的信息。BNO055内部有完善的校准算法，但其效果取决于传感器是否完成了校准过程。你可以通过读取 BNO055_CALIB_STAT_ADDR (0x35) 寄存器来获取系统（sys）、陀螺仪（gyro）、加速度计（accel）和磁力计（mag）的校准状态。每个状态值范围是0（未校准）到3（完全校准）。在NDOF模式下，只有当系统校准状态为3时，输出的方向数据才是完全可靠的。一个常见的做法是在系统启动后，提示用户以“8字形”缓慢移动设备，直到磁力计和加速度计校准完成。

5. 多传感器数据同步与实时性优化

在机器人或无人机系统中，姿态数据往往需要与其他传感器（如GPS、光流、气压计）的数据进行融合。这就对BNO055数据读取的同步性和实时性提出了更高要求。简单的延时轮询 delay_ms(100) 会严重拖慢系统节奏，并引入不确定的延迟。

策略一：定时器触发读取。利用STM32的硬件定时器产生一个固定频率的中断（例如100Hz），在中断服务程序中启动一次BNO055数据读取。这能保证采样间隔的精确性。注意，中断服务程序里只应设置标志位或启动DMA传输，繁重的数据解析应放在主循环中。

// 在定时器中断中触发读取
void TIM3_IRQHandler(void) {
    if(__HAL_TIM_GET_FLAG(&htim3, TIM_FLAG_UPDATE) != RESET) {
        __HAL_TIM_CLEAR_IT(&htim3, TIM_IT_UPDATE);
        bno055_read_requested = 1; // 设置全局标志
    }
}

// 在主循环中处理
while(1) {
    if(bno055_read_requested) {
        bno055_read_requested = 0;
        // 读取所有需要的数据（加速度、角速度、四元数）
        BNO055_ReadAllData(&imu_data);
        // 获取当前系统时间戳（微秒级）
        imu_data.timestamp = get_micros();
        // 将带时间戳的数据放入队列，供其他任务消费
        queue_push(&imu_data_queue, &imu_data);
    }
    // ... 其他任务
}

策略二：使用DMA进行连续读取（针对特定模式）。虽然BNO055的UART模式没有真正的连续输出，但我们可以通过快速、连续地发送读命令来模拟。此时，将USART的TX和RX都配置为DMA模式可以极大提升效率。你需要仔细设计通信协议，确保请求和响应不会错乱。一个稳妥的方法是使用“乒乓缓冲区”：准备两个DMA接收缓冲区，当一个缓冲区正在接收时，另一个缓冲区的数据可以被安全地解析。

数据同步的关键在于时间戳。在读取到传感器数据包的瞬间，应立即通过STM32的高精度定时器（如TIM2或TIM5）获取一个时间戳，并附着在该数据包上。这样，后续的融合算法（如扩展卡尔曼滤波）就能知道每个数据点对应的精确时刻，从而进行时间对齐。

6. 常见通信故障排查与调试技巧

即使按照指南操作，在实际硬件调试中仍可能遇到各种问题。下面我总结了一份常见故障排查清单，希望能帮你快速定位问题。

  • 问题一：上电后读取任何数据都是0。

    • 检查初始化流程：确认是否严格按照“复位 -> 配置模式 -> 设置参数 -> 切换融合模式”的顺序执行。最容易遗漏的是复位后的650ms延时。
    • 检查模式引脚：用万用表测量PS1和PS0引脚电压，确认是否为高电平和低电平。
    • 检查电源：确保BNO055的VIN引脚电压稳定在3.3V。电压不足或纹波过大可能导致传感器工作异常。

  • 问题二：能读到数据，但数值明显不对（例如静止时加速度不为1g）。

    • 检查量程和单位：确认读取的原始值是否正确，以及转换公式中使用的量程是否与初始化配置一致。
    • 检查校准状态：读取 CALIB_STAT 寄存器。如果磁力计或加速度计未校准，方向数据会漂移。进行校准动作。
    • 检查传感器放置：确保传感器水平放置，且周围没有强磁场干扰（如电机、扬声器）。

  • 问题三：通信时好时坏，偶尔收不到回复或数据错位。

    • 检查波特率：用示波器测量USART的TX和RX波形，确认实际的波特率是否为115200，起始位、停止位是否正确。
    • 检查缓冲区溢出：如果接收数据过快，而解析速度太慢，可能导致缓冲区被新数据覆盖。增大接收缓冲区或提高数据处理优先级。
    • 检查中断冲突：确保USART中断的优先级设置合理，不会被其他长时间的中断阻塞。
    • 添加超时和重试机制：在发送命令后，等待回复应设置一个合理的超时时间（如50ms）。如果超时，则清空接收缓冲区并重发命令。

  • 问题四：使用DMA时数据混乱。

    • 检查DMA配置：确认DMA的内存和外设地址、数据宽度、传输模式（循环/单次）是否正确。
    • 处理空闲中断：在DMA循环模式下，必须结合空闲中断来判断一帧数据的结束。确保空闲中断被正确使能和响应。
    • 同步问题：DMA接收是连续的，而发送是间断的。需要在发送读命令前，确保DMA接收缓冲区处于就绪状态，并记录下接收起始位置。

实用的调试技巧：

  1. 打印原始字节：在初始调试阶段，不要急于解析数据。先将接收到的每一个字节以十六进制形式打印出来，与BNO055手册中的协议格式对比。这能帮你确认通信链路是否基本通畅。
  2. 利用状态寄存器：BNO055提供了 SYS_STAT (0x39) 和 SYS_ERR (0x3A) 寄存器。定期读取它们可以获取传感器的内部状态和错误代码，这是诊断深层问题的有力工具。
  3. 分步测试：不要试图一次性完成所有功能。先测试最基本的寄存器读写（例如读取 CHIP_ID (0x00)，应该返回 0xA0），再测试单个传感器数据读取，最后测试融合模式。

最后，我想分享一个在四轴项目中遇到的真实案例。当时飞控板在电机启动后，BNO055的数据会出现剧烈跳变。最初怀疑是电源噪声，但在电源上加了大电容后问题依旧。后来用逻辑分析仪抓取UART波形，发现每当电机PWM变化时，RX线上会出现明显的毛刺。最终发现是电机驱动线与传感器信号线平行走线且距离过近，导致了严重的电磁干扰。重新布线后问题彻底解决。这个故事告诉我们，当软件逻辑排查无误后，不要忘记硬件和物理环境也可能是问题的根源。

Logo
乐奇 Rokid 开放社区

更多推荐

cover

AR 技术科普：光波导是什么，为什么警务要用它

avatar 乐奇 Rokid 开放社区
cover

LVGL嵌入式UI开发教程：AIUI Studio可视化编辑器实操指南

avatar 乐奇 Rokid 开放社区
cover

影目Air3被召回，智能眼镜迎来散热大考

avatar 乐奇 Rokid 开放社区