C实现PID控制算法文档格式.docx
- 文档编号:17215708
- 上传时间:2022-11-29
- 格式:DOCX
- 页数:122
- 大小:186.97KB
C实现PID控制算法文档格式.docx
《C实现PID控制算法文档格式.docx》由会员分享,可在线阅读,更多相关《C实现PID控制算法文档格式.docx(122页珍藏版)》请在冰豆网上搜索。
floaterr_last;
//定义上一个偏差值
floatKp,Ki,Kd;
//定义比例、积分、微分系数
floatvoltage;
//定义电压值(控制执行器的变量)
floatintegral;
//定义积分值
}pid;
控制算法中所需要用到的参数在一个结构体中统一定义,方便后面的使用。
第二部:
初始化变量,代码如下:
voidPID_init(){
printf("
PID_initbegin\n"
);
pid.SetSpeed=0.0;
pid.ActualSpeed=0.0;
pid.err=0.0;
pid.err_last=0.0;
pid.voltage=0.0;
pid.integral=0.0;
pid.Kp=0.2;
pid.Ki=0.015;
pid.Kd=0.2;
PID_initend\n"
}
统一初始化变量,尤其是Kp,Ki,Kd三个参数,调试过程当中,对于要求的控制效果,可以通过调节这三个量直接进行调节。
第三步:
编写控制算法,代码如下:
floatPID_realize(floatspeed){
pid.SetSpeed=speed;
pid.err=pid.SetSpeed-pid.ActualSpeed;
pid.integral+=pid.err;
pid.voltage=pid.Kp*pid.err+pid.Ki*pid.integral+pid.Kd*(pid.err-pid.err_last);
pid.err_last=pid.err;
pid.ActualSpeed=pid.voltage*1.0;
returnpid.ActualSpeed;
注意:
这里用了最基本的算法实现形式,没有考虑死区问题,没有设定上下限,只是对公式的一种直接的实现,后面的介绍当中还会逐渐的对此改进。
到此为止,PID的基本实现部分就初步完成了。
下面是测试代码:
intmain(){
printf("
Systembegin\n"
PID_init();
intcount=0;
while(count<
1000)
{
floatspeed=PID_realize(200.0);
%f\n"
speed);
count++;
}
return0;
下面是经过1000次的调节后输出的1000个数据(具体的参数整定过程就不说明了,网上这种说明非常多):
83.000001
11.555000
59.559675
28.175408
52.907421
38.944152
51.891699
46.141651
53.339054
51.509998
55.908450
55.944631
58.970680
59.882936
62.225001
63.537254
65.527707
67.011058
68.810646
70.355318
72.042040
73.595658
75.207620
76.745444
78.301526
79.812136
81.321929
82.800304
84.268909
85.713108
87.143455
88.553005
89.946960
91.322078
92.680996
94.022234
95.347186
96.655242
97.947180
99.222808
100.482601
101.726572
102.955049
104.168125
105.366066
106.549019
107.717187
108.870756
110.009898
111.134811
112.245652
113.342615
114.425860
115.495564
116.551897
117.595029
118.625116
119.642331
120.646826
121.638767
122.618307
123.585603
124.540813
125.484079
126.415549
127.335383
128.243715
129.140691
130.026459
130.901149
131.764909
132.617870
133.460162
134.291942
135.113308
135.924419
136.725382
137.516332
138.297401
139.068697
139.830352
140.582499
141.325237
142.058701
142.782985
143.498218
144.204509
144.901969
145.590726
146.270843
146.942486
147.605718
148.260674
148.907425
149.546109
150.176794
150.799612
151.414626
152.021959
152.621696
153.213951
153.798781
154.376315
154.946626
155.509812
156.065958
156.615146
157.157471
157.693012
158.221871
158.744097
159.259826
159.769078
160.271991
160.768588
161.258996
161.743264
162.221494
162.693737
163.160075
163.620593
164.075347
164.524422
164.967877
165.405795
165.838235
166.265257
166.686967
167.103377
167.514610
167.920681
168.321682
168.717670
169.108719
169.494862
169.876198
170.252740
170.624605
170.991799
171.354406
171.712487
172.066080
172.415265
172.760077
173.100594
173.436838
173.768895
174.096796
174.420594
174.740352
175.056096
175.367915
175.675818
175.979886
176.280136
176.576656
176.869444
177.158600
177.444121
177.726087
178.004510
178.279458
178.550967
178.819094
179.083860
179.345315
179.603504
179.858466
180.110241
180.358866
180.604388
180.846849
181.086262
181.322699
181.556172
181.786733
182.014396
182.239222
182.461226
182.680475
182.896971
183.110768
183.321881
183.530369
183.736239
183.939545
184.140301
184.338555
184.534321
184.727651
184.918558
185.107080
185.293243
185.477080
185.658625
185.837886
186.014930
186.189745
186.362382
186.532859
186.701207
186.867437
187.031605
187.193713
187.353802
187.511884
187.667997
187.822151
187.974384
188.124700
188.273148
188.419728
188.564488
188.707429
188.848592
188.987995
189.125644
189.261576
189.395801
189.528364
189.659258
189.788528
189.916170
190.042233
190.166702
190.289633
190.411007
190.530867
190.649236
190.766119
190.881544
190.995531
191.108087
191.219243
191.329005
191.437382
191.544428
191.650111
191.754504
191.857565
191.959350
192.059857
192.159119
192.257135
192.353919
192.449511
192.543890
192.637105
192.729137
192.820032
192.909776
192.998410
193.085920
193.172360
193.257700
193.341993
193.425214
193.507408
193.588568
193.668715
193.747847
193.826004
193.903175
193.979391
194.054643
194.128963
194.202349
194.274828
194.346393
194.417073
194.486854
194.555777
194.623820
194.691027
194.757390
194.822919
194.887626
194.951536
195.014633
195.076965
195.138496
195.199273
195.259270
195.318547
195.377060
195.434856
195.491918
195.548283
195.603919
195.658886
195.713145
195.766734
195.819654
195.871912
195.923517
195.974472
196.024791
196.074478
196.123558
196.172016
196.219859
196.267115
196.313778
196.359851
196.405363
196.450296
196.494672
196.538492
196.581753
196.624494
196.666678
196.708363
196.749493
196.790138
196.830267
196.869889
196.909019
196.947656
196.985803
197.023493
197.060701
197.097449
197.133733
197.169558
197.204940
197.239872
197.274378
197.308436
197.342089
197.375309
197.408125
197.440523
197.472520
197.504114
197.535309
197.566127
197.596546
197.626594
197.656258
197.685546
197.714486
197.743047
197.771265
197.799113
197.826629
197.853799
197.880631
197.907131
197.933284
197.959122
197.984629
198.009823
198.034705
198.059275
198.083520
198.107481
198.131129
198.154493
198.177566
198.200349
198.222843
198.245062
198.267001
198.288662
198.310059
198.331178
198.352049
198.372645
198.392982
198.413066
198.432911
198.452499
198.471846
198.490953
198.509819
198.528439
198.546842
198.565003
198.582945
198.600648
198.618147
198.635415
198.652474
198.669313
198.685955
198.702378
198.718611
198.734625
198.750448
198.766067
198.781497
198.796736
198.811776
198.826628
198.841303
198.855788
198.870087
198.884218
198.898162
198.911943
198.925538
198.938970
198.952229
198.965320
198.978257
198.991033
199.003643
199.016092
199.028390
199.040542
199.052536
199.064373
199.076067
199.087617
199.099019
199.110280
199.121407
199.132381
199.143240
199.153940
199.164511
199.174957
199.185270
199.195457
199.205514
199.215440
199.225262
199.234930
199.244503
199.253928
199.263275
199.272468
199.281571
199.290541
199.299421
199.308165
199.316815
199.325345
199.333789
199.342115
199.350336
199.358462
199.366479
199.374396
199.382228
199.389943
199.397586
199.405110
199.412555
199.419891
199.427152
199.434307
199.441389
199.448363
199.455264
199.462073
199.468802
199.475442
199.481995
199.488475
199.494857
199.501183
199.507404
199.513578
199.519639
199.525656
199.531579
199.537437
199.543230
199.548936
199.554583
199.560149
199.565647
199.571073
199.576436
199.581730
199.586961
199.592118
199.597220
199.602260
199.607218
199.612132
199.616974
199.621764
199.626486
199.631156
199.635757
199.640316
199.644808
199.649249
199.653636
199.657959
199.662246
199.666457
199.670635
199.674752
199.678815
199.682833
199.686798
199.690715
199.694583
199.698409
199.702177
199.705905
199.709582
199.713209
199.716788
199.720339
199.723826
199.727276
199.730690
199.734054
199.737378
199.740657
199.743901
199.747111
199.750260
199.753393
199.756474
199.759526
199.762524
199.765490
199.768422
199.771314
199.774169
199.77
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 实现 PID 控制 算法