找回密碼
 立即注冊(cè)

QQ登錄

只需一步，快速開(kāi)始

搜索
查看: 2629|回復(fù): 1
打印 上一主題 下一主題
收起左側(cè)

STM32控制舵機(jī)運(yùn)轉(zhuǎn),代碼如下

[復(fù)制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
ID:564334 發(fā)表于 2022-3-29 13:24 | 只看該作者 回帖獎(jiǎng)勵(lì) |倒序?yàn)g覽 |閱讀模式
  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. // 儲(chǔ)存OPENCV發(fā)送來(lái)的數(shù)據(jù)
  30. u16 Res;
  31. int main(void)
  32. {
  33.         /*延時(shí)函數(shù)初始化*/
  34.         delay_init();
  35.         
  36.         /* 設(shè)置中斷優(yōu)先級(jí)分組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)入一次定時(shí)器中斷，更新當(dāng)前電機(jī)速度*/
  52.         TIM6_Int_Init(99,7199);
  53.         
  54.         /*初始化編碼器 */
  55.         Encoder_Init_TIM2();            
  56.         
  57.         /*舵機(jī)定時(shí)器初始化 50HZ范圍1750-1950*/
  58.         TIM3_PWM_Init(1999,719);
  59.         
  60.         /*初始化TIM1 PWM 10KHZ，用于驅(qū)動(dòng)電機(jī) */
  61.         TIM4_PWM_Init(7199,0);
  62.         
  63.         /*200hz的計(jì)數(shù)頻率,每5ms進(jìn)入一次定時(shí)器中斷：中斷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ī)云臺(tái)位置設(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)

評(píng)分

參與人數(shù) 1黑幣 +10 收起 理由
admin + 10 共享資料的黑幣獎(jiǎng)勵(lì)！

查看全部評(píng)分

分享到:  QQ好友和群QQ好友和群 QQ空間QQ空間 騰訊微博騰訊微博 騰訊朋友騰訊朋友
收藏收藏 分享淘帖 頂頂 踩踩
回復(fù)

使用道具 舉報(bào)

沙發(fā)
ID:835435 發(fā)表于 2022-4-17 17:04 | 只看該作者
f幾的板子啊
回復(fù)

使用道具 舉報(bào)

本版積分規(guī)則

手機(jī)版|小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術(shù)交流QQ群281945664

Powered by 單片機(jī)教程網(wǎng)

快速回復(fù) 返回頂部 返回列表