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

標(biāo)題: STM32控制舵機(jī)運(yùn)轉(zhuǎn),代碼如下 [打印本頁]
作者: ldxxin    時間: 2022-3-29 13:24
標(biāo)題: STM32控制舵機(jī)運(yùn)轉(zhuǎn),代碼如下
  1. #include "led.h"
  2. #include "delay.h"
  3. #include "usart.h"
  4. #include "key.h"
  5. #include "sys.h"
  6. #include "oled.h"
  7. #include "menu.h"
  8. #include "encoder.h"
  9. #include "timer.h"
  10. #include "motor.h"
  11. #include "pid.h"
  12. /************************************************

  14. 功能加上串口通訊
  15.   x,下舵機(jī)(1750->1950)從右往左
  16.         y,上舵機(jī)(1750->1950)從上往下
  17. ************************************************/

  19. int x_pwm = 1850,y_pwm = 1825;
  20. // 初始化目標(biāo)值和小球的中心位置
  21. int x_face = 320, y_face = 240;
  22. int if_face=0;
  23. int x_face_store = 320, y_face_store = 240;
  24. int face_store=0;
  25. int x_target = 320, y_target = 240;
  26. // 上下舵機(jī)PID參數(shù)
  27. float x_KP = -0.00060,x_KI = 0.0007, x_KD = 0.002;
  28. float y_KP = -0.00060, y_KI = 0.0007, y_KD =0.002;
  29. // 儲存OPENCV發(fā)送來的數(shù)據(jù)
  30. u16 Res;
  31. int main(void)
  32. {
  33.         /*延時函數(shù)初始化*/
  34.         delay_init();
  35.         
  36.         /* 設(shè)置中斷優(yōu)先級分組2*/
  37.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);        
  38.         
  39.         /*串口初始化為115200*/
  40.         uart_init(115200);         
  41.         
  42.         /*LED初始化*/
  43.         LED_Init();
  44.         
  45.         /*KEY初始化*/
  46.         KEY_Init();
  47.         
  48.         /*OLED初始化*/
  49.         OLED_Init();        
  50.         
  51.         /*100hz的計(jì)數(shù)頻率，每10ms進(jìn)入一次定時器中斷，更新當(dāng)前電機(jī)速度*/
  52.         TIM6_Int_Init(99,7199);
  53.         
  54.         /*初始化編碼器 */
  55.         Encoder_Init_TIM2();            
  56.         
  57.         /*舵機(jī)定時器初始化 50HZ范圍1750-1950*/
  58.         TIM3_PWM_Init(1999,719);
  59.         
  60.         /*初始化TIM1 PWM 10KHZ，用于驅(qū)動電機(jī) */
  61.         TIM4_PWM_Init(7199,0);
  62.         
  63.         /*200hz的計(jì)數(shù)頻率,每5ms進(jìn)入一次定時器中斷：中斷PID賦值*/
  64.         TIM7_Int_Init(49,7199);
  65.         
  66.         AIN2=1;
  67.         AIN1=0;//初始將電機(jī)不轉(zhuǎn)
  68.         PWMA=0;

  70.         TIM_SetCompare1 (TIM3,1850); //初始將舵機(jī)云臺位置設(shè)置在中間
  71.         TIM_SetCompare2 (TIM3,1825);
  72.         
  73.         
  74.         OLED_Fill(0, 0, 128, 63, 0);
  75.         Display_OLEDMenu();
  76.         while (1)
  77.         {        
  78.                 MenuReflash();
  79.         }
  80. }
復(fù)制代碼

Keil代碼下載: 單片機(jī)程序V1.2.7z (217.74 KB, 下載次數(shù): 40)
作者: ht2020    時間: 2022-4-17 17:04
f幾的板子啊



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