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

 找回密碼
 立即注冊

QQ登錄

只需一步,快速開始

搜索
查看: 2892|回復: 1
打印 上一主題 下一主題
收起左側

STM32控制舵機運轉,代碼如下

[復制鏈接]
跳轉到指定樓層
樓主
ID:564334 發表于 2022-3-29 13:24 | 只看該作者 回帖獎勵 |倒序瀏覽 |閱讀模式
  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. /************************************************

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

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

  67.         TIM_SetCompare1 (TIM3,1850); //初始將舵機云臺位置設置在中間
  68.         TIM_SetCompare2 (TIM3,1825);
  69.         
  70.         
  71.         OLED_Fill(0, 0, 128, 63, 0);
  72.         Display_OLEDMenu();
  73.         while (1)
  74.         {        
  75.                 MenuReflash();
  76.         }
  77. }
復制代碼

Keil代碼下載: 單片機程序V1.2.7z (217.74 KB, 下載次數: 40)

評分

參與人數 1黑幣 +10 收起 理由
admin + 10 共享資料的黑幣獎勵!

查看全部評分

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

使用道具 舉報

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

使用道具 舉報

您需要登錄后才可以回帖 登錄 | 立即注冊

本版積分規則

小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術交流QQ群281945664

Powered by 單片機教程網

快速回復 返回頂部 返回列表