久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

標題: mpu6050體感云臺 STM32源程序 [打印本頁]
作者: young962464    時間: 2020-10-12 11:07
標題: mpu6050體感云臺 STM32源程序
視頻鏈接：https://www.bilibili.com/video/BV1kv41117Bc

單片機源程序如下:
  1. /*
  2. 引腳定義
  3. MPU6050_PIN:  SCL:PB(10)  SDA:PB(11)
  4. OLED_PIN:     SCL:PA(5)   SDA:PA(4)
  5. ADC_PIN:       CH6:PA(2)   CH7:PA(3)   CH0:PA(0)   CH1:PA(1)
  6. LED_PIN:      LED1:PB(12) LED2:PB(13)
  7. KEY_PIN:      KEY:PA(8)
  8. PWM_PIN:      PA(6) PA(7) PB(0) PB(1)
  9. 作者：B站~保你江山半壁 UID:475029472
  10. 拿了我的的代碼還是給個三連吧！
  11. */

  13. #include "oled.h"
  14. #include "delay.h"
  15. #include "sys.h"
  16. #include "usart.h"
  17. #include "mpu6050.h"  
  18. #include "inv_mpu.h"
  19. #include "inv_mpu_dmp_motion_driver.h"
  20. #include "adc.h"
  21. #include "led.h"
  22. #include "key.h"
  23. #include "timer.h"

  25. u8 flag=1;
  26. extern u16 ADC_DMA_IN[4]; //聲明外部變量

  28. int main(void)
  29. {
  30.   char oledBuf[20];
  31.         float Pitch,Roll,Yaw;                 //歐拉角
  32.   LED_Init();
  33.         KEY_Init();
  34.         TIM3_PWM_Init(1999,719);                                                                //定時器3產生PWM初始化，裝載值1999，預分頻數719，周期20ms
  35.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);         //設置NVIC中斷分組2:2位搶占優先級，2位響應優先級
  36.         uart_init(115200);                 //串口初始化為115200
  37.         delay_init();        //延時初始化
  38.         ADC_Configuration();//       
  39.        
  40.         OLED_Init();
  41.         OLED_ColorTurn(0);//0正常顯示，1 反色顯示
  42.   OLED_DisplayTurn(0);//0正常顯示 1 屏幕翻轉顯示
  43.         OLED_Clear();
  44.        
  45.         LED_YON();
  46.                
  47.         while(1)
  48.         {
  49.                         if(KEY1 == 0)
  50.                         {
  51.                                
  52.                                 delay_ms(20);
  53.                                 if(KEY1 == 0)
  54.                                 {
  55.                                         flag=!flag;
  56.                                         LED1 =!LED1;
  57.                                         LED2 =!LED2;
  58.                                         OLED_Clear();
  59.                                         if(flag == 0)
  60.                                         {
  61.                                                         MPU_Init();                                        //初始化MPU6050
  62.                                                         mpu_dmp_init();
  63.                                         }
  64.                                         while(!KEY1);
  65.                                 }
  66.                         }
  67.                         if(flag == 1)
  68.                         {
  69.                                         sprintf(oledBuf,"YAO_GAN");
  70.                                         OLED_ShowString(32,0,(u8*)oledBuf,16);//OLED第一行
  71.                                   sprintf(oledBuf," YG_1  |  YG_2");
  72.                                         OLED_ShowString(0,16,(u8*)oledBuf,16);//OLED第二行
  73.                                         sprintf(oledBuf,"X:%4d | X:%4d",ADC_DMA_IN[0],ADC_DMA_IN[2]);
  74.                                         OLED_ShowString(0,32,(u8*)oledBuf,16);//OLED第三行
  75.                                         sprintf(oledBuf,"Y:%4d | Y:%4d",ADC_DMA_IN[1],ADC_DMA_IN[3]);
  76.                                         OLED_ShowString(0,48,(u8*)oledBuf,16);//OLED第四行
  77.                                         OLED_Refresh();
  78.                                   TIM_SetCompare1(TIM3,(int)((ADC_DMA_IN[0]*1000)/20475+50));
  79.                                   TIM_SetCompare2(TIM3,(int)((ADC_DMA_IN[1]*1000)/20475+50));
  80.                                   TIM_SetCompare3(TIM3,(int)((ADC_DMA_IN[2]*1000)/20475+50));
  81.                                   TIM_SetCompare4(TIM3,(int)((ADC_DMA_IN[3]*1000)/20475+50));
  82.                          }//(int)(((float)ADC_DMA_IN[0])/20.475+50)
  83.                         else
  84.                         {                                       
  85. //                                        delay_ms(2);
  86.                                         mpu_dmp_get_data(&Pitch,&Roll,&Yaw);                                       
  87.                                         sprintf(oledBuf,"MPU6050");
  88.                                         OLED_ShowString(32,0,(u8*)oledBuf,16);//OLED第一行
  89.                                         sprintf(oledBuf,"X:%.2f ",Pitch);
  90.                                         OLED_ShowString(0,16,(u8*)oledBuf,16);//OLED第二行
  91.                                         sprintf(oledBuf,"Y:%.2f ",Roll);
  92.                                         OLED_ShowString(0,32,(u8*)oledBuf,16);//OLED第三行
  93.                                         sprintf(oledBuf,"Z:%.2f ",Yaw);
  94.                                         OLED_ShowString(0,48,(u8*)oledBuf,16);//OLED第四 行
  95.                                         OLED_Refresh();
  96.                                   TIM_SetCompare2(TIM3,(int)((Roll+90)*10/9+50));
  97.                                   TIM_SetCompare3(TIM3,(int)((Pitch+90)*10/9+50));
  98.                                         TIM_SetCompare4(TIM3,(int)((Yaw+90)*10/9+50));  
  99.                         }                               

  101.                  
  102.         }        
  103. }

復制代碼

所有代碼51hei提供下載:
MPU6050_YG_CONTROL.7z (251.48 KB, 下載次數: 52)






歡迎光臨 (http://www.zg4o1577.cn/bbs/) Powered by Discuz! X3.1
主站蜘蛛池模板： 亚洲一区二区三区在线免费观看 | 日本成年免费网站 | 日韩视频在线播放 | 精品一区二区三区入口 | 99re在线 | 亚洲激情av | 欧美日本久久 | 亚洲免费在线 | 午夜寂寞网站 | 成人免费视频观看视频 | 久久无毛| 欧美亚洲国产日韩 | 天天操夜夜骑 | 欧美综合一区 | 精品国产伦一区二区三区观看说明 | a免费观看 | 九九热国产精品视频 | 一呦二呦三呦国产精品 | 中文字幕国产一区 | aacc678成免费人电影网站 | 婷婷在线免费 | 日本精品久久久一区二区三区 | 日韩在线一区二区 | 国产欧美一区二区三区在线看蜜臀 | 中文字幕日韩一区 | 国产一级片一区二区 | 成人午夜 | 人人草天天草 | 亚洲精品久久久9婷婷中文字幕 | 欧美久久一级特黄毛片 | 午夜丰满寂寞少妇精品 | 精品久草| 久久久精品综合 | 在线观看中文字幕 | 国产a区| 成人一区二区三区视频 | 天天天操天天天干 | 操操操av | 国产中文字幕网 | 国产成人精品区一区二区不卡 | 国产高清视频一区 |