【CanMV K210】传感器实验 MPU6050 六轴数据与四元数姿态融合

在智能硬件项目中，姿态数据是一类非常常见的底层能力。无人小车判断车身是否倾斜、机器人检测运动姿态、手持设备识别方向变化、云台判断当前角度，这些场景背后都离不开加速度计和陀螺仪的数据采集。对于编程学习而言，MPU6050 实验的价值不只是读取一组数字，而是把传感器采集、I2C 通信、数据校准、单位换算和姿态解算串成一条完整的数据链路。本实验使用 CanMV K210 开发板通过 I2C 总线读取 MPU6050 六轴传感器数据。程序启动后会扫描 I2C 设备，初始化 MPU6050 寄存器，解除模块休眠，配置陀螺仪和加速度计量程，随后进行陀螺仪零偏校准。校准期间模块需要保持静止，运行后程序会持续读取加速度计和陀螺仪原始数据，并通过四元数姿态解算函数输出姿态结果。代码中还保留了一阶互补滤波函数，便于后续对比不同姿态融合方式。学习目标说明理解六轴姿态传感器认识 MPU6050 中三轴加速度计和三轴陀螺仪的作用掌握 I2C 传感器读取使用 CanMV K210 通过 I2C 总线读取 MPU6050 寄存器数据理解数据换算将加速度计和陀螺仪原始值转换成 g、角速度和姿态计算输入掌握零偏校准通过静止采样计算陀螺仪零偏，减少姿态解算漂移建立姿态融合思路使用四元数融合加速度计和陀螺仪数据，输出 Pitch、Roll 等姿态结果这个实验比单纯读取传感器数值更进一步。MPU6050 输出的是原始字节数据，程序需要完成寄存器读取、字节合成、零偏修正、单位换算和算法融合，才能得到更有工程意义的姿态结果。后续智能小车防侧翻、云台姿态反馈、手势控制、平衡车基础实验等内容，都可以在这类姿态感知能力上继续扩展。文章目录理论基础硬件设施软件代码扩展应用总结理论基础MPU6050 是常见的六轴姿态传感器，内部包含三轴加速度计和三轴陀螺仪。加速度计可以感知重力方向和运动加速度，适合用来估计设备相对于重力方向的倾斜状态；陀螺仪可以感知绕 X、Y、Z 三个轴的角速度，适合捕捉短时间内的旋转变化。单独使用加速度计容易受到运动干扰，单独使用陀螺仪又容易出现长期积分漂移，因此姿态解算通常需要把两类数据结合起来。本实验使用 I2C 总线读取 MPU6050。CanMV K210 通过 IO7 连接 MPU6050 的 SCL，通过 IO6 连接 MPU6050 的 SDA。程序先创建 I2C 对象，再访问默认地址0x68的传感器设备。初始化阶段会向 MPU6050 的寄存器写入配置，例如解除休眠、设置采样分频、配置低通滤波、设置陀螺仪量程和加速度计量程。完成初始化后，程序从0x3B起始寄存器连续读取 14 个字节，得到加速度、温度和陀螺仪原始数据。姿态解算的核心不是直接把传感器读数当作角度，而是先把原始数据转换成算法可用的物理量。代码中陀螺仪量程配置为 ±500°/s，因此使用65.5作为原始值到角速度的换算系数；加速度计量程配置为 ±4g，因此使用8192作为原始值到 g 单位的换算系数。陀螺仪角速度还需要乘以0.0174533，从角度每秒转换成弧度每秒，才能进入四元数姿态融合函数。