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

 找回密码
 立即注册

QQ登录

只需一步，快速开始

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

搜索
»论坛 › 嵌入式/单片机论坛 › STM32/8 › STM32F103C8T6测试MPU6050串口输出 九轴姿态传感器源码
返回列表 发新帖
查看: 12294|回复: 25
收起左侧

STM32F103C8T6测试MPU6050串口输出 九轴姿态传感器源码

  [复制链接]
ID:302731 发表于 2018-4-6 13:58 | 显示全部楼层 |阅读模式
在网上找了好久，没找到合适的，后来就自己参照资料写了一个，用的最新版的keil5编写，库也是最新的。PB6、PB7为IIC接口读取，PA9、PA10串口输出数据，效果如图，三轴加速已经校准过，数据还算灵敏，eg:98代表加速度为9.8m/s 2 陀螺仪已经能够正常读取，数据还未调校。有中文注释，自行下载研究！！

QQ图片20180406134900.png

单片机源程序如下:
  1. #include "sys.h"
  2. #include "delay.h"
  3. #include "usart.h"
  4. #include "stm32f10x.h"                  // Device header
  5. #include  <math.h>    //Keil library  
  6. GPIO_InitTypeDef GPIO_InitStructure;
  7. ErrorStatus HSEStartUpStatus;
  8. #define   uchar unsigned char
  9. #define   uint unsigned int       
  10. //        加速度，陀螺仪，磁力 Acceleration, gyroscope, magnetic
  11. // 定义MPU6050内部地址
  12. //****************************************
  13. #define        SMPLRT_DIV                0x19        //陀螺仪采样率，典型值：0x07(125Hz)
  14. #define        CONFIG                        0x1A        //低通滤波频率，典型值：0x06(5Hz)
  15. #define        GYRO_CONFIG                0x1B        //陀螺仪自检及测量范围，典型值：0x18(不自检，2000deg/s)
  16. #define        ACCEL_CONFIG        0x1C        //加速计自检、测量范围及高通滤波频率，典型值：0x01(不自检，2G，5Hz)
  17. #define        ACCEL_XOUT_H        0x3B        //加速度地址
  18. #define        ACCEL_XOUT_L        0x3C
  19. #define        ACCEL_YOUT_H        0x3D
  20. #define        ACCEL_YOUT_L        0x3E
  21. #define        ACCEL_ZOUT_H        0x3F
  22. #define        ACCEL_ZOUT_L        0x40
  23. #define        TEMP_OUT_H                0x41        //温度地址
  24. #define        TEMP_OUT_L                0x42

  26. #define        GYRO_XOUT_H                0x43        //陀螺仪地址
  27. #define        GYRO_XOUT_L                0x44       
  28. #define        GYRO_YOUT_H                0x45
  29. #define        GYRO_YOUT_L                0x46
  30. #define        GYRO_ZOUT_H                0x47
  31. #define        GYRO_ZOUT_L                0x48

  33. #define MAG_ADDRESS                0x0c
  34. #define MAG_XOUT_H                0x04                //磁力传感器地址
  35. #define MAG_XOUT_L                0x03
  36. #define MAG_YOUT_H                0x06
  37. #define MAG_YOUT_L                0x05
  38. #define MAG_ZOUT_H                0x08
  39. #define MAG_ZOUT_L                0x07

  41. #define        PWR_MGMT_1                0x6B        //电源管理，典型值：0x00(正常启用)
  42. #define        WHO_AM_I                0x75        //IIC地址寄存器(默认数值0x68，只读)


  45. //****************************

  47. #define        MPU6050_Addr   0xD0          //定义器件在IIC总线中的从地址,根据ALT  ADDRESS地址引脚不同修改

  49. unsigned char TX_DATA[4];           //显示据缓存区

  51. unsigned char BUF0[10];       //接收数据缓存区
  52. unsigned char BUF1[10];       //接收数据缓存区
  53. char  test=0;                                                          //IIC用到
  54. short G_X,G_Y,G_Z,T_T;                         //X,Y,Z轴角度，温度


  57. short A_X,A_Y,A_Z;                                         //X,Y,Z加速度
  58. //short M_X,M_Y,M_Z;                                         //X,Y,Z地磁
  59. //************************************
  60. /*模拟IIC端口输出输入定义*/
  61. #define SCL_H         GPIOB->BSRR = GPIO_Pin_6
  62. #define SCL_L         GPIOB->BRR  = GPIO_Pin_6
  63.    
  64. #define SDA_H         GPIOB->BSRR = GPIO_Pin_7
  65. #define SDA_L         GPIOB->BRR  = GPIO_Pin_7

  67. #define SCL_read      GPIOB->IDR  & GPIO_Pin_6
  68. #define SDA_read      GPIOB->IDR  & GPIO_Pin_7

  70. /* 函数申明 -----------------------------------------------*/
  71. void RCC_Configuration(void);
  72. void GPIO_Configuration(void);                //GPIO初始化
  73. void NVIC_Configuration(void);                //中断初始化
  74. void USART1_Configuration(void);        //串口初始化
  75. void WWDG_Configuration(void);                //看门狗初始化
  76. void Delay(u32 nTime);
  77. void Delayms(vu32 m);  
  78. /* 变量定义 ----------------------------------------------*/

  80.   /*******************************/
  81. void DATA_printf(uchar *s,short temp_data)
  82. {
  83.         if(temp_data<0){
  84.         temp_data=-temp_data;
  85.     *s='-';
  86.         }
  87.         else *s=' ';
  88.     *++s =temp_data/100+0x30;
  89.     temp_data=temp_data%100;     //取余运算
  90.     *++s =temp_data/10+0x30;
  91.     temp_data=temp_data%10;      //取余运算
  92.     *++s =temp_data+0x30;        
  93. }

  95. /*******************************************************************************
  96. * Function Name  : I2C_GPIO_Config
  97. * Description    : Configration Simulation IIC GPIO
  98. * Input          : None
  99. * Output         : None
  100. * Return         : None
  101. ****************************************************************************** */
  102. void I2C_GPIO_Config(void)                                //IIC引脚初始化
  103. {
  104.   GPIO_InitTypeDef  GPIO_InitStructure;

  106.   GPIO_InitStructure.GPIO_Pin =  GPIO_Pin_6;
  107.   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  108.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_OD;  
  109.   GPIO_Init(GPIOB, &GPIO_InitStructure);

  111.   GPIO_InitStructure.GPIO_Pin =  GPIO_Pin_7;
  112.   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  113.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_OD;
  114.   GPIO_Init(GPIOB, &GPIO_InitStructure);
  115. }

  117. /*******************************************************************************
  118. * Function Name  : I2C_delay
  119. * Description    : Simulation IIC Timing series delay
  120. * Input          : None
  121. * Output         : None
  122. * Return         : None
  123. ****************************************************************************** */
  124. void I2C_delay(void)
  125. {
  126.                
  127.    u8 i=30; //这里可以优化速度        ，经测试最低到5还能写入
  128.    while(i)
  129.    {
  130.      i--;
  131.    }  
  132. }

  134. void delay5ms(void)
  135. {
  136.                
  137.    int i=5000;  
  138.    while(i)
  139.    {
  140.      i--;
  141.    }  
  142. }
  143. /*******************************************************************************
  144. * Function Name  : I2C_Start
  145. * Description    : Master Start Simulation IIC Communication
  146. * Input          : None
  147. * Output         : None
  148. * Return         : Wheather         Start
  149. ****************************************************************************** */
  150. bool I2C_Start(void)                        //IIC开始
  151. {
  152.         SDA_H;
  153.         SCL_H;
  154.         I2C_delay();
  155.         if(!SDA_read)return FALSE;        //SDA线为低电平则总线忙,退出
  156.         SDA_L;
  157.         I2C_delay();
  158.         if(SDA_read) return FALSE;        //SDA线为高电平则总线出错,退出
  159.         SDA_L;
  160.         I2C_delay();
  161.         return TRUE;
  162. }
  163. /*******************************************************************************
  164. * Function Name  : I2C_Stop
  165. * Description    : Master Stop Simulation IIC Communication
  166. * Input          : None
  167. * Output         : None
  168. * Return         : None
  169. ****************************************************************************** */
  170. void I2C_Stop(void)                                //IIC停止
  171. {
  172.         SCL_L;
  173.         I2C_delay();
  174.         SDA_L;
  175.         I2C_delay();
  176.         SCL_H;
  177.         I2C_delay();
  178.         SDA_H;
  179.         I2C_delay();
  180. }
  181. /*******************************************************************************
  182. * Function Name  : I2C_Ack
  183. * Description    : Master Send Acknowledge Single
  184. * Input          : None
  185. * Output         : None
  186. * Return         : None
  187. ****************************************************************************** */
  188. void I2C_Ack(void)                //IIC发送
  189. {       
  190.         SCL_L;
  191.         I2C_delay();
  192.         SDA_L;
  193.         I2C_delay();
  194.         SCL_H;
  195.         I2C_delay();
  196.         SCL_L;
  197.         I2C_delay();
  198. }   
  199. /*******************************************************************************
  200. * Function Name  : I2C_NoAck
  201. * Description    : Master Send No Acknowledge Single
  202. * Input          : None
  203. * Output         : None
  204. * Return         : None
  205. ****************************************************************************** */
  206. void I2C_NoAck(void)       
  207. {       
  208.         SCL_L;
  209.         I2C_delay();
  210.         SDA_H;
  211.         I2C_delay();
  212.         SCL_H;
  213.         I2C_delay();
  214.         SCL_L;
  215.         I2C_delay();
  216. }
  217. /*******************************************************************************
  218. * Function Name  : I2C_WaitAck
  219. * Description    : Master Reserive Slave Acknowledge Single
  220. * Input          : None
  221. * Output         : None
  222. * Return         : Wheather         Reserive Slave Acknowledge Single
  223. ****************************************************************************** */
  224. bool I2C_WaitAck(void)          //返回为:=1有ACK,=0无ACK  等待接收
  225. {
  226.         SCL_L;
  227.         I2C_delay();
  228.         SDA_H;                       
  229.         I2C_delay();
  230.         SCL_H;
  231.         I2C_delay();
  232.         if(SDA_read)
  233.         {
  234.       SCL_L;
  235.           I2C_delay();
  236.       return FALSE;
  237.         }
  238.         SCL_L;
  239.         I2C_delay();
  240.         return TRUE;
  241. }
  242. /*******************************************************************************
  243. * Function Name  : I2C_SendByte
  244. * Description    : Master Send a Byte to Slave
  245. * Input          : Will Send Date
  246. * Output         : None
  247. * Return         : None
  248. ****************************************************************************** */
  249. void I2C_SendByte(u8 SendByte) //数据从高位到低位//发送数据
  250. {
  251.     u8 i=8;
  252.     while(i--)
  253.     {
  254.         SCL_L;
  255.         I2C_delay();
  256.       if(SendByte&0x80)
  257.         SDA_H;  
  258.       else
  259.         SDA_L;
  260.         SendByte<<=1;
  261.         I2C_delay();
  262.                 SCL_H;
  263.         I2C_delay();
  264.     }
  265.     SCL_L;
  266. }  
  267. /*******************************************************************************
  268. * Function Name  : I2C_RadeByte
  269. * Description    : Master Reserive a Byte From Slave
  270. * Input          : None
  271. * Output         : None
  272. * Return         : Date From Slave
  273. ****************************************************************************** */
  274. unsigned char I2C_RadeByte(void)  //数据从高位到低位//读取字节
  275. {
  276.     u8 i=8;
  277.     u8 ReceiveByte=0;

  279.     SDA_H;                               
  280.     while(i--)
  281.     {
  282.       ReceiveByte<<=1;      
  283.       SCL_L;
  284.       I2C_delay();
  285.           SCL_H;
  286.       I2C_delay();       
  287.       if(SDA_read)
  288.       {
  289.         ReceiveByte|=0x01;
  290.       }
  291.     }
  292.     SCL_L;
  293.     return ReceiveByte;
  294. }
  295. //ZRX         
  296. //单字节写入*******************************************

  298. bool Single_Write(unsigned char SlaveAddress,unsigned char REG_Address,unsigned char REG_data)                     //void
  299. {
  300.           if(!I2C_Start())return FALSE;
  301.     I2C_SendByte(SlaveAddress);   //发送设备地址+写信号//I2C_SendByte(((REG_Address & 0x0700) >>7) | SlaveAddress & 0xFFFE);//设置高起始地址+器件地址
  302.     if(!I2C_WaitAck()){I2C_Stop(); return FALSE;}
  303.     I2C_SendByte(REG_Address );   //设置低起始地址      
  304.     I2C_WaitAck();       
  305.     I2C_SendByte(REG_data);
  306.     I2C_WaitAck();   
  307.     I2C_Stop();
  308.     delay5ms();
  309.     return TRUE;
  310. }

  312. //单字节读取*****************************************
  313. unsigned char Single_Read(unsigned char SlaveAddress,unsigned char REG_Address)
  314. {   unsigned char REG_data;            
  315.         if(!I2C_Start())return FALSE;
  316.     I2C_SendByte(SlaveAddress); //I2C_SendByte(((REG_Address & 0x0700) >>7) | REG_Address & 0xFFFE);//设置高起始地址+器件地址
  317.     if(!I2C_WaitAck()){I2C_Stop();test=1; return FALSE;}
  318.     I2C_SendByte((u8) REG_Address);   //设置低起始地址      
  319.     I2C_WaitAck();
  320.     I2C_Start();
  321.     I2C_SendByte(SlaveAddress+1);
  322.     I2C_WaitAck();

  324.         REG_data= I2C_RadeByte();
  325.     I2C_NoAck();
  326.     I2C_Stop();
  327.     //return TRUE;
  328.         return REG_data;

  330. }                                                     

  332. /*
  333. ********************************************************************************
  334. ** 函数名称 ： RCC_Configuration(void)
  335. ** 函数功能 ： 时钟初始化
  336. ** 输    入        ： 无
  337. ** 输    出        ： 无
  338. ** 返    回        ： 无
  339. ********************************************************************************
  340. */
  341. void RCC_Configuration(void)
  342. {   
  343.   /* RCC system reset(for debug purpose) */
  344.   RCC_DeInit();

  346.   /* Enable HSE */
  347.   RCC_HSEConfig(RCC_HSE_ON);

  349.   /* Wait till HSE is ready */
  350.   HSEStartUpStatus = RCC_WaitForHSEStartUp();

  352.   if(HSEStartUpStatus == SUCCESS)
  353.   {
  354.     /* HCLK = SYSCLK */
  355.     RCC_HCLKConfig(RCC_SYSCLK_Div1);
  356.   
  357.     /* PCLK2 = HCLK */
  358.     RCC_PCLK2Config(RCC_HCLK_Div1);

  360.     /* PCLK1 = HCLK/2 */
  361.     RCC_PCLK1Config(RCC_HCLK_Div2);

  363.     /* Flash 2 wait state */
  364.     FLASH_SetLatency(FLASH_Latency_2);
  365.     /* Enable Prefetch Buffer */
  366.     FLASH_PrefetchBufferCmd(FLASH_PrefetchBuffer_Enable);

  368.     /* PLLCLK = 8MHz * 9 = 72 MHz */
  369.     RCC_PLLConfig(RCC_PLLSource_HSE_Div1, RCC_PLLMul_9);

  371.     /* Enable PLL */
  372.     RCC_PLLCmd(ENABLE);

  374.     /* Wait till PLL is ready */
  375.     while(RCC_GetFlagStatus(RCC_FLAG_PLLRDY) == RESET)
  376.     {
  377.     }

  379.     /* Select PLL as system clock source */
  380.     RCC_SYSCLKConfig(RCC_SYSCLKSource_PLLCLK);

  382.     /* Wait till PLL is used as system clock source */
  383.     while(RCC_GetSYSCLKSource() != 0x08)
  384.     {
  385.     }
  386.   }
  387.    /* Enable GPIOA, GPIOB, GPIOC, GPIOD, GPIOE, GPIOF, GPIOG and AFIO clocks */
  388.     RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_GPIOB , ENABLE);
  389.         RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC | RCC_APB2Periph_GPIOD , ENABLE);
  390.         RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOE | RCC_APB2Periph_GPIOF , ENABLE);
  391.         RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOG | RCC_APB2Periph_AFIO  , ENABLE);  
  392. }

  394. /*
  395. ********************************************************************************
  396. ** 函数名称 ： GPIO_Configuration(void)
  397. ** 函数功能 ： 端口初始化
  398. ** 输    入        ： 无
  399. ** 输    出        ： 无
  400. ** 返    回        ： 无
  401. ********************************************************************************
  402. */
  403. void GPIO_Configuration(void)                                                                        //串口端口初始化
  404. {
  405.   GPIO_InitTypeDef GPIO_InitStructure;
  406.   RCC_APB2PeriphClockCmd( RCC_APB2Periph_GPIOA | RCC_APB2Periph_GPIOB | RCC_APB2Periph_GPIOC | RCC_APB2Periph_GPIOD, ENABLE  );
  407.    /* Configure USART1 Tx (PA.09) as alternate function push-pull */
  408.   GPIO_InitStructure.GPIO_Pin = GPIO_Pin_9;                                 //        选中管脚9
  409.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;                 // 复用推挽输出
  410.   GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;                 // 最高输出速率50MHz
  411.   GPIO_Init(GPIOA, &GPIO_InitStructure);                                 // 选择A端口
  412.    
  413.   /* Configure USART1 Rx (PA.10) as input floating */
  414.   GPIO_InitStructure.GPIO_Pin = GPIO_Pin_10;                          //选中管脚10
  415.   GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;          //浮空输入
  416.   GPIO_Init(GPIOA, &GPIO_InitStructure);                                  //选择A端口

  418. }

  420. /*
  421. ********************************************************************************
  422. ** 函数名称 ： USART1_Configuration(void)
  423. ** 函数功能 ： 串口1初始化
  424. ** 输    入        ： 无
  425. ** 输    出        ： 无
  426. ** 返    回        ： 无
  427. ********************************************************************************
  428. */
  429. void USART1_Configuration(void)
  430. {
  431. USART_InitTypeDef USART_InitStructure;
  432. USART_ClockInitTypeDef  USART_ClockInitStructure;

  434. RCC_APB2PeriphClockCmd(RCC_APB2Periph_TIM1 |RCC_APB2Periph_USART1, ENABLE  );

  436. USART_ClockInitStructure.USART_Clock = USART_Clock_Disable;                        // 时钟低电平活动
  437. USART_ClockInitStructure.USART_CPOL = USART_CPOL_Low;                                // 时钟低电平
  438. USART_ClockInitStructure.USART_CPHA = USART_CPHA_2Edge;                                // 时钟第二个边沿进行数据捕获
  439. USART_ClockInitStructure.USART_LastBit = USART_LastBit_Disable;                // 最后一位数据的时钟脉冲不从SCLK输出
  440. /* Configure the USART1 synchronous paramters */
  441. USART_ClockInit(USART1, &USART_ClockInitStructure);                                        // 时钟参数初始化设置
  442.                                                                                                                                          
  443. USART_InitStructure.USART_BaudRate = 115200;                                                  // 波特率为：115200
  444. USART_InitStructure.USART_WordLength = USART_WordLength_8b;                          // 8位数据
  445. USART_InitStructure.USART_StopBits = USART_StopBits_1;                                  // 在帧结尾传输1个停止位
  446. USART_InitStructure.USART_Parity = USART_Parity_No ;                                  // 奇偶失能
  447. USART_InitStructure.USART_HardwareFlowControl = USART_HardwareFlowControl_None;        // 硬件流控制失能

  449. USART_InitStructure.USART_Mode = USART_Mode_Rx | USART_Mode_Tx;                  // 发送使能+接收使能
  450. /* Configure USART1 basic and asynchronous paramters */
  451. USART_Init(USART1, &USART_InitStructure);
  452.    
  453.   /* Enable USART1 */
  454. USART_ClearFlag(USART1, USART_IT_RXNE);                         //清中断，以免一启用中断后立即产生中断
  455. USART_ITConfig(USART1,USART_IT_RXNE, ENABLE);                //使能USART1中断源
  456. USART_Cmd(USART1, ENABLE);                                                        //USART1总开关：开启
  457. }

  459. /*
  460. ********************************************************************************
  461. ** 函数名称 ： NVIC_Configuration(void)
  462. ** 函数功能 ： 中断初始化
  463. ** 输    入        ： 无
  464. ** 输    出        ： 无
  465. ** 返    回        ： 无
  466. ********************************************************************************
  467. */
  468. void NVIC_Configuration(void)
  469. {
  470.   NVIC_InitTypeDef NVIC_InitStructure;  
  471.   NVIC_PriorityGroupConfig(NVIC_PriorityGroup_0);

  473.   NVIC_InitStructure.NVIC_IRQChannel = WWDG_IRQn;    //WWDG中断
  474.   NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0;
  475.   NVIC_Init(&NVIC_InitStructure);
  476. }

  478. /*
  479. ********************************************************************************
  480. ** 函数名称 ： WWDG_Configuration(void)
  481. ** 函数功能 ： 看门狗初始化
  482. ** 输    入        ： 无
  483. ** 输    出        ： 无
  484. ** 返    回        ： 无
  485. ********************************************************************************
  486. */
  487. void WWDG_Configuration(void)
  488. {
  489.   RCC_APB1PeriphClockCmd(RCC_APB1Periph_WWDG, ENABLE);        //   WWDG时钟使能
  490.   
  491.         WWDG_SetPrescaler(WWDG_Prescaler_8);                      //  WWDG clock counter = (PCLK1/4096)/8 = 244 Hz (~4 ms)  
  492.   
  493.         WWDG_SetWindowValue(0x41);                                 // Set Window value to 0x41
  494.   
  495.         WWDG_Enable(0x50);                       // Enable WWDG and set counter value to 0x7F, WWDG timeout = ~4 ms * 64 = 262 ms
  496.   
  497.         WWDG_ClearFlag();                               // Clear EWI flag
  498.        
  499.   WWDG_EnableIT();                               // Enable EW interrupt
  500. }

  502. /*
  503. ********************************************************************************
  504. ** 函数名称 ： Delay(vu32 nCount)
  505. ** 函数功能 ： 延时函数
  506. ** 输    入        ： 无
  507. ** 输    出        ： 无
  508. ** 返    回        ： 无
  509. ********************************************************************************
  510. */
  511. void Delay(vu32 nCount)
  512. {
  513.   for(; nCount != 0; nCount--);
  514. }

  516. /*
  517. ********************************************************************************
  518. ** 函数名称 ： void Delayms(vu32 m)
  519. ** 函数功能 ： 长延时函数         m=1,延时1ms
  520. ** 输    入        ： 无
  521. ** 输    出        ： 无
  522. ** 返    回        ： 无
  523. ********************************************************************************
  524. */
  525. void Delayms(vu32 m)
  526. {
  527.   u32 i;
  528.   
  529.   for(; m != 0; m--)       
  530.        for (i=0; i<50000; i++);
  531. }

  533. /*
  534. ********************************************************************************
  535. ** 函数名称 ： WWDG_IRQHandler(void)
  536. ** 函数功能 ： 窗口提前唤醒中断
  537. ** 输    入        ： 无
  538. ** 输    出        ： 无
  539. ** 返    回        ： 无
  540. ********************************************************************************
  541. */

  543. void WWDG_IRQHandler(void)
  544. {
  545.   /* Update WWDG counter */
  546.   WWDG_SetCounter(0x50);
  547.        
  548.   /* Clear EWI flag */
  549.   WWDG_ClearFlag();
  550. }
  551. //************************************************
  552. void  USART1_SendData(uchar SendData)
  553. {
  554. USART_SendData(USART1, SendData);
  555. Delayms(1);
  556. }
  557. //初始化MPU6050，根据需要请参考pdf进行修改************************
  558. void Init_MPU6050(void)
  559. {
  560. /*
  561.    Single_Write(MPU6050_Addr,PWR_M, 0x80);   //
  562.    Single_Write(MPU6050_Addr,SMPL, 0x07);    //
  563.    Single_Write(MPU6050_Addr,DLPF, 0x1E);    //±2000°
  564.    Single_Write(MPU6050_Addr,INT_C, 0x00 );  //
  565.    Single_Write(MPU6050_Addr,PWR_M, 0x00);   //
  566. */
  567.   Single_Write(MPU6050_Addr,PWR_MGMT_1, 0x00);        //解除休眠状态
  568.         Single_Write(MPU6050_Addr,SMPLRT_DIV, 0x07);
  569.         Single_Write(MPU6050_Addr,CONFIG, 0x06);
  570.         Single_Write(MPU6050_Addr,GYRO_CONFIG, 0x18);
  571.         Single_Write(MPU6050_Addr,ACCEL_CONFIG, 0x01);
  572. }
  573.        
  574. //******读取MPU6050数据****************************************
  575. void READ_MPU6050(void)
  576. {
  577.         /*        读取陀螺仪数据                */
  578.         //***********************************************************
  579.    BUF0[0]=Single_Read(MPU6050_Addr,GYRO_XOUT_L);
  580.    BUF0[1]=Single_Read(MPU6050_Addr,GYRO_XOUT_H);
  581.    G_X =        (BUF0[1]<<8)|BUF0[0];
  582.    G_X =(double)G_X*250/327.68;                                                    //读取计算X轴数据

  584.    BUF0[2]=Single_Read(MPU6050_Addr,GYRO_YOUT_L);
  585.    BUF0[3]=Single_Read(MPU6050_Addr,GYRO_YOUT_H);
  586.    G_Y =        (BUF0[3]<<8)|BUF0[2];
  587.    G_Y =(double)G_Y*250/327.68;                                                    //读取计算Y轴数据
  588.        
  589.    BUF0[4]=Single_Read(MPU6050_Addr,GYRO_ZOUT_L);
  590.    BUF0[5]=Single_Read(MPU6050_Addr,GYRO_ZOUT_H);
  591.    G_Z =        (BUF0[5]<<8)|BUF0[4];
  592.    G_Z =(double)G_Z*250/327.68;                                                //读取计算Z轴数据

  594.    BUF0[6]=Single_Read(MPU6050_Addr,TEMP_OUT_L);
  595.    BUF0[7]=Single_Read(MPU6050_Addr,TEMP_OUT_H);
  596.    T_T =(BUF0[7]<<8)|BUF0[6];
  597.    T_T =(((double) (T_T + 13200)) / 280)-39;// 读取计算出温度
  598.        
  599.         //ACCEL_ZOUT_L
  600.         //*************************************************************
  601.                 /*        读取加速度数据                */
  602.         //***********************************************************
  603.    BUF1[0]=Single_Read(MPU6050_Addr,ACCEL_XOUT_L);
  604.    BUF1[1]=Single_Read(MPU6050_Addr,ACCEL_XOUT_H);
  605.    A_X =        (BUF1[1]<<8)|BUF1[0];
  606.    A_X = (double)A_X/163.84;                                                    //读取计算X轴数据

  608.    BUF1[2]=Single_Read(MPU6050_Addr,ACCEL_YOUT_L);
  609.    BUF1[3]=Single_Read(MPU6050_Addr,ACCEL_YOUT_H);
  610.    A_Y =        (BUF1[3]<<8)|BUF1[2];
  611.    A_Y = (double)A_Y/163.84;                                                    //读取计算Y轴数据
  612.        
  613.    BUF1[4]=Single_Read(MPU6050_Addr,ACCEL_ZOUT_L);
  614.    BUF1[5]=Single_Read(MPU6050_Addr,ACCEL_ZOUT_H);
  615.    A_Z =        (BUF1[5]<<8)|BUF1[4];
  616.    A_Z = (double)A_Z/163.84;                                                //读取计算Z轴数据
  617.         //*************************************************************
  618. }
  619. //********串口发送数据***************************************
  620. void Send_data(uchar axis)
  621. {uchar i;
  622.   USART1_SendData(axis);
  623.   USART1_SendData(':');
  624.   for(i=0;i<4;i++)USART1_SendData(TX_DATA[i]);
  625.   USART1_SendData(' ');
  626.   USART1_SendData(' ');
  627. }

  629.   /*
  630. ********************************************************************************
  631. ** 函数名称 ： main(void)
  632. ** 函数功能 ： 主函数
  633. ** 输    入        ： 无
  634. ** 输    出        ： 无
  635. ** 返    回        ： 无
  636. ********************************************************************************
  637. */
  638. int main(void)
  639. {
  640.   RCC_Configuration();                 //配置RCC
  641.   GPIO_Configuration();                 //配置GPIO
  642.   USART1_Configuration();         //配置串口1
  643.   I2C_GPIO_Config();                 //配置IIC使用端口
  644.   Delayms(10);                                 //延时
  645.   Init_MPU6050();                     //初始化MPU6050
  646.   while(1)
  647. {
  648.         READ_MPU6050();                 //读取MPU6050数据
  649. //输出陀螺仪
  650.          printf("Gyroscope: ");
  651.   DATA_printf(TX_DATA,G_X);//转换X轴数据到数组
  652.         Send_data('X');                         //发送X轴数
  653.         DATA_printf(TX_DATA,G_Y);//转换Y轴数据到数组
  654.         Send_data('Y');                         //发送Y轴数
  655.         DATA_printf(TX_DATA,G_Z);//转换Z轴数据到数组
  656.         Send_data('Z');                         //发送Z轴数
  657.         DATA_printf(TX_DATA,T_T);//转换温度数据到数组
  658.         Send_data('T');                         //发送温度数据
  659.         USART1_SendData(0X0D);         //换行
  660.         USART1_SendData(0X0A);         //回车
  661. //输出加速度
  662.          printf("Acceleration: ");
  663.   DATA_printf(TX_DATA,A_X);//转换X轴数据到数组
  664.         Send_data('X');                         //发送X轴数
  665.         DATA_printf(TX_DATA,A_Y);//转换Y轴数据到数组
  666.         Send_data('Y');                         //发送Y轴数
  667.         DATA_printf(TX_DATA,A_Z);//转换Z轴数据到数组
  668.         Send_data('Z');                         //发送Z轴数

  670.         USART1_SendData(0X0D);         //换行
  671.         USART1_SendData(0X0A);         //回车
  672.         USART1_SendData(0X0A);       
  673.         USART1_SendData(0X0A);       
  674.         Delayms(100);
  675.   }
  676. }

  678. /*************结束***************/
复制代码

所有资料51hei提供下载:
九轴姿态传感器STM32F103C8T6串口程序.rar (298.14 KB, 下载次数: 561)

评分

参与人数 1黑币 +50 收起 理由
admin + 50 共享资料的黑币奖励！

查看全部评分

回复

使用道具 举报

ID:260931 发表于 2018-5-18 08:47 | 显示全部楼层
我去赚黑币先，等下再下你！
回复

使用道具 举报

ID:336631 发表于 2018-5-23 16:52 | 显示全部楼层
很给力哦
回复

使用道具 举报

ID:400671 发表于 2018-9-20 22:14 | 显示全部楼层
我去赚黑币先，等下再下你！
回复

使用道具 举报

ID:225515 发表于 2018-11-19 22:50 | 显示全部楼层
很不错~~~
回复

使用道具 举报

ID:225515 发表于 2018-11-19 22:50 | 显示全部楼层
很好的资源，刚刚好需要用到，楼主牛逼
回复

使用道具 举报

ID:225515 发表于 2018-11-19 22:50 | 显示全部楼层
刚刚好需要用到，楼主牛逼，找了很久在这里找到；
回复

使用道具 举报

ID:380922 发表于 2019-1-14 13:46 | 显示全部楼层
楼主牛逼！，不过这好像是直接用模拟IIC读MPU的原始数据吧，没经过DMP处理吧，角度那好像不太对
回复

使用道具 举报

ID:378985 发表于 2019-1-23 10:02 | 显示全部楼层
楼主牛逼，完全好用，100分！
回复

使用道具 举报

ID:170847 发表于 2019-4-29 17:27 | 显示全部楼层
为毛我烧进去没反应，接口都是对应的
回复

使用道具 举报

ID:301268 发表于 2019-5-10 18:34 | 显示全部楼层
很有用，感谢楼主
回复

使用道具 举报

ID:301268 发表于 2019-5-10 18:37 | 显示全部楼层
先去赚取黑币，希望楼主给的程序有用
回复

使用道具 举报

ID:301268 发表于 2019-5-15 15:12 | 显示全部楼层
烧录后没有显示啊，不太行啊
回复

使用道具 举报

ID:466188 发表于 2019-5-16 15:46 | 显示全部楼层
为什么传回来的是一些符号呢？
回复

使用道具 举报

ID:397670 发表于 2019-5-22 15:02 | 显示全部楼层
很不错
回复

使用道具 举报

ID:543896 发表于 2019-5-22 22:04 | 显示全部楼层
这个论坛还有基本上一样的，格式都一样，http://www.51hei.com/bbs/dpj-29287-1.html  不知道是谁抄袭谁的，居然只改动了一下标识，抄袭的人可耻呀。
回复

使用道具 举报

ID:490640 发表于 2019-7-19 23:06 | 显示全部楼层
角度怎么计算！！角度怎么计算！！角度怎么计算！！角度怎么计算！！感谢楼主，学习学习！！
回复

使用道具 举报

ID:260931 发表于 2019-9-17 08:10 | 显示全部楼层
谢谢楼主分享
回复

使用道具 举报

ID:457185 发表于 2019-11-12 17:25 | 显示全部楼层
参考一下，现在还在嫌九轴陀螺仪太贵了
回复

使用道具 举报

ID:359272 发表于 2019-11-13 08:01 | 显示全部楼层
多谢分享
回复

使用道具 举报

ID:380802 发表于 2019-12-26 01:48 | 显示全部楼层
很好的资源，感谢楼主
回复

使用道具 举报

ID:660878 发表于 2019-12-27 14:11 | 显示全部楼层
学习了谢谢楼主
回复

使用道具 举报

ID:569027 发表于 2020-1-10 09:34 | 显示全部楼层
我测试过了，非常好用！谢谢你真样的做学问的人
回复

使用道具 举报

ID:407977 发表于 2020-6-7 10:07 | 显示全部楼层
刚刚试了，很好用。
回复

使用道具 举报

ID:881974 发表于 2021-3-31 08:09 | 显示全部楼层
为什么我试就不行
回复

使用道具 举报

ID:90970 发表于 2021-4-8 11:49 | 显示全部楼层
6050是九轴的么？不是吧
回复

使用道具 举报

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

本版积分规则

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

Powered by 单片机教程网

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