网页
综合
更新时间 2026-11-17 10:54:59
MPU6050:从原始加速度到姿态变化 - Zw-awa - 博客园
自动蜘蛛
www.cnblogs.com
正文约 4051 字
Q: MPU6050 是什么? A: 一颗把三轴加速度和三轴角速度测出来、通过 I2C 交给单片机的六轴惯性传感器。
Q: 为什么要读它的原始数据? A: 角度是算出来的,寄存器里的数才是证据。安装方向、量程、零偏里任何一处变了,屏幕上那个角度都会跟着变;手里没有原始数据,就分不清是哪一处变了。
Q: 常见使用场景? A: 车头朝向、倾角检测、云台稳定、碰撞与跌倒检测、运动记录。
八针的 MPU6050 模块平放在桌上,接四根线,烧进一段程序。串口那边第一眼看到的是一串整数,头六个是原始值:az 是个两千上下的正数,ax 和 ay 在几十到几百之间来回晃。
把模块一侧垫高,ax 开始顺着一个方向长,az 跟着变小。手指敲一下桌面,六个数字同时跳出一个尖峰。
这些就是原始数据,是十六位有符号整数,不是角度,也不是“每秒多少度”。从这堆整数走到屏幕上能读的倾角,中间要做四件事:把芯片叫醒、把量程说清楚、把十四个字节一次搬回来、再决定每一个数字除以多少。
模块排针上的八个名字是 VCC、GND、SCL、SDA、XDA、XCL、AD0、INT。第一次看见很容易觉得每一根都要接上,其实先接四根就够:
PB8、PB9 正是 OLED 用的那两根。这不是冲突,是 I2C 本来的用法:一条总线上可以挂很多设备,每个设备认自己的地址——OLED 认 0x3C,MPU6050 认 0x68,谁也不理别人。两根线怎么被拉高、模块上的上拉电阻并联之后上升沿更快而灌入电流更大,讲两根线那一回已经说过;手上这块模块写的是多少,以它的说明为准。
供电也按模块说话。芯片本体的工作电压是 2.375V 到 3.46V(产品规格书里的电气参数),所以带稳压的模块可以接 5V,不带稳压的只能给 3.3V。
讲两根线那一回已经把软件 I2C 的时序写全了,这里接着用同一份:SoftI2C_Init() 把 PB8、PB9 配成开漏输出并置空闲,SoftI2C_Start() 和 SoftI2C_Stop() 产生起始和停止条件,SoftI2C_SendByte() 发 8 位并在第 9 拍收回执,SoftI2C_ReadByte() 读 8 位、参数传 1 就回一个应答。它们和芯片没有关系,只和线上那几拍有关系——接第三块、第四块设备时,这几行一个字都不用改。
MPU6050 不认命令,它认寄存器。给它一个字节的寄存器地址,它就按那个寄存器的规矩收或者给数据。既然总线上一堆设备各认各的地址,第一件事就是确认“我喊的这个地址上,坐着的确实是 MPU6050”。
WHO_AM_I(地址 0x75)就是干这个的,它的复位值固定是 0x68(器件手册的寄存器表里写着)。
读一个寄存器是两段传输拼起来的:先按写的方式告诉它要读哪个寄存器,再用一次重复起始换成读的方向,把数据收回来。收最后一个字节的时候要回一个 NACK,这是告诉对方“我够了,放开数据线”,否则它会继续送下一个寄存器 —— 讲两根线那一回第 9 拍那条规矩,在这里第一次真正用上。
地址 0xD0 是 0x68 左移一位、末位留 0;要读的时候把末位置 1,就成了 0xD1。这一点写错,现象和错地址一模一样:没有回执。
PWR_MGMT_1(0x6B)管供电模式和时钟源,上电复位值是 0x40,也就是 SLEEP 那一位是 1——芯片出厂状态是睡着的。不管这一位,后面所有寄存器都会读到不动的一堆数,或者干脆没有回执。
把它写成 0x00 也能唤醒:低三位是时钟源选择,0 表示用芯片内部那个 8MHz 振荡器。但手册在这一段里写得很直接:上电默认用内部振荡器,强烈建议改用某个陀螺仪轴(或者外部时钟)作为时钟基准,稳定性更好。所以这里写 0x01,也就是“唤醒,并且拿 X 轴陀螺仪做时钟基准”。
Delay_ms() 是前面用过很多次的毫秒延时函数,这里用来等时钟稳定。这个等待有依据:把时钟基准换成 PLL 之后,它需要一点时间才锁得住,手册的电气参数里写着,时钟源选 1、2、3(也就是选陀螺仪的某个轴)时,PLL 的稳定时间是 1 到 10 毫秒。留 50 毫秒是把这个上限放宽了几倍,让上电、时钟切换这些都落定之后再开始读写。开机那一下不等,第一批读数的可信度就只能靠运气。
SMPLRT_DIV 那一行要算一遍。芯片内部的陀螺仪采样快得多,这个寄存器是给它做分频的:采样率 = 陀螺仪输出速率 ÷ (1 + 分频值),而陀螺仪输出速率在低通滤波器打开时是 1kHz、关掉时是 8kHz。这里低通开着(CONFIG 写了 0x03),所以 1000 ÷ 10 正好 100Hz —— 和后面每 10 毫秒读一次刚好对上:读得太快会把同一个采样点读两遍,读得太慢,中间那段运动就直接丢了。
GYRO_CONFIG 和 ACCEL_CONFIG 里各有两位选量程。写 0x18 就是二进制 0001 1000,两位都落在 11 上,也就是两边的最大档:
这张表里的数字全部来自器件手册,它们也是后面所有换算式里唯一每次都要翻看的东西。
量程不是精度,是“能测多大”。 选小档,同样的物理量占用的数字更大、看着更细;但一旦超过量程,读数就被切在最大值上不动了——你想看的那段运动正好在切口外面。小车这边的情况是:电机一转,车架跟着抖;轮子卡住、车头撞上桌腿的那一下,几个 g 的冲击很常见。所以这里取最大档。
代价要认下来:±16g 这一档下,平放时的重力读数只有 2048 左右。这不是传感器坏了,也不是校准没做,而是“1g 在这把尺子上只有这么长”。换到 ±2g 那一档,同一个姿势会读到一万六千多;两个数字讲的是同一件事,除以的常数不一样。
数据从 0x3B 开始,连续排着七组、每组两个字节,每组都是高字节在前:
十四这个数字不能改,温度也不能跳过去。 它夹在中间,跳过它,后面的陀螺仪三组字节就全部对错位。
读法上有个细节,手册专门用一段讲过:这七个测量寄存器其实是两套——芯片内部有一套一直在按采样率更新,外面能读到的是另一套;只有当总线空闲下来的时候,外面这一套才从里面同步一次。这条设计的意思是:一次连读的十四个字节,必定来自同一个采样时刻,高低字节不会一个来自这一拍、一个来自下一拍。
一次连读也就这么写出来了:起始、说寄存器地址、重复起始、换方向,然后连着收十四个字节,最后一个回 NACK。
两个字节拼成一个数:高字节先左移八位,再和低字节“或”到一起,最后当成有符号的十六位整数。强转那一下不是装饰:0xFFFF 当无符号数是六万多,当有符号数是 -1。倾斜到另一边时,传感器就是从 0 往负数走,没有这一步,屏幕上的数字会在零点处跳到六万多。
这样写语法没问题,读出来的数大部分时候也像那么回事。但每一次 MPU6050_ReadReg() 都是一整段传输,中间隔着刷屏、发串口、处理按键;而芯片内部那一套寄存器一直按 100Hz 更新。两次独立的读之间跨过一次更新,拼出来的高低字节就来自两个采样时刻,数值在几个数之间无规律地跳,看着像“噪声特别大”。
手册对这种写法给了一句提醒:不用连读的时候,得靠数据就绪中断自己保证一组单字节读发生在同一个采样时刻。也就是说:不连读,就得把那根 INT 线接上——这里先不接它,是因为连读已经把这件事解决了。
原始数只是“尺子上的刻度”。要变成 g 和度每秒,除以刚才那张表里的灵敏度:
温度那一行的两个数字来自产品规格书:温度通道的灵敏度是 340 LSB/°C,35°C 时偏置是 −521 LSB。代进去算一遍就得到 原始值 ÷ 340 + 36.53。它不是高精度温度计,但拿来当“芯片是不是在正常工作”的旁证很够用:手指按住芯片停半分钟,这个数会往上走一两度。
改量程的时候,要改的就是这两个宏。这两个常数和寄存器里那两位是同一件事的两半,只改一处,屏幕上的数就会差 8 倍。
加速度计测的是“它自己感受到的加速度”,静止的时候感受到的就是重力。这一点带来一个很好用的自检:不管模块摆成什么姿势,三个加速度的平方和开根号都应该接近 1g。
F103 里没有硬件浮点单元,开方和三角函数都由软件算出来,比一条整数加法慢得多。放在 200ms 一次的显示任务里不心疼,但它不该出现在中断里——中断只负责搬运,计算留给主循环。
前两行是关键:模长明显偏离 1,是传感器自己的偏差;模长对得上而 az 偏小,是模块本身没放平。 这两个结论完全不同,一个属于另一场要单独做的实验,一个只要把桌子垫平。有了这个自检,就不会把“桌子歪了”当成“传感器不准”,然后开始乱改代码。
做这个自检之前还有一个前提:模块要固定住。用手按着、让杜邦线吊着它,手和线的抖动会一路传进芯片,模长会跟着晃,量出来的结果不作数。
平放的模块绕水平轴一倾,重力就从一个轴分到另一个轴上,分量之间的比例就确定了倾角。用两个反正切就能把它们取出来:
57.29578 是 180 除以 π,把弧度换成度。俯仰角定义成“绕 Y 轴转了多少”,横滚角是“绕 X 轴转了多少”。俯仰角被限制在 −90 到 90 度之间——它的第二个参数是平方和开根号,恒不为负,所以不可能超过 90;横滚角走的是 atan2(ay, az),az 一翻到背面就变负,它能一直走到 ±180 度——把模块翻到背面,横滚角显示的就是 ±180。
为什么这里用反正切,而不是直接拿 ax 除以 az 再查表?因为那个比值在分母接近 0 的时候没法用,而反正切把两个分量一起看,模块转到任何姿态都不会得到无穷大。这一点在模块接近竖直的时候最直观:az 掉到几十,ax 接近 1g,ax ÷ az 成了一个几千的数,比值算法开始乱跳,反正切给出的数还是稳的。
慢慢倾斜模块,屏幕上这两个数跟着走;放回桌面,它们回到 0 附近。
本页为82搜索生成的网页快照,内容来自站内索引;演示数据的原文链接仅作示例。