STM32----MPU6050
创始人
2025-05-30 06:26:19
0

前言:最近几个月没有写文章了,因为这学期的事情真的有点多,但是想了想,文章还是要更新,总结自己学习的知识,真的很重要!!!

废话不多说,正文开始:
1.MPU6050的简介

MPU6050 是 InvenSense 公司推出的全球首款整合性 6 轴运动处理组件,相较于多组件方案,免除了组合陀螺仪与加速器时之轴间差的问题,减少了安装空间。MPU6050 内部整合了 3 轴陀螺仪和 3 轴加速度传感器,并且含有一个第二 IIC 接口,可用于连接外部磁力传感器即AUX_CL 和 AUX_DA,并利用自带的数字运动处理器(DMP: DigitalMotion Processor)硬件加速引擎,通过主 IIC 接口,向应用端输出完整的 9 轴融合演算数据。有了 DMP,我们可以使用 InvenSense 公司提供的运动处理资料库,非常方便的实现姿态解算,降低了运动处理运算对操作系统的负荷,同时大大降低了开发难度。

2.初始化步骤以及寄存器的介绍

(i)首先要初始化IIC的通讯协议,初始化SCL和SDA接口,确保mpu6050可以进行和STM32主板进行通信。

(ii)复位MPU6050然唤醒MPU6050

当复位MPU6050的时候,将Bit7【DEVICE_RESET】置为1,使得其复位,与此同时,SLEEP位则会变为1【1:睡眠模式 0:正常工作模式】,所以需要唤醒MPU6050,将改为置为0,进行下一步的操作,TEMP_DIS 用于设置是否使能温度传感器,设置为 0,则使能。

MPU_Write_Byte(MPU_PWR_MGMT1_REG,0X80);	//复位MPU6050
delay_ms(100);
MPU_Write_Byte(MPU_PWR_MGMT1_REG,0X00);	//唤醒MPU6050 

(iii)初始化陀螺仪传感器【角速度传感器】

 

 该寄存器需要关注的是FS_SEL这两位,这是角速度量程的范围

 这个陀螺仪满量程的概念是:

量程指的是最大量程,比如,选择的是FS_SEL  ==  2  --->±1000°/s,每秒1000以内都可以检验出来,但当大于1000°的时候,就无法进行检测。

(iv)加速度传感器

 和上面同理,关注FS_SEL这两位。

 eg:   2g == 两个重力加速度 = 19.6m/s²,以此类推,确定最大量程。

灵敏度为:65536(2^16)/4000(2000*2)=16384LSB/g。

但一般我们使用mpu6050选择的是 ±1000°/s和±2g。

    MPU_Set_Gyro_Fsr(3);					//陀螺仪传感器,±2000dpsMPU_Set_Accel_Fsr(0);					//加速度传感器,±2g

(v)FIFO使能寄存器

 将ACCEL_FIFO_EN设置为1,则开启FIFO,则开启加速度传感器的三个位,设置为0,则关闭FIFO。角速度的传感器需要自己单个控制开启与否。

MPU_Write_Byte(MPU_FIFO_EN_REG,0X00);	//关闭FIFO

(vi) 陀螺仪采样率分频寄存器

                        公式为 :采样频率=陀螺仪输出频率/1+SMPLRT_DIV 一般陀螺仪的输出频率为1khz或者8khz,这个由数字低通滤波器来决定,当采样频率为50hz的时候,则当前的SMPLRT_DIV为(1000/50-1 = 19)。

(vii)配置寄存器

主要看的低三位的设置:

 

 一般设置的带宽 = 采样频率/2。

(viii)加速度输出寄存器,陀螺仪输出寄存器,温度输出寄存器

 

温度换算公式为:
Temperature = 36.53 + regval/340。
 

 这三个都是输出传感器的数值,高字节在前,低字节在后。

//得到温度值
//返回值:温度值(扩大了100倍)
short MPU_Get_Temperature(void)
{u8 buf[2]; short raw;float temp;MPU_Read_Len(MPU_ADDR,MPU_TEMP_OUTH_REG,2,buf); raw=((u16)buf[0]<<8)|buf[1];  temp=36.53+((double)raw)/340;  return temp*100;;
}
//得到陀螺仪值(原始值)
//gx,gy,gz:陀螺仪x,y,z轴的原始读数(带符号)
//返回值:0,成功
//    其他,错误代码
u8 MPU_Get_Gyroscope(short *gx,short *gy,short *gz)
{u8 buf[6],res;  res=MPU_Read_Len(MPU_ADDR,MPU_GYRO_XOUTH_REG,6,buf);if(res==0){*gx=((u16)buf[0]<<8)|buf[1];  *gy=((u16)buf[2]<<8)|buf[3];  *gz=((u16)buf[4]<<8)|buf[5];} 	return res;;
}
//得到加速度值(原始值)
//gx,gy,gz:陀螺仪x,y,z轴的原始读数(带符号)
//返回值:0,成功
//    其他,错误代码
u8 MPU_Get_Accelerometer(short *ax,short *ay,short *az)
{u8 buf[6],res;  res=MPU_Read_Len(MPU_ADDR,MPU_ACCEL_XOUTH_REG,6,buf);if(res==0){*ax=((u16)buf[0]<<8)|buf[1];  *ay=((u16)buf[2]<<8)|buf[3];  *az=((u16)buf[4]<<8)|buf[5];} 	return res;;
}

 理解一行代码:

((u16)buf[0]<<8)|buf[1]

将buf[0]强制转换为16int型的数据,然后将其左移八位,使得低八位空出来,将buf[1]的八位移入,添到低八位,构成16位的数据,然后输送出来。

(ix)DMP简单解释

DMP会将陀螺仪传感器以及加速度传感器的数值传送出来,借助DMP输出四元数【q30格式】,即放大了2的30次方,所以需要除回来。

        q0 = quat[0] / q30;    //q30格式转换为浮点数
        q1 = quat[1] / q30;
        q2 = quat[2] / q30;
        q3 = quat[3] / q30; 

 然后借助公式转换为角度。除以57.3为了将弧度转化为角度

         *pitch = asin(-2 * q1 * q3 + 2 * q0* q2)* 57.3;    // pitch
        *roll  = atan2(2 * q2 * q3 + 2 * q0 * q1, -2 * q1 * q1 - 2 * q2* q2 + 1)* 57.3;    // roll
        *yaw   = atan2(2*(q1*q2 + q0*q3),q0*q0+q1*q1-q2*q2-q3*q3) * 57.3;    //yaw

 注:如果需要OLED显示,只需要正常的配置一个OLED的IIC通信,然后设定好你需要的字符大小,然后设置相应的需要的字体以及变量,从而可以显示在显示屏上面,,或者你也可以选择串口1printf输出出来。

实物图:

 

 

相关内容

热门资讯

武汉摩尔影城安卓系统APP,便... 你有没有想过,一部手机就能带你走进电影的世界,享受大屏幕带来的震撼?今天,就让我带你详细了解武汉摩尔...
联想刷安卓p系统,畅享智能新体... 你有没有发现,最近联想的安卓P系统刷机热潮可是席卷了整个互联网圈呢!这不,我就迫不及待地来和你聊聊这...
mac从安卓系统改成双系统,双... 你有没有想过,你的Mac电脑从安卓系统改成双系统后,生活会有哪些翻天覆地的变化呢?想象一边是流畅的苹...
kindke安卓系统激活码,激... 亲爱的读者,你是否在寻找一款能够让你手机焕然一新的操作系统?如果你是安卓用户,那么今天我要给你带来一...
萤石云监控安卓系统,安卓系统下... 你有没有想过,家里的安全可以随时随地掌握在手中?现在,有了萤石云监控安卓系统,这不再是梦想啦!想象无...
手机安卓系统会不会爆炸,系统升... 手机安卓系统会不会爆炸——一场关于安全的探讨在当今这个数字化的世界里,手机已经成为我们生活中不可或缺...
安卓系统双清详图解,恢复出厂设... 你有没有遇到过手机卡顿、运行缓慢的问题?别急,今天就来给你详细解析一下安卓系统的“双清”操作,让你的...
召唤抽奖系统安卓直装,轻松体验... 你知道吗?现在市面上有一种特别火的玩意儿,那就是召唤抽奖系统安卓直装。是不是听起来就让人心动不已?没...
系统工具箱安卓2.3,深度解析... 你有没有发现,手机里的那些小工具,有时候就像是个神奇的百宝箱呢?今天,就让我带你一探究竟,看看安卓2...
华硕平板安卓刷机系统,解锁性能... 亲爱的数码爱好者们,你是否曾为你的华硕平板安卓系统感到厌倦,想要给它来一次焕然一新的体验呢?那就跟着...
鸿蒙系统与安卓怎么区别,差异解... 你有没有发现,最近手机圈子里有个大热门,那就是鸿蒙系统和安卓系统的区别。这两位“系统大侠”各有各的绝...
红帽系统怎么刷回安卓,红帽系统... 你是不是也和我一样,对红帽系统刷回安卓充满了好奇?别急,今天就来给你详细揭秘这个过程,让你轻松上手,...
ios安卓联想三系统,全面解析... 你有没有发现,现在的手机市场真是热闹非凡呢!各种操作系统轮番登场,让人眼花缭乱。今天,就让我带你来聊...
安卓调用系统相机并存盘,And... 你有没有想过,手机里的照片和视频,是怎么被我们随手拍下,又神奇地存到手机里的呢?今天,就让我带你一探...
安卓4.0原生系统下,引领智能... 你有没有发现,安卓4.0原生系统下,手机的使用体验简直就像打开了新世界的大门?今天,就让我带你一起探...
安卓c13系统,创新功能与性能... 你知道吗?最近安卓系统又来了一次大更新,那就是安卓C13系统。这可不是一个小打小闹的更新,而是带来了...
鸿蒙3.0脱离安卓系统,开启全... 你知道吗?最近科技圈可是炸开了锅,因为华为的新操作系统鸿蒙3.0横空出世,竟然宣布要脱离安卓系统,这...
安卓怎么应对苹果系统,安卓系统... 你知道吗?在智能手机的世界里,安卓和苹果就像是一对相爱相杀的恋人。安卓系统,这位多才多艺的“大众情人...
安卓系统如何开橱窗教程,安卓系... 你有没有想过,你的安卓手机里也能开个橱窗,展示那些你心爱的宝贝?没错,就是那种可以随时翻看、随时分享...
安卓系统软件APK,深入探究安... 你有没有发现,手机里的那些好玩的应用,其实都是靠一个小小的文件来“住”进去的?没错,就是安卓系统里的...