標題: STM32 PID算法測試C語言程序?qū)崿F(xiàn) 0.96寸OLED顯示 [打印本頁]
作者: 小哦噢    時間: 2019-7-21 12:09
標題: STM32 PID算法測試C語言程序?qū)崿F(xiàn) 0.96寸OLED顯示


單片機源程序如下:
  1. #include "PID.h"

  3. /*以電機調(diào)速為例*/

  5. struct _pid{
  6.         float SetSpeed;       //設(shè)定值
  7.         float ActualSpeed;    //實際值
  8.         float err;            //偏差值
  9.         float err_last;       //上一個偏差值
  10.         float err_last_last;  //最上一個偏差值
  11.         float Kp, Ki, Kd;     //比例、積分、微分系數(shù)
  12. }pid;

  14. void PID_init()               //初始化
  15. {
  16.         pid.SetSpeed = 0.0;
  17.         pid.ActualSpeed = 0.0;
  18.         pid.err = 0.0;
  19.         pid.err_last = 0.0;
  20.         pid.err_last_last = 0.0;
  21.   pid.Kp = 0.2;               //可修改
  22.         pid.Ki = 0.015;             //可修改
  23.         pid.Kd = 0.2;               //可修改
  24. }

  26. float PID_realize(float Speed)
  27. {
  28.         float incrementSpeed;        //當前值
  29.         pid.SetSpeed = Speed;        //用戶設(shè)定值
  30.         pid.err = pid.SetSpeed - pid.ActualSpeed;   //偏差值
  31.         incrementSpeed =pid.Kp*(pid.err - pid.err_last) + pid.Ki*pid.err + pid.Kd*(pid.err - 2 * pid.err_last_last + pid.err_last);
  32.         pid.ActualSpeed += incrementSpeed;   //實際輸出值
  33.         pid.err_last = pid.err_last_last;
  34.         pid.err_last_last = pid.err;
  35.         return pid.ActualSpeed;
  36. }
復(fù)制代碼
  1. /**********************PID算法測試C語言實現(xiàn)**************************/

  3. //  0.96寸OLED顯示   IIC通訊
  4. //              --------------------
  5. //              GND   電源地
  6. //              VCC   接5V或3.3v電源
  7. //              SCL   接PA5（SCL）
  8. //              SDA   接PA7（SDA）  
  9. //              --------------------
  10. #include "stm32f10x.h"
  11. #include "oled.h"
  12. #include "PID.h"

  14. int main(void)
  15.   {
  16.                 u32 count=0;

  18.                 OLED_Init();                        //初始化OLED  
  19.                 OLED_Clear();
  20.                 PID_init();
  21.         
  22.                 OLED_ShowChar(16,0,'P',16);
  23.                 OLED_ShowChar(24,0,'I',16);
  24.                 OLED_ShowChar(32,0,'D',16);
  25.                 OLED_ShowCHinese(44,0,0);
  26.                 OLED_ShowCHinese(60,0,1);
  27.                 OLED_ShowCHinese(76,0,2);
  28.                 OLED_ShowCHinese(92,0,3);
  29.                
  30.                 OLED_ShowCHinese(0,4,4);
  31.                 OLED_ShowCHinese(16,4,5);
  32.                 OLED_ShowCHinese(32,4,6);
  33.                 OLED_ShowChar(48,4,':',16);
  34.                
  35.                 OLED_ShowCHinese(0,6,7);
  36.                 OLED_ShowCHinese(16,6,8);
  37.                 OLED_ShowCHinese(32,6,9);
  38.                 OLED_ShowChar(48,6,':',16);
  39.                
  40.                 OLED_ShowChar(86,5,'.',12);
  41.                 OLED_ShowChar(86,7,'.',12);
  42.                
  43.                 OLED_ShowNum(56,5,(int)setspeed,5,12);  //顯示設(shè)定值整數(shù)部分
  44.                 OLED_ShowNum(93,5,(int)(setspeed*10)%10,1,12);  //顯示設(shè)定值小數(shù)部分
  45.                 OLED_ShowNum(99,5,(int)(setspeed*100)%10,1,12);
  46.                 OLED_ShowNum(105,5,(int)(setspeed*1000)%10,1,12);
  47.                 OLED_ShowNum(111,5,(int)(setspeed*10000)%10,1,12);
  48.         while(count<1000)
  49.         {
  50.           float Speed = PID_realize(setspeed);
  51.                 OLED_ShowNum(56,7,Speed,5,12);    //顯示當前值整數(shù)部分
  52.                 OLED_ShowNum(93,7,(int)(Speed*10000)%10000,4,12);  //顯示當前值及小數(shù)點后4位
  53.         }
  54. }
復(fù)制代碼


所有資料51hei提供下載:
PID算法測試.7z (184.24 KB, 下載次數(shù): 141)


作者: wsxujn    時間: 2019-8-29 23:56
這個怎么樣，下來看看
作者: afeiaa    時間: 2020-4-16 23:23
感謝樓主 學(xué)習(xí)了



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