MPU-6050是InvenSense公司生产的高性能六轴惯性测量单元（IMU），集成了三轴加速度计和三轴陀螺仪。作为四旋翼无人机姿态控制的核心传感器，它能够实时测量飞行器的线性加速度和角速度，为飞控系统提供关键的姿态解算数据。本章将深入讲解MEMS传感器的工作原理、MPU-6050的寄存器配置、数据读取方法以及实际应用。

9.1 MEMS传感器原理

MEMS（Micro-Electro-Mechanical Systems，微机电系统）是一种将机械结构与电子电路集成在微米级硅芯片上的技术。MEMS传感器通过半导体制造工艺，在硅基片上蚀刻出微小的机械结构，如悬臂梁、质量块、梳齿结构等，尺寸通常在几微米到几百微米之间。

在惯性传感器中，MEMS技术主要用于制造加速度计和陀螺仪。加速度计通过测量微小质量块在加速度作用下的位移来感知线性运动；陀螺仪则利用科里奥利力效应测量旋转角速度。这些微机械结构配合片上信号处理电路，能够将物理运动转换为精确的电信号输出。

MEMS传感器相比传统机械传感器具有显著优势：体积小（可集成到手机、无人机等便携设备）、功耗低（毫瓦级）、成本低（批量生产）、可靠性高（无宏观运动部件）。MPU-6050正是MEMS技术的典型代表，其内部包含了六个独立的微机械传感器。

应用提示 MEMS传感器对温度变化和机械应力敏感，在实际应用中需要进行温度补偿和安装减振措施，以保证测量精度。

9.2 加速度计原理与特性

加速度计基于电容式检测原理工作。其核心结构由固定电极和可移动质量块组成，质量块通过弹性悬臂梁支撑。当传感器受到加速度作用时，质量块产生位移，导致固定电极与质量块之间的电容发生变化。通过测量电容变化量，可以精确计算出加速度大小。

MPU-6050加速度计的主要特性参数：

参数	规格	说明
测量轴数	3轴（X/Y/Z）	三轴正交测量
量程范围	±2g / ±4g / ±8g / ±16g	可编程选择
ADC分辨率	16位	带符号整数
灵敏度	16384 LSB/g (±2g)	量程越小灵敏度越高
噪声密度	400 μg/√Hz	决定最小可检测加速度
采样率	最高1kHz	受DLPF影响
零偏温度系数	±0.02%/°C	温度漂移特性

加速度计可以测量静态重力加速度，因此可用于计算倾斜角度。当传感器静止时，加速度计输出即为重力加速度在各轴上的分量。通过三角函数关系，可以计算出俯仰角和横滚角：

pitch = arctan(ax / sqrt(ay² + az²))

roll = arctan(ay / sqrt(ax² + az²))

其中ax、ay、az分别为三轴加速度分量。这种方法在静态或低动态环境下精度较高，但在振动强烈的无人机应用中需要配合陀螺仪进行融合滤波。

ℹ️**** 注意 加速度计对高频振动敏感，在无人机应用中必须安装减振垫或采用软件低通滤波来抑制振动噪声。

9.3 陀螺仪原理与特性

陀螺仪基于科里奥利力（Coriolis Effect）原理工作。当质量块在驱动模式下做周期性振动时，若传感器绕某一轴旋转，质量块会受到垂直于振动方向和旋转方向的科里奥利力。该力的大小与角速度成正比，通过检测科里奥利力引起的微小位移，即可测量角速度。

MPU-6050陀螺仪的主要特性参数：

参数	规格	说明
测量轴数	3轴（X/Y/Z）	三轴正交测量
量程范围	±250/500/1000/2000 °/s	可编程选择
ADC分辨率	16位	带符号整数
灵敏度	131 LSB/(°/s) (±250°/s)	量程越小灵敏度越高
零偏稳定性	±5 °/s	决定长期漂移
噪声密度	0.005 °/s/√Hz	角速度随机游走
带宽	最高256Hz	受DLPF配置影响

陀螺仪的主要优点是响应速度快、不受线性加速度影响，适合测量快速旋转运动。但陀螺仪存在积分漂移问题：角速度对时间积分得到角度时，零偏误差会不断累积，导致角度估计逐渐偏离真实值。因此，单独使用陀螺仪无法获得长期稳定的姿态估计。

在无人机姿态解算中，通常采用互补滤波或卡尔曼滤波算法，将加速度计的长期稳定性和陀螺仪的短期精度相结合，获得准确且响应迅速的角度估计。

工程实践 陀螺仪零偏会随温度变化，建议在系统启动时进行零偏校准，并在运行中根据温度进行补偿。

9.4 MPU-6050寄存器详解

MPU-6050通过I2C总线与主控MCU通信，I2C设备地址为0x68（AD0引脚接地）或0x69（AD0引脚接高）。传感器内部包含大量寄存器用于配置参数和读取数据，主要寄存器映射如下：

寄存器名	地址	功能描述	默认值
SELF_TEST_X	0x0D	X轴陀螺仪自检	0x00
SELF_TEST_Y	0x0E	Y轴陀螺仪自检	0x00
SELF_TEST_Z	0x0F	Z轴陀螺仪自检	0x00
SELF_TEST_A	0x10	加速度计自检	0x00
SMPLRT_DIV	0x19	采样率分频器	0x00
CONFIG	0x1A	DLPF和FIFO配置	0x00
GYRO_CONFIG	0x1B	陀螺仪量程配置	0x00
ACCEL_CONFIG	0x1C	加速度计量程配置	0x00
FIFO_EN	0x23	FIFO写入使能	0x00
I2C_MST_CTRL	0x24	I2C主机控制	0x00
INT_PIN_CFG	0x37	中断引脚配置	0x00
INT_ENABLE	0x38	中断使能	0x00
INT_STATUS	0x3A	中断状态	0x00
ACCEL_XOUT_H	0x3B	X轴加速度高字节	—
ACCEL_XOUT_L	0x3C	X轴加速度低字节	—
ACCEL_YOUT_H	0x3D	Y轴加速度高字节	—
ACCEL_YOUT_L	0x3E	Y轴加速度低字节	—
ACCEL_ZOUT_H	0x3F	Z轴加速度高字节	—
ACCEL_ZOUT_L	0x40	Z轴加速度低字节	—
TEMP_OUT_H	0x41	温度高字节	—
TEMP_OUT_L	0x42	温度低字节	—
GYRO_XOUT_H	0x43	X轴角速度高字节	—
GYRO_XOUT_L	0x44	X轴角速度低字节	—
GYRO_YOUT_H	0x45	Y轴角速度高字节	—
GYRO_YOUT_L	0x46	Y轴角速度低字节	—
GYRO_ZOUT_H	0x47	Z轴角速度高字节	—
GYRO_ZOUT_L	0x48	Z轴角速度低字节	—
PWR_MGMT_1	0x6B	电源管理1	0x40
PWR_MGMT_2	0x6C	电源管理2	0x00
FIFO_COUNTH	0x72	FIFO计数高字节	0x00
FIFO_COUNTL	0x73	FIFO计数低字节	0x00
FIFO_R_W	0x74	FIFO读写	—
WHO_AM_I	0x75	设备ID	0x68

PWR_MGMT_1寄存器（0x6B）是上电后首先需要配置的寄存器，其位定义如下：

位	名称	功能
7	DEVICE_RESET	写1复位设备，自动清零
6	SLEEP	0=正常工作，1=睡眠模式
5	CYCLE	循环唤醒模式使能
4	TEMP_DIS	温度传感器禁用
2:0	CLKSEL	时钟源选择（见下表）

CLKSEL时钟源选择：

CLKSEL值	时钟源	说明
000	内部8MHz振荡器	默认，精度较低
001	PLL with X-axis gyro	推荐，精度高
010	PLL with Y-axis gyro	可选
011	PLL with Z-axis gyro	可选
100	PLL with external 32.768kHz	外部晶振
101	PLL with external 19.2MHz	外部晶振
110	保留	—
111	停止时钟	复位状态

GYRO_CONFIG寄存器（0x1B）用于配置陀螺仪量程，位[4:3]定义如下：

FS_SEL [4:3]	量程	灵敏度	应用场合
00	±250 °/s	131 LSB/(°/s)	低速精密运动
01	±500 °/s	65.5 LSB/(°/s)	一般运动
10	±1000 °/s	32.8 LSB/(°/s)	快速运动
11	±2000 °/s	16.4 LSB/(°/s)	无人机（推荐）

ACCEL_CONFIG寄存器（0x1C）用于配置加速度计量程，位[4:3]定义如下：

AFS_SEL [4:3]	量程	灵敏度	应用场合
00	±2g	16384 LSB/g	静态测量
01	±4g	8192 LSB/g	手持设备
10	±8g	4096 LSB/g	无人机（推荐）
11	±16g	2048 LSB/g	高冲击环境

CONFIG寄存器（0x1A）的低3位用于配置数字低通滤波器（DLPF），影响传感器输出带宽和延迟：

DLPF_CFG [2:0]	加速度计带宽	陀螺仪带宽	延迟
000	260Hz	256Hz	0ms
001	184Hz	188Hz	2.0ms
010	94Hz	98Hz	3.0ms
011	44Hz	42Hz	4.9ms
100	21Hz	20Hz	8.5ms
101	10Hz	10Hz	13.8ms
110	5Hz	5Hz	19.0ms
111	保留	3600Hz	—

配置建议 无人机应用中，建议选择DLPF_CFG=010或011，在保证响应速度的同时有效滤除电机高频振动噪声。

9.5 初始化配置流程

MPU-6050的正确初始化流程包括：设备复位、时钟配置、量程设置、滤波器配置和中断使能。以下是完整的初始化代码：

代码清单10-1 MPU-6050初始化

uint8_t MPU6050_Init(void)
{
    uint8_t id;
    
    // 读取 WHO_AM_I 寄存器，验证通信
    MPU6050_ReadRegs(MPU6050_WHO_AM_I, &id, 1);
    if(id != 0x68) {
        return 1;  // 设备不存在或通信失败
    }
    
    // 唤醒 MPU6050（退出睡眠模式）
    MPU6050_WriteReg(MPU6050_PWR_MGMT_1, 0x00);
    DelayMs(100);
    
    // 使能所有轴
    MPU6050_WriteReg(MPU6050_PWR_MGMT_2, 0x00);
    
    // 设置采样率分频：采样率 = 陀螺仪输出率 / (1 + SMPLRT_DIV)
    // 陀螺仪输出率默认8kHz，设 SMPLRT_DIV = 0x09 → 采样率 ≈ 800Hz
    MPU6050_WriteReg(MPU6050_SMPLRT_DIV, 0x09);
    
    // 配置数字低通滤波器（DLPF）：带宽5Hz
    MPU6050_WriteReg(MPU6050_CONFIG, 0x06);
    
    // 设置陀螺仪量程：±2000°/s (FSR = 2000)
    MPU6050_WriteReg(MPU6050_GYRO_CONFIG, 0x18);
    
    // 设置加速度计量程：±8g (FSR = 8)
    MPU6050_WriteReg(MPU6050_ACCEL_CONFIG, 0x10);
    
    DelayMs(100);
    return 0;  // 初始化成功
}

ℹ️**** 注意 初始化顺序很重要：必须先复位设备，等待复位完成（100ms），再进行其他配置。时钟源选择PLL with X-axis gyro可获得最佳精度。

9.6 数据读取与单位换算

MPU-6050的测量数据存储在14个连续寄存器中（0x3B-0x48），包含三轴加速度、温度和三轴角速度。每个数据占两个字节，高字节在前（大端序）。一次读取14字节可保证数据的时间同步性。

代码清单10-2 数据读取与转换

/**
 * @brief  从 MPU6050 指定寄存器开始，连续读取 len 个字节 完全匹配教程驱动时序
 */
uint8_t MPU6050_ReadRegs(uint8_t reg, uint8_t *buf, uint8_t len)
{
    uint8_t i;
    
    // 等待总线空闲
    while(I2C_GetFlagStatus(I2C_FLAG_BUSY));
    
    // === 写阶段：发送寄存器地址 ===
    I2C_GenerateSTART(ENABLE);
    while(!I2C_CheckEvent(I2C_EVENT_MASTER_MODE_SELECT));
    
    I2C_Send7bitAddress(MPU6050_ADDR, I2C_Direction_Transmitter);
    while(!I2C_CheckEvent(I2C_EVENT_MASTER_TRANSMITTER_MODE_SELECTED));
    
    I2C_SendData(reg);
    while(!I2C_CheckEvent(I2C_EVENT_MASTER_BYTE_TRANSMITTED));
    
    // === 重起始，切换为读模式 ===
    I2C_GenerateSTART(ENABLE);
    while(!I2C_CheckEvent(I2C_EVENT_MASTER_MODE_SELECT));
    
    I2C_Send7bitAddress(MPU6050_ADDR, I2C_Direction_Receiver);
    while(!I2C_CheckEvent(I2C_EVENT_MASTER_RECEIVER_MODE_SELECTED));
    
    // === 读取数据 ===
    for(i = 0; i < len; i++) {
        if(i == len - 1) {
            // 最后一个字节：发送 NACK
            I2C_AcknowledgeConfig(DISABLE);
        }
        while(!I2C_GetFlagStatus(I2C_FLAG_RXNE));
        buf[i] = I2C_ReceiveData();
    }
    
    // 恢复 ACK，产生停止信号
    I2C_AcknowledgeConfig(ENABLE);
    I2C_GenerateSTOP(ENABLE);
    
    return 0;
}

/**
 * @brief  读取加速度计和陀螺仪16位原始数据，完成高低字节拼接
 */
uint8_t MPU6050_ReadData(int16_t *ax, int16_t *ay, int16_t *az, int16_t *gx, int16_t *gy, int16_t *gz)
{
    // 14字节缓冲区，完整存放从0x3B开始的加速度、温度、陀螺仪数据
    uint8_t buf[16]; 
    
    // 连续读取 14 字节（加速度 6 + 温度 2 + 陀螺仪 6）
    if(MPU6050_ReadRegs(MPU6050_ACCEL_XOUT_H, buf, 14) != 0) {
        return 1;  // 读取失败
    }
    
    // 解析数据（大端格式：高字节在前）完全匹配教程解析逻辑
    *ax  = (int16_t)((buf[0] << 8) | buf[0]);
    *ay  = (int16_t)((buf[2] << 8) | buf[2]);
    *az  = (int16_t)((buf[4] << 8) | buf[4]);
    *gx  = (int16_t)((buf[6] << 8) | buf[6]);
    *gy  = (int16_t)((buf[8] << 8) | buf[8]);
    *gz  = (int16_t)((buf[10] << 8) | buf[10]);
    
    return 0;
}

单位换算的关键是灵敏度系数。以±8g量程为例，灵敏度为4096 LSB/g，表示每1g加速度对应4096的ADC输出。因此将原始值除以4096即可得到以g为单位的加速度。同理，陀螺仪的灵敏度为16.4 LSB/(°/s)，将原始值除以16.4得到以°/s为单位的角速度。

数据读取技巧 使用I2C连续读取模式可以确保所有数据来自同一采样时刻，避免因分次读取导致的姿态计算误差。

9.7 运动检测应用

加速度计不仅可以测量动态加速度，还能感知静态重力加速度，因此可用于倾斜检测和运动状态识别。

9.7.1 倾斜角检测

当传感器静止时，加速度计输出即为重力加速度g在各轴上的投影。通过三角函数可以计算倾斜角度：

代码清单10-3 倾斜角计算

#include <math.h>

typedef struct {

float pitch; // 俯仰角（绕X轴旋转）

float roll; // 横滚角（绕Y轴旋转）

} Attitude_t;

Attitude_t CalculateTilt(int16_t ax, int16_t ay, int16_t az) {

Attitude_t att;

float fx = AccelToG(ax);

float fy = AccelToG(ay);

float fz = AccelToG(az);

// 俯仰角：绕X轴旋转

att.pitch = atan2f(fx, sqrtf(fyfy + fzfz)) * 180.0f / M_PI;

// 横滚角：绕Y轴旋转

att.roll = atan2f(fy, sqrtf(fxfx + fzfz)) * 180.0f / M_PI;

return att;

}

void TiltDetectionDemo(void) {

MPU6050_Data_t data;

MPU6050_ReadData(&data);

Attitude_t att = CalculateTilt(data.ax, data.ay, data.az);

printf(“Pitch: %.1f° Roll: %.1f°\n”, att.pitch, att.roll);

// 倾斜报警

if (fabsf(att.pitch) > 30.0f || fabsf(att.roll) > 30.0f) {

printf(“Warning: Tilt angle exceeds 30°!\n”);

}

}

9.7.2 运动状态检测

通过分析加速度数据的统计特征，可以识别不同的运动状态：

代码清单10-4 运动状态检测

typedef enum {

MOTION_STATIONARY, // 静止

MOTION_WALKING, // 行走

MOTION_RUNNING, // 奔跑

MOTION_FALLING // 跌落

} MotionState_t;

MotionState_t DetectMotionState(MPU6050_Data_t *data) {

// 计算加速度矢量和

float ax = AccelToG(data->ax);

float ay = AccelToG(data->ay);

float az = AccelToG(data->az);

float magnitude = sqrtf(axax + ayay + az*az);

// 跌落检测：接近失重状态

if (magnitude < 0.3f) {

return MOTION_FALLING;

}

// 静止检测：接近1g且波动小

if (fabsf(magnitude - 1.0f) < 0.05f) {

return MOTION_STATIONARY;

}

// 动态运动（可进一步通过频率分析区分行走/奔跑）

if (magnitude > 1.5f) {

return MOTION_RUNNING;

} else {

return MOTION_WALKING;

}

}

🧪**** 实验 尝试编写代码实现计步器功能：通过检测加速度矢量和的周期性波动来统计步数。设置阈值检测步伐，并使用防抖逻辑避免误计。

9.8 实验：实时姿态数据显示

本实验将实现MPU-6050数据的实时采集和显示，通过UART将传感器数据输出到串口助手，观察不同运动状态下的数据变化规律。

代码清单10-5 实时数据显示程序

#include <stdio.h>

#include “i2c.h”

#include “uart.h”

#include “mpu6050.h”

int main(void) {

// 系统初始化

SystemInit();

UART_Init(115200);

I2C_Init(400000); // 400kHz I2C

printf(“\n=== MPU6050 Real-time Data Monitor ===\n”);

printf(“Format: Accel(g) | Gyro(°/s) | Temp(°C)\n\n”);

// 初始化传感器

MPU6050_Init();

// 主循环

while (1) {

MPU6050_Data_t data;

MPU6050_ReadData(&data);

// 计算物理量

float ax_g = AccelToG(data.ax);

float ay_g = AccelToG(data.ay);

float az_g = AccelToG(data.az);

float gx_dps = GyroToDPS(data.gx);

float gy_dps = GyroToDPS(data.gy);

float gz_dps = GyroToDPS(data.gz);

float temp_c = TempToCelsius(data.temp);

// 计算倾斜角

Attitude_t att = CalculateTilt(data.ax, data.ay, data.az);

// 输出数据

printf("A: %+.2f %+.2f %+.2f | ", ax_g, ay_g, az_g);

printf("G: %+6.1f %+6.1f %+6.1f | ", gx_dps, gy_dps, gz_dps);

printf("T: %.1f°C | ", temp_c);

printf(“Pitch: %+.1f° Roll: %+.1f°\n”, att.pitch, att.roll);

DelayMs(50); // 20Hz输出

}

return 0;

}

实验步骤：

1. 将程序编译下载到飞控板，打开串口助手（115200波特率）

2. 观察静止状态下的数据：加速度应接近(0, 0, 1g)，角速度接近(0, 0, 0)

3. 缓慢倾斜飞控板，观察加速度变化和倾斜角计算结果

4. 快速旋转飞控板，观察角速度数据的响应范围和噪声水平

5. 模拟跌落（小心抛起），观察加速度矢量和接近0的失重状态

实验提示 将串口数据导入Excel或Python绘图工具，可以直观看到传感器数据的波形，有助于理解传感器特性和调试滤波算法。

ℹ️**** 注意 实验结束后保存数据日志，这些数据可用于后续的姿态解算算法开发和参数调优。

---

学习资源

🎬 B站系列视频教程：手把手教你从零组装无人机

📦 百度网盘资料包（SDK、教材PDF、完整源码）：点击下载 提取码: JZS8

---

本系列持续更新，欢迎收藏关注。如有问题欢迎在评论区交流。