|
|
actual=0;%实际值
4 p2 S+ B% A7 v3 wlasterr=0;%上一个偏差值\/ k0 v( \: N, J# `
integral=0;%累计偏差
' I0 p, [% U5 T1 _kp=1;%比例系数
% K2 E( }9 u0 F) m Mki=0.1;%积分系数3 ^% J; _) x. ` i
kd=0.01;%微分系数8 `% F6 Y8 z* w, c: q" J
for count=1:1:200%采样两百次
5 W4 e. o a( W& _# G( s2 M, g* a9 X$ b set=45;%设定值45' D y4 \/ A* W$ O4 O8 i, A
err=set-actual;%偏差值7 a3 y/ u+ {) O/ _6 [# D; P6 M% R
u(count)=kp*err+ki*integral+kd*(err-lasterr);
' o j& n9 ]+ T; S integral=integral+err;%累计误差
7 g/ m/ T# [, O) G$ A, D2 ? lasterr=err;. X( } h5 b5 G
end
$ E& n' u8 j1 _% P; K2 F" Q- v& w4 x3 pcount=1:1:200;5 h% K. b4 X5 Y: }$ R* R* u
plot(count,u) |
|