位置式PID源代码

位置式PID源代码，本程序来源于网络

1. FUNCTION FC1 : VOID
   
2. 
   
3.     VAR_INPUT
   
4.         Run:BOOL;    //True-运行，False-停止
   
5.         Auto:BOOL;    //True-自动，False-手动
   
6.         ISW:BOOL;    //True-积分有效，False-积分无效
   
7.         DSW:BOOL;    //True-微分有效，False-微分无效
   
8.         SetMV:REAL;    //手动时的开度设定值
   
9.         SVSW:REAL;    //当设定值低于SVSW时，开度为零
   
10.         PV:REAL;    //测量值
    
11.         SV:REAL;    //设定值
    
12.         DeadBand:REAL;    //死区大小
    
13.         PBW:REAL;    //比例带大小
    
14.         IW:REAL;    //积分带大小
    
15.         DW:REAL;    //微分带大小
    
16.         dErr_IN:REAL;    //误差累积
    
17.         LastPV_IN:REAL;    //上一控制周期的测量值
    
18.     END_VAR
    
19. 
    
20.     VAR_OUTPUT
    
21.         MV:REAL;    //输出开度
    
22.         dErr_OUT:REAL;    //误差累积
    
23.         LastPV_OUT:REAL;//上一控制周期的测量值
    
24.     END_VAR
    
25. 
    
26.     VAR
    
27.         Err:REAL;    //误差
    
28.         dErr:REAL;    //误差累积
    
29.         PBH:REAL;    //比例带上限
    
30.         PBL:REAL;    //比例带下限
    
31.         PVC:REAL;    //测量值在一个控制周期内的变化率，即测量值变化速率
    
32.         P:REAL;        //比例项
    
33.         I:REAL;        //积分项
    
34.         D:REAL;        //微分项
    
35.     END_VAR
    
36. 
    
37.     IF Run THEN
    
38.         IF Auto THEN
    
39.             IF SV>=SVSW THEN
    
40.                 Err:=SV-PV;
    
41.                 PBH:=SV+PBW;
    
42.                 PBL:=SV-PBW;
    
43.                 IF PV<PBL THEN
    
44.                     MV:=1;
    
45.                 ELSIF PV>PBH THEN
    
46.                     MV:=0;
    
47.                 ELSE
    
48.                     P:=(PBH-PV)/(PBH-PBL);    //计算比例项
    
49. /////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
    
50. /////////////////////////////////////////////以下为积分项的计算//////////////////////////////////////////////////////////////
    
51.                     IF ISW  THEN
    
52.                         dErr:=dErr_IN;
    
53.                         IF (PV<(SV-DeadBand)) OR (PV>(SV+DeadBand)) THEN
    
54.                             IF (dErr+Err)<(0-IW) THEN
    
55.                                 dErr:=0-IW;
    
56.                             ELSIF (dErr+Err)>IW THEN
    
57.                                 dErr:=IW;
    
58.                             ELSE
    
59.                                 dErr:=dErr+Err;
    
60.                             END_IF;
    
61.                         END_IF;
    
62.                         I:=dErr/IW;
    
63.                         dErr_OUT:=dErr;
    
64.                     ELSE
    
65.                         I:=0;
    
66.                     END_IF;
    
67. /////////////////////////////////////////////以上为积分项的计算//////////////////////////////////////////////////////////////
    
68. /////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
    
69. /////////////////////////////////////////////以下为微分项的计算//////////////////////////////////////////////////////////////
    
70.                     IF DSW=1 THEN
    
71.                         PVC:=LastPV_IN-PV;
    
72.                         D:=PVC/DW;
    
73.                         LastPV_OUT:=PV;
    
74.                     ELSE
    
75.                         D:=0;
    
76.                     END_IF;
    
77. /////////////////////////////////////////////以上为微分项的计算//////////////////////////////////////////////////////////////
    
78. /////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
    
79.                     IF (P+I+D)>1 THEN
    
80.                         MV:=1;
    
81.                     ELSIF (P+I+D)<0 THEN
    
82.                         MV:=0;
    
83.                     ELSE
    
84.                         MV:=P+I+D;
    
85.                     END_IF;
    
86.                 END_IF;
    
87.             ELSE
    
88.                 MV:=0;
    
89.             END_IF;
    
90.         ELSE
    
91.             MV:=SetMV;
    
92.         END_IF;
    
93.     ELSE
    
94.         MV:=0;
    
95.     END_IF;
    
96. 
    
97. END_FUNCTION

复制代码

【必读】版权免责声明

1、本主题所有言论和内容纯属会员个人意见，与本论坛立场无关。2、本站对所发内容真实性、客观性、可用性不做任何保证也不负任何责任，网友之间仅出于学习目的进行交流。3、对提供的数字内容不拥有任何权利，其版权归原著者拥有。请勿将该数字内容进行商业交易、转载等行为，该内容只为学习所提供，使用后发生的一切问题与本站无关。 4、本网站不保证本站提供的下载资源的准确性、安全性和完整性;同时本网站也不承担用户因使用这些下载资源对自己和他人造成任何形式的损失或伤害。 5、本网站所有软件和资料均为网友推荐收集整理而来，仅供学习用途使用，请务必下载后两小时内删除，禁止商用。6、如有侵犯你版权的，请及时联系我们（电子邮箱1370723259@qq.com）指出，本站将立即改正。