標(biāo)題: STC單片機(jī)關(guān)于PID控制氣壓的算法,led數(shù)據(jù)碼顯示 [打印本頁]
作者: niping321    時(shí)間: 2017-6-14 15:39
標(biāo)題: STC單片機(jī)關(guān)于PID控制氣壓的算法,led數(shù)據(jù)碼顯示
STC單片機(jī)做了一個(gè)關(guān)于PID控制氣壓的算法，led數(shù)據(jù)碼顯示


單片機(jī)源程序如下:

  2. #include "config.h"
  3. #include <math.h>
  4. #define ADC_POWER   0x80            
  5. #define ADC_FLAG    0x10            
  6. #define ADC_START   0x08           
  7. #define ADC_SPEEDLL 0x00         
  8. #define ADC_SPEEDL  0x20           
  9. #define ADC_SPEEDH  0x40         
  10. #define ADC_SPEEDHH 0x60

  12. unsigned char idata RsBuf[MAC_RX_BUF];
  13. unsigned char data guc_RsPoint=0;
  14. //unsigned char xdata Time0L1;
  15. //unsigned char xdata Time0H1;
  16. unsigned char xdata led_step=0;

  18. unsigned char xdata led_show1;
  19. unsigned char xdata led_show2;
  20. unsigned char xdata led_show3;
  21. unsigned char xdata led_show4;
  22. unsigned int xdata Time_Show=0;

  24. unsigned int xdata TimeMotor=0;
  25. unsigned int xdata PwmBitVat=0;
  26. //unsigned short xdata ADC_VAL[3];
  27. //unsigned char xdata ADC_ch=0;

  29. bit led_dian1;
  30. bit led_dian2;
  31. bit led_dian3;
  32. bit led_dian4;
  33. bit RsOver=0;

  35. typedef struct _pid_t
  36. {
  37.         float SetSpeed;//定義設(shè)定值
  38.         float ActualSpeed;//定義實(shí)際值
  39.         float err;//定義偏差值
  40.         float err_last;//定義上一個(gè)偏差值
  41.         float Kp,Ki,Kd;//定義比例、積分、微分系數(shù)
  42.         float voltage;//定義電壓值（控制執(zhí)行器的變量）
  43.         float integral;//定義積分值
  44.         float umax;
  45.         float umin;
  46. } pid_t;



  50. unsigned char code ledTab[10]={0x3f,0x06,0x5b,0x4f,0x66,0x6d,0x7d,0x27,0x7f,0x6f};


  53. void PID_init(pid_t *npid)
  54. {
  55.         npid->SetSpeed=0.0;
  56.         npid->ActualSpeed=0.0;
  57.         npid->err=0.0;
  58.         npid->err_last=0.0;
  59.         npid->voltage=0.0;
  60.         npid->integral=0.0;
  61.         npid->Kp=0.2;
  62.         npid->Ki=0.015;
  63.         npid->Kd=0.2;
  64.        
  65.         npid->umax=127;
  66.         npid->umin=-127;
  67. }

  69. float PID_realize(pid_t *npid ,float speed,float ActualSpeed)
  70. {
  71.         float index;
  72.         npid->SetSpeed=speed;
  73.         npid->ActualSpeed=ActualSpeed;
  74.         npid->err=npid->SetSpeed-npid->ActualSpeed;
  75.         if(npid->voltage>npid->umax)
  76.         {
  77.                 if(abs(npid->err)>200)//變積分過程
  78.                 {
  79.                         index=0.0;
  80.                 }
  81.                 else if(abs(npid->err)<180)
  82.                 {
  83.                         index=1.0;
  84.                         if(npid->err<0)
  85.                         {
  86.                                 npid->integral+=npid->err;
  87.                         }
  88.                 }
  89.                 else
  90.                 {
  91.                         index=(200-abs(npid->err))/20;
  92.                         if(npid->err<0)
  93.                         {
  94.                                 npid->integral+=npid->err;
  95.                         }
  96.                 }
  97.         }
  98.         else if(npid->voltage<npid->umin)
  99.         {
  100.                 if(abs(npid->err)>200)//變積分過程
  101.                 {
  102.                         index=0.0;
  103.                 }
  104.                 else if(abs(npid->err)<180)
  105.                 {
  106.                         index=1.0;
  107.                         if(npid->err>0)
  108.                         {
  109.                                 npid->integral+=npid->err;
  110.                         }
  111.                 }
  112.                 else
  113.                 {
  114.                         index=(200-abs(npid->err))/20;
  115.                         if(npid->err>0)
  116.                         {
  117.                                 npid->integral+=npid->err;
  118.                         }
  119.                 }
  120.         }
  121.         else
  122.         {
  123.                 if(abs(npid->err)>200)//變積分過程
  124.                 {
  125.                         index=0.0;
  126.                 }
  127.                 else if(abs(npid->err)<180)
  128.                 {
  129.                         index=1.0;
  130.                         npid->integral+=npid->err;
  131.                 }
  132.                 else
  133.                 {
  134.                         index=(200-abs(npid->err))/20;
  135.                         npid->integral+=npid->err;
  136.                 }
  137.         }
  138.         npid->voltage=npid->Kp*npid->err+index*npid->Ki*npid->integral+npid->Kd*(npid->err-npid->err_last);
  139.         npid->err_last=npid->err;
  140.         return npid->voltage;
  141. }


  144. void Delay_n_ms(unsigned int dly)
  145. {
  146.         unsigned int        j;
  147.         do
  148.         {
  149.                 j = MAIN_Fosc / 13000;        //延時(shí)1ms, 主程序在此節(jié)拍下運(yùn)行
  150.                 while(--j)        ;
  151.         }while(--dly);
  152. }
  153. void InitUart(void)
  154. {
  155.         SCON = 0x50;//工作在串口模式
  156.         T2L = (65536 - (MAIN_Fosc/4/BAUD)); //設(shè)置波特率為重新裝值
  157.         T2H = (65536 - (MAIN_Fosc/4/BAUD))>>8;
  158.         AUXR |= 0x14; //啟用定時(shí)器T2為1T模式, 并啟用定時(shí)器2
  159.         AUXR |= 0x01; //選擇定時(shí)器2為串口1的波特率發(fā)生器
  160.         ES = 1; //使能串口1為中斷
  161. }
  162. void InitTime0(void)
  163. {
  164. //        #if 0
  165. //        AUXR |=  (1<<7);        // Timer0 set as 1T mode
  166. //        TMOD = 0x01; //16位，
  167. //        //Timer0_16bit();
  168. //        Time0L1=(65536-(MAIN_Fosc/1000000)*(TIME0_us1))%256;
  169. //        Time0H1=(65536-(MAIN_Fosc/1000000)*(TIME0_us1))/256;
  170. //        TL0=Time0L1;
  171. //        TH0=Time0H1;
  172. //        #endif
  173.         T0_Load_us_12T(TIME0_us1);
  174.         ET0 = 1;                //Timer0 Interrupt Enable
  175.         PT0 = 1;                //高優(yōu)先級
  176.         TR0 = 1;                //Timer0 Run
  177. }
  178. // ADC初始化函數(shù)
  179. void ADC_Init(void)
  180. {
  181. //        ADC_ch=0;
  182. //        P1ASF=0x30;//設(shè)置P1為ADC
  183. //        //P1ASF|=(1<<4)|(1<<5);
  184. //        ADC_RES=0; // 清除結(jié)果寄存器
  185. //        ADC_CONTR=ADC_POWER|ADC_SPEEDLL|ADC_START|4;
  186. //        Delay_n_ms(20);
  187. //        EADC=1;// EADC=1 允許ADC中斷
  188.        
  189. //查詢方式
  190.         P1ASF=0x30;//設(shè)置P1為ADC
  191.         ADC_RES=0;
  192.         ADC_RESL=0;
  193.         ADC_CONTR=ADC_POWER|ADC_SPEEDLL;
  194.         Delay_n_ms(20);
  195. }

  197. void SendTxdBuf(unsigned char ASC)                                                        //發(fā)送-個(gè)ASCII
  198. {
  199.         ES     =   0;  //關(guān)閉串口中斷
  200.         SBUF   =   ASC;
  201.         while(TI ==0); //
  202.         TI     =   0;  //
  203.         ES     =   1;  //允許串口中斷
  204. }
  205. void Rs_Do(void) interrupt 4 using 1                                                                 //  通訊中斷接收程序
  206. {
  207.         unsigned char data luc_temp;
  208.         if(RI==1)
  209.         {
  210.                 RI=0;
  211.                 luc_temp = SBUF;
  212.                 if(guc_RsPoint>=MAC_RX_BUF)
  213.                         guc_RsPoint=0;       
  214.                 if(luc_temp==0x0d)
  215.                 {
  216.                         RsBuf[guc_RsPoint] = 0x0d;
  217.                         guc_RsPoint = 0;
  218.                         RsOver = 1;
  219.                 }
  220.                 else
  221.                 {
  222.                         RsBuf[guc_RsPoint++]=luc_temp;
  223.                 }
  224.         }
  225. }


  228. void ledTime()
  229. {
  230.         switch(led_step)
  231.         {
  232.                 case 0:
  233.                         DIG1=1;
  234.                         DIG2=0;
  235.                         DIG3=0;
  236.                         DIG4=0;
  237.                         P2=ledTab[led_show1];
  238.                         led_di=led_dian1;
  239.                         led_step=1;
  240.                         break;
  241.                 case 1:
  242.                         DIG1=0;
  243.                         DIG2=1;
  244.                         DIG3=0;
  245.                         DIG4=0;
  246.                         P2=ledTab[led_show2];
  247.                         led_di=led_dian2;
  248.                         led_step=2;
  249.                         break;
  250.                 case 2:
  251.                         DIG1=0;
  252.                         DIG2=0;
  253.                         DIG3=1;
  254.                         DIG4=0;
  255.                         P2=ledTab[led_show3];
  256.                         led_di=led_dian3;
  257.                         led_step=3;
  258.                         break;
  259.                 case 3:
  260.                         DIG1=0;
  261.                         DIG2=0;
  262.                         DIG3=0;
  263.                         DIG4=1;
  264.                         P2=ledTab[led_show4];
  265.                         led_di=led_dian4;
  266.                         led_step=0;
  267.                         break;
  268.         }
  269. }

  271. void Time0Interrupt(void) interrupt 1 using 3
  272. {
  273.         //TR0=0;
  274.         ledTime();
  275.         if(Time_Show>0)
  276.                 Time_Show--;
  277.        
  278.         if(PwmBitVat>TimeMotor)
  279.         {
  280.                 MOTOR1=1;
  281.         }
  282.         else
  283.         {
  284.                 MOTOR1=0;//低電平打開電機(jī)
  285.         }
  286.         if(PwmBitVat++>256)
  287.         {
  288.                 PwmBitVat=0;
  289.         }
  290.         //TL0=Time0L1;
  291.         //TH0=Time0H1;
  292.         //TR0=1;
  293. }

  295. //void ADC_ISR() interrupt 5
  296. //{
  297. //        ADC_CONTR &= ~ADC_FLAG;
  298. //        switch(ADC_ch)
  299. //        {
  300. //                case 0:
  301. //                        ADC_ch=1;
  302. //                        ADC_VAL[0]=(ADC_RES<<2)|(ADC_RESL&0x03);
  303. //               
  304. //                        ADC_CONTR = ADC_POWER | ADC_SPEEDLL | 5 | ADC_START;
  305. //                break;
  306. //                case 1:
  307. //                        ADC_ch=0;
  308. //                        ADC_VAL[1]=(ADC_RES<<2)|(ADC_RESL&0x03);
  309. //               
  310. //                        ADC_CONTR = ADC_POWER | ADC_SPEEDLL | 4 | ADC_START;
  311. //                break;
  312. //        }
  313. //}

  315. void led_showP(float fshowPa)
  316. {
  317.         static float tmp_showPa=-1;
  318.         float tmp_show=fshowPa;
  319.         float temp_dian;
  320.         unsigned char shorteger,shordian;
  321.         if(fshowPa==tmp_showPa)
  322.                 return;
  323.         tmp_showPa=fshowPa;
  324.        
  325.         shorteger=(unsigned char)abs((int)fshowPa);
  326.         temp_dian=tmp_show-(float)shorteger;
  327.        
  328.         led_show1=shorteger/10;
  329.         led_show2=shorteger%10;
  330.         led_dian1=0;
  331.         led_dian2=1;
  332.        
  333.         //小數(shù)點(diǎn)后兩位
  334.         shordian=(unsigned char)(temp_dian*100.0);
  335.         led_show3=shordian/10;
  336.         led_show4=shordian%10;
  337.         led_dian3=0;
  338.         led_dian4=0;
  339. }

  341. unsigned short GetADCResult(unsigned char ch)
  342. {
  343.         ADC_CONTR = ADC_POWER | ADC_SPEEDLL | ch | ADC_START;
  344.         while(!(ADC_CONTR&ADC_FLAG));
  345.         ADC_CONTR &= ~ADC_FLAG;
  346.        
  347.         return (ADC_RES<<2)|(ADC_RESL&0x03);
  348. }

  350. //-20-0 0.5=4.5(102.4-921.6)
  351. void main(void)
  352. {
  353.         unsigned short xdata sensorV;
  354.         unsigned short xdata RtV;
  355.         unsigned char xdata TimeShowRt=0;
  356.         float xdata Actual;
  357.         float xdata tmp_TimeMotor;
  358.         float xdata SetSpeed;
  359.         char xdata tmp_SetSpeed=-128;
  360.         float xdata getSpeed;
  361.         pid_t xdata gpid;
  362.         //GPIO1
  363.         PP1(0);//輸出
  364.         PP1(1);//輸出
  365.         PP1(2);//輸出
  366.         PP1(3);//輸出
  367.         RP1(4);//輸入
  368.         RP1(5);//輸入
  369.         //GPIO2
  370.         PP2(0);//輸出
  371.         PP2(1);//輸出
  372.         PP2(2);//輸出
  373.         PP2(3);//輸出
  374.         PP2(4);//輸出
  375.         PP2(5);//輸出
  376.         PP2(6);//輸出
  377.         PP2(7);//輸出
  378.         //GPIO3
  379.         PP3(2);//輸出
  380.         PP3(3);//輸出
  381.         PP3(4);//輸出
  382.         PP3(5);//輸出
  383.         RP3(6);//輸入
  384.         PP3(7);//輸出
  385.         InitUart();
  386.         InitTime0();
  387.         ADC_Init();
  388.         EA = 1;                // 打開總中斷
  389.         SendTxdBuf(0x89);
  390.         RtV=GetADCResult(4);
  391.         SetSpeed=0.019531*RtV-20.0;
  392.         tmp_SetSpeed=(char)SetSpeed;
  393.         PID_init(&gpid);
  394.         gpid.Kp=0.4;//作用是加快系統(tǒng)的響應(yīng)速度，提高系統(tǒng)的調(diào)節(jié)精度，副作用是會導(dǎo)致超調(diào);
  395.         gpid.Ki=0.2;//作用是消除穩(wěn)態(tài)誤差，副作用是導(dǎo)致積分飽和現(xiàn)象
  396.         gpid.Kd=0.2;//作用是改善系統(tǒng)的動態(tài)性能，副作用是延長系統(tǒng)的調(diào)節(jié)時(shí)間

  398. ……………………

  400. …………限于本文篇幅 余下代碼請從51黑下載附件…………
復(fù)制代碼

所有資料51hei提供下載:
軟件.rar (112.24 KB, 下載次數(shù): 71)



作者: 10149151    時(shí)間: 2023-10-10 22:55
學(xué)習(xí)pid



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