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

標題: STM32智能小車路徑閉環PID算法源碼 省賽一等獎作品 [打印本頁]
作者: ZYNG    時間: 2019-1-18 23:45
標題: STM32智能小車路徑閉環PID算法源碼 省賽一等獎作品
希望給做智能小車的朋友一點點幫助，里面包含工程文件模板基于STM32F103ZET6芯片、encoder編碼器、串口數據讀取、PID閉環控制、乃至一點尋跡PID思路，該尋跡PID為本作者原創，算法完成以后，不需要任何費時的調試，模塊化完成之后即可在95%穩定性（測試之后）尋跡，因此上屆省賽我以第三的成績出線（一等獎）。

單片機源程序如下:
  1. #include "delay.h"
  2. #include "sys.h"
  3. #include "usart.h"
  4. #include "encoder.h"
  5. #include "stm32f10x.h"
  6. #include "pid.h"
  7. #include "PWM.h"
  8. #include "key.h"


  11. int u=2;
  12. int main(void)
  13. {               
  14.         delay_init();                     //延時函數初始化          
  15.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2); //設置NVIC中斷分組2:2位搶占優先級，2位響應優先級
  16.         uart_init(115200);         //串口初始化為115200         
  17.   TIM8_Configuration();//pwm
  18.         KEY_Init();
  19.         while(1)
  20.         {
  21.         int p=1;
  22.         if(p!=GPIO_ReadInputDataBit(GPIOE,GPIO_Pin_4))
  23.         {delay_ms(10);
  24.         if(p!=GPIO_ReadInputDataBit(GPIOE,GPIO_Pin_4))
  25.         {u++;
  26.                 delay_ms(500);
  27.         }
  28.        
  29.        
  30.         printf("%d\r\n",0);
  31. //        while(1)
  32. //        { jisuan_2();
  33. //           jisuan_();}
  34.         }         
  35. }

  37. }
復制代碼
pid.c
  1. #include "pid.h"
  2. #include "encoder.h"
  3. #include "stm32f10x.h"


  6. int V_encoder_TIM3(void)//1電機速度計算 轉/秒
  7. {
  8.         int cnt1;
  9.         cnt1=((int16_t)TIM3->CNT);
  10.         TIM3->CNT=0;
  11.         return cnt1;
  12. }


  15. int User_PidSpeedControl1(float SpeedTag)
  16. {
  17. float control1=0;
  18. float kp=450;   
  19. float ki=1;   
  20. float kd=1;
  21. float errILim=999;
  22. float errNow;
  23. float errOld=0;
  24. float errP=0;
  25. float errI=0;
  26. float errD=0;
  27. float spdNow1;
  28. float s;
  29. spdNow1=s;
  30. errNow =SpeedTag*1.1 - spdNow1;
  31. errP=errNow;
  32. errI+=errNow;
  33. if(errILim != 0)       
  34. {
  35.   if(errI >=  errILim)    errI =  errILim;
  36.   else if(errI <= -errILim)   errI = -errILim;
  37. }
  38. errD= errNow - errOld;
  39. errOld = errNow;       
  40. control1= kp * errP + ki * errI + kd * errD;

  42.    if(control1 >= 1000)  control1 =   1000-1 ;//上限 CCR的值必須小于或等于ARR的值
  43.          if(control1 <=-1000)  control1 = -(1000-1);//下限


  46.          if(control1>=0.0) { GPIO_SetBits(GPIOC,GPIO_Pin_4);         GPIO_ResetBits(GPIOC,GPIO_Pin_5);  }
  47.          else {GPIO_SetBits(GPIOC,GPIO_Pin_5);         GPIO_ResetBits(GPIOC,GPIO_Pin_4);}
  48.          if(control1 <0)  control1 =-control1;//下限  
  49.          
  50.          if(s<=0.1&&s>=-0.1&&SpeedTag==0)TIM_SetCompare1(TIM8,0);
  51.    else TIM_SetCompare1(TIM8,control1);//放入PWM
  52.          
  53.          
  54.          return (int)control1;
  55. }
復制代碼

所有資料51hei提供下載:
stm32三輪PID閉環算法.rar (282.03 KB, 下載次數: 308)


作者: ZZH3    時間: 2019-7-16 17:15
頂一個
作者: aktuan007    時間: 2021-2-13 21:41
是什么比賽一等獎哦？



歡迎光臨 (http://www.zg4o1577.cn/bbs/) Powered by Discuz! X3.1
主站蜘蛛池模板： 欧美国产一区二区 | 久久精品国产精品青草 | 一区二区三区免费 | 亚洲成人一区 | 九九爱这里只有精品 | 在线观看黄色 | 欧美 日韩 国产 在线 | av网站在线看 | 久久久久一区二区三区 | 日韩精品无码一区二区三区 | 精品无码三级在线观看视频 | 国产精品高潮呻吟久久 | 国产精品久久久久无码av | 日韩欧美在 | 亚洲国产欧美在线 | 午夜小影院 | 色综合九九 | 国产精品视频一区二区三区 | 亚洲精品视频观看 | 亚洲一区久久久 | 9999精品视频 | 欧美国产精品一区二区三区 | 日韩av一区二区在线观看 | 国产一级在线视频 | 不卡一区| 精品三区 | 成人不卡视频 | 亚洲欧美精品久久 | 一区二区精品 | 久久久精品一区二区三区四季av | 日韩中文字幕一区二区三区 | 欧美日韩在线精品 | 日韩人体在线 | 国产精品无码久久久久 | jizz亚洲人 | 精品国产乱码久久久久久影片 | 国产精品一区二区免费 | 毛片在线视频 | 成人a在线 | 日本成人福利视频 | 欧美性大战久久久久久久蜜臀 |