设为首页收藏本站
开启辅助访问 切换到宽版

 找回密码
 立即注册

QQ登录

只需一步，快速开始

热门： 51单片机 | 24小时必答区 | 单片机教程 | 单片机DIY制作 | STM32 | Cortex M3 | 模数电子 | 电子DIY制作 | 音响/功放 | 拆机乐园 | Arduino | 嵌入式OS | 程序设计

搜索
»论坛 › 嵌入式/单片机论坛 › 24小时必答区 › 陀螺仪mpu6050+STM32单片机程序
返回列表 发新帖
查看: 1119|回复: 0
打印 上一主题 下一主题
收起左侧

陀螺仪mpu6050+STM32单片机程序

[复制链接]
跳转到指定楼层
楼主
ID:1069607 发表于 2023-4-3 10:48 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
(源数据读取_串口上传)
STM32F103ZET6+mpu6050+TTL***********************************

TTL:
5v<->5v
GND<->GND
RXD<->PA9
TXD<->PA10
mpu9050:
SDA<->PB7
SCL<->PB6
5V<->5V
GND<->GND

***********************************
  1. /**
  2.   ******************************************************************************
  3.   * @file    main.c
  4.   * @brief   MPU9250陀螺仪源数据读取
  5.   ******************************************************************************
  6.   * 硬件平台         :STM32F103ZET6系统板+MPU9250模块+USB转TTL电平工具
  7.   ******************************************************************************
  8.   */
  9. #include "main.h"
  10. /**
  11.   * @brief  主函数
  12.   * @param  无
  13.   * @retval 无
  14.   */
  15. int main(void)
  16. {
  17.         SYS_Init();                                      //系统初始化总函数
  18.         while(1)                                         //主循环
  19.         {
  20.                 MPU_Read();                                  //MPU6050数据读取
  21.                 DATA_Report();                               //MPU6050数据上报
  22.         }
  23. }
  24. /**
  25.   * @brief  系统初始化总函数
  26.   * @param  无
  27.   * @retval 无
  28.   */
  29. void SYS_Init(void)
  30. {
  31.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);  //中断优先级分组函数
  32.         delay_init();                                                                     //延时函数初始化
  33.         uart_init(115200);                                          //串口初始化为115200
  34.         LED_Init();                                      //初始化与LED连接的硬件接口
  35.         MPU9250_Init();                                  //初始化MPU9250
  36. }        
  37. /**
  38.   * @brief  MPU6050数据读取函数
  39.   * @param  无
  40.   * @retval 无
  41.   */
  42. void MPU_Read(void)
  43. {                        
  44.         MPU_Get_Gyroscope(Gyro,Gyro+1,Gyro+2);                         //读取角速度原始数据
  45.         MPU_Get_Accelerometer(Acc,Acc+1,Acc+2);                         //读取角加速度原始数据
  46.         MPU_Get_Magnetometer(Mag,Mag+1,Mag+2);                         //读取磁力计原始数据
  47.                         
  48. }
  49. /**
  50.   * @brief  MPU6050数据上报
  51.   * @param  无
  52.   * @retval 无
  53.   */
  54. void DATA_Report(void)
  55. {
  56.         printf("Accx:%d,Accy:%d,Accz:%d,Gyrox:%d,Gyroy:%d,Gyroz:%d,Magx:%d,Magy:%d,Magz:%d\r\n",
  57.         Acc[0],Acc[1],Acc[2],Gyro[0],Gyro[1],Gyro[2],Mag[0],Mag[1],Mag[2]);//源数据串口输出
  58. }
复制代码
  1. #include "mpu9250.h"
  2. #include "mpuiic.h"
  3. #include "delay.h"

  5. //初始化MPU9250
  6. //返回值:0,成功
  7. //    其他,错误代码
  8. u8 MPU9250_Init(void)
  9. {
  10.     u8 res=0;
  11.     IIC_Init();     //初始化IIC总线
  12.     MPU_Write_Byte(MPU9250_ADDR,MPU_PWR_MGMT1_REG,0X80);//复位MPU9250
  13.     delay_ms(100);  //延时100ms
  14.     MPU_Write_Byte(MPU9250_ADDR,MPU_PWR_MGMT1_REG,0X00);//唤醒MPU9250
  15.     MPU_Set_Gyro_Fsr(3);                                                        //陀螺仪传感器,±2000dps
  16.           MPU_Set_Accel_Fsr(0);                                                                //加速度传感器,±2g
  17.     MPU_Set_Rate(50);                                                                        //设置采样率50Hz
  18.     MPU_Write_Byte(MPU9250_ADDR,MPU_INT_EN_REG,0X00);   //关闭所有中断
  19.           MPU_Write_Byte(MPU9250_ADDR,MPU_USER_CTRL_REG,0X00);//I2C主模式关闭
  20.           MPU_Write_Byte(MPU9250_ADDR,MPU_FIFO_EN_REG,0X00);        //关闭FIFO
  21.           MPU_Write_Byte(MPU9250_ADDR,MPU_INTBP_CFG_REG,0X82);//INT引脚低电平有效，开启bypass模式，可以直接读取磁力计
  22.     res=MPU_Read_Byte(MPU9250_ADDR,MPU_DEVICE_ID_REG);  //读取MPU6500的ID
  23.     if(res==MPU6500_ID) //器件ID正确
  24.     {
  25.         MPU_Write_Byte(MPU9250_ADDR,MPU_PWR_MGMT1_REG,0X01);          //设置CLKSEL,PLL X轴为参考
  26.         MPU_Write_Byte(MPU9250_ADDR,MPU_PWR_MGMT2_REG,0X00);          //加速度与陀螺仪都工作
  27.                     MPU_Set_Rate(50);                                                               //设置采样率为50Hz   
  28.     }else return 1;

  30.     res=MPU_Read_Byte(AK8963_ADDR,MAG_WIA);                            //读取AK8963 ID   
  31.     if(res==AK8963_ID)
  32.     {
  33.         MPU_Write_Byte(AK8963_ADDR,MAG_CNTL1,0X11);                //设置AK8963为单次测量模式
  34.     }else return 1;

  36.     return 0;
  37. }

  39. //设置MPU9250陀螺仪传感器满量程范围
  40. //fsr:0,±250dps;1,±500dps;2,±1000dps;3,±2000dps
  41. //返回值:0,设置成功
  42. //    其他,设置失败
  43. u8 MPU_Set_Gyro_Fsr(u8 fsr)
  44. {
  45.         return MPU_Write_Byte(MPU9250_ADDR,MPU_GYRO_CFG_REG,fsr<<3);//设置陀螺仪满量程范围  
  46. }
  47. //设置MPU9250加速度传感器满量程范围
  48. //fsr:0,±2g;1,±4g;2,±8g;3,±16g
  49. //返回值:0,设置成功
  50. //    其他,设置失败
  51. u8 MPU_Set_Accel_Fsr(u8 fsr)
  52. {
  53.         return MPU_Write_Byte(MPU9250_ADDR,MPU_ACCEL_CFG_REG,fsr<<3);//设置加速度传感器满量程范围  
  54. }

  56. //设置MPU9250的数字低通滤波器
  57. //lpf:数字低通滤波频率(Hz)
  58. //返回值:0,设置成功
  59. //    其他,设置失败
  60. u8 MPU_Set_LPF(u16 lpf)
  61. {
  62.         u8 data=0;
  63.         if(lpf>=188)data=1;
  64.         else if(lpf>=98)data=2;
  65.         else if(lpf>=42)data=3;
  66.         else if(lpf>=20)data=4;
  67.         else if(lpf>=10)data=5;
  68.         else data=6;
  69.         return MPU_Write_Byte(MPU9250_ADDR,MPU_CFG_REG,data);//设置数字低通滤波器  
  70. }

  72. //设置MPU9250的采样率(假定Fs=1KHz)
  73. //rate:4~1000(Hz)
  74. //返回值:0,设置成功
  75. //    其他,设置失败
  76. u8 MPU_Set_Rate(u16 rate)
  77. {
  78.         u8 data;
  79.         if(rate>1000)rate=1000;
  80.         if(rate<4)rate=4;
  81.         data=1000/rate-1;
  82.         data=MPU_Write_Byte(MPU9250_ADDR,MPU_SAMPLE_RATE_REG,data);        //设置数字低通滤波器
  83.         return MPU_Set_LPF(rate/2);        //自动设置LPF为采样率的一半
  84. }

  86. //得到温度值
  87. //返回值:温度值(扩大了100倍)
  88. short MPU_Get_Temperature(void)
  89. {
  90.     u8 buf[2];
  91.     short raw;
  92.         float temp;
  93.         MPU_Read_Len(MPU9250_ADDR,MPU_TEMP_OUTH_REG,2,buf);
  94.     raw=((u16)buf[0]<<8)|buf[1];  
  95.     temp=21+((double)raw)/333.87;  
  96.     return temp*100;;
  97. }
  98. //得到陀螺仪值(原始值)
  99. //gx,gy,gz:陀螺仪x,y,z轴的原始读数(带符号)
  100. //返回值:0,成功
  101. //    其他,错误代码
  102. u8 MPU_Get_Gyroscope(short *gx,short *gy,short *gz)
  103. {
  104.     u8 buf[6],res;
  105.         res=MPU_Read_Len(MPU9250_ADDR,MPU_GYRO_XOUTH_REG,6,buf);
  106.         if(res==0)
  107.         {
  108.                 *gx=((u16)buf[0]<<8)|buf[1];  
  109.                 *gy=((u16)buf[2]<<8)|buf[3];  
  110.                 *gz=((u16)buf[4]<<8)|buf[5];
  111.         }        
  112.     return res;;
  113. }
  114. //得到加速度值(原始值)
  115. //gx,gy,gz:陀螺仪x,y,z轴的原始读数(带符号)
  116. //返回值:0,成功
  117. //    其他,错误代码
  118. u8 MPU_Get_Accelerometer(short *ax,short *ay,short *az)
  119. {
  120.     u8 buf[6],res;  
  121.         res=MPU_Read_Len(MPU9250_ADDR,MPU_ACCEL_XOUTH_REG,6,buf);
  122.         if(res==0)
  123.         {
  124.                 *ax=((u16)buf[0]<<8)|buf[1];  
  125.                 *ay=((u16)buf[2]<<8)|buf[3];  
  126.                 *az=((u16)buf[4]<<8)|buf[5];
  127.         }        
  128.     return res;;
  129. }

  131. //得到磁力计值(原始值)
  132. //mx,my,mz:磁力计x,y,z轴的原始读数(带符号)
  133. //返回值:0,成功
  134. //    其他,错误代码
  135. u8 MPU_Get_Magnetometer(short *mx,short *my,short *mz)
  136. {
  137.     u8 buf[6],res;  
  138.         res=MPU_Read_Len(AK8963_ADDR,MAG_XOUT_L,6,buf);
  139.         if(res==0)
  140.         {
  141.                 *mx=((u16)buf[1]<<8)|buf[0];  
  142.                 *my=((u16)buf[3]<<8)|buf[2];  
  143.                 *mz=((u16)buf[5]<<8)|buf[4];
  144.         }        
  145.     MPU_Write_Byte(AK8963_ADDR,MAG_CNTL1,0X11); //AK8963每次读完以后都需要重新设置为单次测量模式
  146.     return res;;
  147. }

  149. //IIC连续写
  150. //addr:器件地址
  151. //reg:寄存器地址
  152. //len:写入长度
  153. //buf:数据区
  154. //返回值:0,正常
  155. //    其他,错误代码
  156. u8 MPU_Write_Len(u8 addr,u8 reg,u8 len,u8 *buf)
  157. {
  158.     u8 i;
  159.     IIC_Start();
  160.     IIC_Send_Byte((addr<<1)|0); //发送器件地址+写命令
  161.     if(IIC_Wait_Ack())          //等待应答
  162.     {
  163.         IIC_Stop();
  164.         return 1;
  165.     }
  166.     IIC_Send_Byte(reg);         //写寄存器地址
  167.     IIC_Wait_Ack();             //等待应答
  168.     for(i=0;i<len;i++)
  169.     {
  170.         IIC_Send_Byte(buf[i]);  //发送数据
  171.         if(IIC_Wait_Ack())      //等待ACK
  172.         {
  173.             IIC_Stop();
  174.             return 1;
  175.         }
  176.     }
  177.     IIC_Stop();
  178.     return 0;
  179. }

  181. //IIC连续读
  182. //addr:器件地址
  183. //reg:要读取的寄存器地址
  184. //len:要读取的长度
  185. //buf:读取到的数据存储区
  186. //返回值:0,正常
  187. //    其他,错误代码
  188. u8 MPU_Read_Len(u8 addr,u8 reg,u8 len,u8 *buf)
  189. {
  190.     IIC_Start();
  191.     IIC_Send_Byte((addr<<1)|0); //发送器件地址+写命令
  192.     if(IIC_Wait_Ack())          //等待应答
  193.     {
  194.         IIC_Stop();
  195.         return 1;
  196.     }
  197.     IIC_Send_Byte(reg);         //写寄存器地址
  198.     IIC_Wait_Ack();             //等待应答
  199.           IIC_Start();               
  200.     IIC_Send_Byte((addr<<1)|1); //发送器件地址+读命令
  201.     IIC_Wait_Ack();             //等待应答
  202.     while(len)
  203.     {
  204.         if(len==1)*buf=IIC_Read_Byte(0);//读数据,发送nACK
  205.                                 else *buf=IIC_Read_Byte(1);                //读数据,发送ACK  
  206.                                 len--;
  207.                                 buf++;  
  208.     }
  209.     IIC_Stop();                 //产生一个停止条件
  210.     return 0;      
  211. }

  213. //IIC写一个字节
  214. //devaddr:器件IIC地址
  215. //reg:寄存器地址
  216. //data:数据
  217. //返回值:0,正常
  218. //    其他,错误代码
  219. u8 MPU_Write_Byte(u8 addr,u8 reg,u8 data)
  220. {
  221.     IIC_Start();
  222.     IIC_Send_Byte((addr<<1)|0); //发送器件地址+写命令
  223.     if(IIC_Wait_Ack())          //等待应答
  224.     {
  225.         IIC_Stop();
  226.         return 1;
  227.     }
  228.     IIC_Send_Byte(reg);         //写寄存器地址
  229.     IIC_Wait_Ack();             //等待应答
  230.     IIC_Send_Byte(data);        //发送数据
  231.     if(IIC_Wait_Ack())          //等待ACK
  232.     {
  233.         IIC_Stop();
  234.         return 1;
  235.     }
  236.     IIC_Stop();
  237.     return 0;
  238. }

  240. //IIC读一个字节
  241. //reg:寄存器地址
  242. //返回值:读到的数据
  243. u8 MPU_Read_Byte(u8 addr,u8 reg)
  244. {
  245.     u8 res;
  246.     IIC_Start();
  247.     IIC_Send_Byte((addr<<1)|0); //发送器件地址+写命令
  248.     IIC_Wait_Ack();             //等待应答
  249.     IIC_Send_Byte(reg);         //写寄存器地址
  250.     IIC_Wait_Ack();             //等待应答
  251.           IIC_Start();               
  252.     IIC_Send_Byte((addr<<1)|1); //发送器件地址+读命令
  253.     IIC_Wait_Ack();             //等待应答
  254.     res=IIC_Read_Byte(0);                    //读数据,发送nACK  
  255.     IIC_Stop();                 //产生一个停止条件
  256.     return res;  
  257. }
复制代码


Keil代码下载: STM32F103ZET6驱动MPU9250程序(源数据读取_串口上传).7z (185.43 KB, 下载次数: 33)
分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏 分享淘帖 顶顶 踩踩
回复

使用道具 举报

返回列表 发新帖
高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表