欧美极品高清xxxxhd,国产日产欧美最新,无码AV国产东京热AV无码,国产精品人与动性XXX,国产传媒亚洲综合一区二区,四库影院永久国产精品,毛片免费免费高清视频,福利所导航夜趣136

標題: STM32解析MPU6050源程序 [打印本頁]
作者: CNT    時間: 2017-7-27 17:10
標題: STM32解析MPU6050源程序
使用STM32 MPU6050編寫的程序

單片機源程序如下:
  1. #include "stm32f10x.h"
  2. #include "delay.h"
  3. #include "sys.h"
  4. #include "usart.h"
  5. #include "MY_time_Conf.h"
  6. //#include "uart_1.h"
  7. //#include "dma.h"
  8. //#include "RS485.h"
  9. //#include "74hc595.h"
  10. #include "string.h"

  12. /**************************
  13. 模板配置信息：
  14. 選用芯片是 stm32f103vc
  15. 啟動信息：stm32f10x_hd.s
  16. 固件庫：stm32固件庫v3.5
  17. ***************************/

  19. #define led_PB12   PBout(12)           //位綁定，位定義PB12口作為LED輸出。這樣速度最快
  20. //#define led_PB1   PBout(1)           //位綁定，位定義PB1口作為LED輸出。這樣速度最快
  21. //#define PA9   PAout(10)
  22. //#define CLK1   PDout(0)
  23. //#define CWW1   PDout(1)
  24. //#define CLK2   PDout(2)
  25. //#define CWW2   PDout(3)


  28. //uint8_t i = 0;    //測試用

  30. float a[3],w[3],angle[3],T;
  31. extern unsigned char Re_buf[11],temp_buf[11],counter;
  32. extern unsigned char sign;

  34. /*************************************************
  35. 函數: int main(void)
  36. 功能: main主函數
  37. 參數: 無
  38. 返回: 無
  39. **************************************************/

  41. int main(void)
  42. {
  43.    unsigned char Temp[11];
  44.    //u8 i;

  46.    RCC_Configuration();      //初始化時鐘
  47.    GPIO_Configuration();      //初始化IO端口
  48.    delay_init(72);            //初始化延時函數
  49.    NVIC_Configuration();      //中斷優先級初始化

  51.    USART1_Config();   //初始化 配置USART1
  52.    USART2_Config();   //初始化 配置USART2 （用于接收MPU6050數據）
  53.    
  54.    delay_ms(200);
  55.       
  56.    while (1)
  57.    {
  58.       if(sign)
  59.       {  
  60.          memcpy(Temp,Re_buf,11);
  61.          sign=0;
  62.          if(Re_buf[0]==0x55)       //檢查幀頭
  63.          {  
  64.             switch(Re_buf[1])
  65.             {
  66.                case 0x51: //標識這個包是加速度包
  67.                   a[0] = ((short)(Temp[3]<<8 | Temp[2]))/32768.0*16;      //X軸加速度
  68.                   a[1] = ((short)(Temp[5]<<8 | Temp[4]))/32768.0*16;      //Y軸加速度
  69.                   a[2] = ((short)(Temp[7]<<8 | Temp[6]))/32768.0*16;      //Z軸加速度
  70.                   T    = ((short)(Temp[9]<<8 | Temp[8]))/340.0+36.25;      //溫度
  71.                   break;
  72.                case 0x52: //標識這個包是角速度包
  73.                   w[0] = ((short)(Temp[3]<<8| Temp[2]))/32768.0*2000;      //X軸角速度
  74.                   w[1] = ((short)(Temp[5]<<8| Temp[4]))/32768.0*2000;      //Y軸角速度
  75.                   w[2] = ((short)(Temp[7]<<8| Temp[6]))/32768.0*2000;      //Z軸角速度
  76.                   T    = ((short)(Temp[9]<<8| Temp[8]))/340.0+36.25;      //溫度
  77.                   break;
  78.                case 0x53: //標識這個包是角度包
  79.                   angle[0] = ((short)(Temp[3]<<8| Temp[2]))/32768.0*180;   //X軸滾轉角（x 軸）
  80.                   angle[1] = ((short)(Temp[5]<<8| Temp[4]))/32768.0*180;   //Y軸俯仰角（y 軸）
  81.                   angle[2] = ((short)(Temp[7]<<8| Temp[6]))/32768.0*180;   //Z軸偏航角（z 軸）
  82.                   T        = ((short)(Temp[9]<<8| Temp[8]))/340.0+36.25;   //溫度

  84.                   //printf("X軸角度：%.2f   Y軸角度：%.2f   Z軸角度：%.2f\r\n",angle[0],angle[1],angle[2]);
  85.                   break;
  86.                default:  break;
  87.             }
  88.                         printf("X角度：%.2f  Y角度：%.2f  Z角度：%.2f  X速度：%.2f  Y速度：%.2f  Z速度：%.2f\r\n",angle[0],angle[1],angle[2],w[0],w[1],w[2]);
  89.          }
  90.          
  91.       }
  92.       delay_ms(50);
  93.    }
  94. }


  97. /*
  98. int main(void)
  99. {
  100.        
  101.         //u8 i;

  103.         RCC_Configuration();           //初始化時鐘
  104.         GPIO_Configuration();           //初始化IO端口
  105.         delay_init(72);                           //初始化延時函數
  106.         NVIC_Configuration();           //中斷優先級初始化

  108.         USART1_Config();   //初始化 配置USART1
  109.         USART2_Config();   //初始化 配置USART2 （用于接收MPU6050數據）
  110.        
  111.         delay_ms(200);

  113.                
  114.         while (1)
  115.         {
  116.                 if(sign)
  117.                 {  
  118.                         sign=0;
  119. //                        if(Re_buf[0]==0x55)       //檢查幀頭
  120. //                        {  
  121. //                                switch(Re_buf[1])
  122. //                                {
  123. //                                        case 0x51: //標識這個包是加速度包
  124. //                                                a[0] = ((short)(Re_buf[3]<<8 | Re_buf[2]))/32768.0*16;                //X軸加速度
  125. //                                                a[1] = ((short)(Re_buf[5]<<8 | Re_buf[4]))/32768.0*16;                //Y軸加速度
  126. //                                                a[2] = ((short)(Re_buf[7]<<8 | Re_buf[6]))/32768.0*16;                //Z軸加速度
  127. //                                                T    = ((short)(Re_buf[9]<<8 | Re_buf[8]))/340.0+36.25;                //溫度
  128. //                                                break;
  129. //                                        case 0x52: //標識這個包是角速度包
  130. //                                                w[0] = ((short)(Re_buf[3]<<8| Re_buf[2]))/32768.0*2000;                //X軸角速度
  131. //                                                w[1] = ((short)(Re_buf[5]<<8| Re_buf[4]))/32768.0*2000;                //Y軸角速度
  132. //                                                w[2] = ((short)(Re_buf[7]<<8| Re_buf[6]))/32768.0*2000;                //Z軸角速度
  133. //                                                T    = ((short)(Re_buf[9]<<8| Re_buf[8]))/340.0+36.25;                //溫度
  134. //                                                break;
  135. //                                        case 0x53: //標識這個包是角度包
  136. //                                                angle[0] = ((short)(Re_buf[3]<<8| Re_buf[2]))/32768.0*180;        //X軸滾轉角（x 軸）
  137. //                                                angle[1] = ((short)(Re_buf[5]<<8| Re_buf[4]))/32768.0*180;        //Y軸俯仰角（y 軸）
  138. //                                                angle[2] = ((short)(Re_buf[7]<<8| Re_buf[6]))/32768.0*180;        //Z軸偏航角（z 軸）
  139. //                                                T        = ((short)(Re_buf[9]<<8| Re_buf[8]))/340.0+36.25;        //溫度
  140. //
  141. //                                                //printf("X軸角度：%.2f   Y軸角度：%.2f   Z軸角度：%.2f\r\n",angle[0],angle[1],angle[2]);
  142. //                                                printf("%.2f   %.2f   %.2f\r\n",angle[0],angle[1],angle[2]);
  143. //                                                break;
  144. //                                        default:  break;
  145. //                                }
  146. //                        }
  147.                         //printf("X角度：%.2f  Y角度：%.2f  Z角度：%.2f  X速度：%.2f  Y速度：%.2f  Z速度：%.2f\r\n",angle[0],angle[1],angle[2],w[0],w[1],w[2]);

  149. //                        if(temp_buf[0]==0x55)       //檢查幀頭
  150. //                        {  
  151. //                                temp_buf[0] = 0;
  152. //                                switch(temp_buf[1])
  153. //                                {
  154. //                                        case 0x51: //標識這個包是加速度包
  155. //                                                a[0] = ((short)(temp_buf[3]<<8 | temp_buf[2]))/32768.0*16;                //X軸加速度
  156. //                                                a[1] = ((short)(temp_buf[5]<<8 | temp_buf[4]))/32768.0*16;                //Y軸加速度
  157. //                                                a[2] = ((short)(temp_buf[7]<<8 | temp_buf[6]))/32768.0*16;                //Z軸加速度
  158. //                                                T    = ((short)(temp_buf[9]<<8 | temp_buf[8]))/340.0+36.25;                //溫度
  159. //                                                break;
  160. //                                        case 0x52: //標識這個包是角速度包
  161. //                                                w[0] = ((short)(temp_buf[3]<<8| temp_buf[2]))/32768.0*2000;                //X軸角速度
  162. //                                                w[1] = ((short)(temp_buf[5]<<8| temp_buf[4]))/32768.0*2000;                //Y軸角速度
  163. ……………………

  165. …………限于本文篇幅 余下代碼請從51黑下載附件…………
復制代碼

所有資料51hei提供下載:
STM32解析MPU6050.zip (386.78 KB, 下載次數: 19)







歡迎光臨 (http://www.raoushi.com/bbs/) Powered by Discuz! X3.1