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

標題: STM32F103風力擺系統程序,陀螺儀使用基于DMP的MPU6050可自行增加卡爾曼濾波 [打印本頁]
作者: 超大俠    時間: 2023-11-21 17:01
標題: STM32F103風力擺系統程序,陀螺儀使用基于DMP的MPU6050可自行增加卡爾曼濾波
基于STM32F103的風力擺系統，陀螺儀使用基于DMP的MPU6050可自行增加卡爾曼濾波

單片機源程序如下:
  1. #include "sys.h"       
  2. #include "delay.h"       
  3. #include "key.h"   
  4. #include "mpu6050.h"  
  5. #include "inv_mpu.h"
  6. #include "inv_mpu_dmp_motion_driver.h"
  7. #include "USART2.h"
  8. #include "pwm.h"
  9. #include "PID.h"
  10. #include "TIM.h"
  11. #include "KEY.h"
  12. #include "outputdata.h"

  14. u8 RUN_MODE=0;
  15. u8 Print=0;

  17. float pitch,roll,yaw;                 //歐拉角
  18. short aacx,aacy,aacz;                //加速度傳感器原始數據
  19. short gyrox,gyroy,gyroz;        //陀螺儀原始數據
  20. Pid_struct motor13_parameter,motor24_parameter;  // 電機pid參數

  22. void NVIC_Config(void);

  24. int main(void)
  25. {
  26.           short temp;                                        //溫度            
  27.           
  28.                 SystemInit();
  29.                 NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);
  30.     NVIC_Config();
  31.            delay_init();                     //延時函數初始化       
  32.     PWM_Init(3000,0);    //0分頻。PWM頻率=72000/(4000*1)=14Khz
  33.     PWM_Init_2(3000,0);   
  34.     USART1_Config();   
  35.     KEY_Init();   

  37.    Speed_PIDInit(&motor13_parameter,30,0.2,100);   // 電機pid 參數初始化
  38.          Speed_PIDInit(&motor24_parameter,60,0.2,200);
  39.        
  40.          MPU_Init();               
  41.    delay_ms(500);   
  42.    while(mpu_dmp_init());   //初始化MPU6050_DMP
  43.      
  44.    TIM4_Init(10000-1,71);   //定時器初始化
  45.    uprintf(USART1," 系統啟動成功!\r\n");
  46.          
  47. while(1)
  48. {               
  49.    //           MPU_Get_Accelerometer(&aacx,&aacy,&aacz);        //得到加速度傳感器數據
  50.    //    MPU_Get_Gyroscope(&gyrox,&gyroy,&gyroz);        //得到陀螺儀數據   
  51.   KEY_Scan();
  52.   if(Print==1){   // 發送曲線到上位機
  53.    
  54.      OutData[0]=pitch;
  55.      OutData[1]=roll;
  56.      OutData[2]= motor13_parameter.out_duty/100;         
  57.      OutPut_Data();
  58. }          }         }


  61. void NVIC_Config(void)
  62. {
  63.          
  64.    
  65.          NVIC_InitTypeDef NVIC_InitStructure;                                          //復位NVIC寄存器為默認值       
  66.      NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);           //設置中斷優先級組

  68.         RCC_APB2PeriphClockCmd(   RCC_APB2Periph_GPIOA
  69.                                                         | RCC_APB2Periph_GPIOB
  70.                                                             | RCC_APB2Periph_GPIOC
  71.          //   | RCC_APB2Periph_GPIOD
  72.                                         //        | RCC_APB2Periph_AFIO
  73.                                                         | RCC_APB2Periph_TIM1
  74.                                   //        | RCC_APB2Periph_ADC1
  75.               | RCC_APB2Periph_USART1
  76.                                                         , ENABLE );

  78.         RCC_APB1PeriphClockCmd( RCC_APB1Periph_TIM3
  79.                                                         | RCC_APB1Periph_TIM4
  80.               | RCC_APB1Periph_TIM2
  81.                                                         , ENABLE);
  82.       
  83.    
  84.               //復位NVIC寄存器為默認值          
  85.     NVIC_InitStructure.NVIC_IRQChannel = TIM4_IRQn;       
  86.           NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 1;   //搶占優先級2
  87.     NVIC_InitStructure.NVIC_IRQChannelSubPriority = 1;              //響應優先級0
  88.           NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;                   
  89.           NVIC_Init(&NVIC_InitStructure);
  90.    
  91.     NVIC_InitStructure.NVIC_IRQChannel = USART1_IRQn;
  92.     NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority =0;
  93.                 NVIC_InitStructure.NVIC_IRQChannelSubPriority =0;
  94.     NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
  95.     NVIC_Init(&NVIC_InitStructure);
  96. }

復制代碼

原理圖: 無
仿真: 無
代碼: MPU6050_DMP_Stm32.7z (289.75 KB, 下載次數: 18)




歡迎光臨 (http://www.zg4o1577.cn/bbs/) Powered by Discuz! X3.1
主站蜘蛛池模板： 亚洲精品欧美一区二区三区 | 国产精品久久久久久久久久久久冷 | 亚洲精品乱码久久久久v最新版 | aa级毛片毛片免费观看久 | 特级毛片www| 亚洲精品视频在线 | 天堂男人av| 伊人免费观看视频 | 成人一区二区电影 | 国产成人自拍av | 欧美久久久网站 | 欧美激情一区二区三区 | 91免费观看国产 | 欧美日韩精品区 | 亚洲一区免费 | 国产日韩欧美在线 | 国产精品视频久久久久久 | 欧美一级高潮片免费的 | 欧美一级黄视频 | 久久亚洲春色中文字幕久久久 | 97久久久久久 | 超碰成人免费 | 久久新视频 | 国产精品一码二码三码在线 | 国产精品亚洲视频 | 蜜臀网 | 在线免费观看黄视频 | 成人亚洲一区 | 精品欧美乱码久久久久久 | 欧美xxxx性xxxxx高清 | 久久久成人一区二区免费影院 | jlzzxxxx18hd护士 | 日韩精品成人一区二区三区视频 | 夜夜草av | 亚洲精品99久久久久久 | 免费成人高清在线视频 | 亚洲一区二区中文字幕在线观看 | 干干干日日日 | 欧美性乱| 涩涩导航 | 亚洲成人av |