|
|
actual=0;%实际值
6 u* J/ ^7 }% g( G" Llasterr=0;%上一个偏差值\
5 R0 H8 e9 r3 V. `* u; Zintegral=0;%累计偏差
7 h$ g' F3 V. v' u# i% Ykp=1;%比例系数
6 T' f. o: I T8 I, E" S6 zki=0.1;%积分系数
+ Z; W+ Z1 \" N- I8 `kd=0.01;%微分系数
' _) k3 s7 {( I/ l" c' Xfor count=1:1:200%采样两百次2 l- U# `( E# G( \& \+ w" `& w
set=45;%设定值45. t9 J( M: A/ q+ ?3 o7 }
err=set-actual;%偏差值1 @" c: G1 r9 j0 a; K. l
u(count)=kp*err+ki*integral+kd*(err-lasterr);
" `; R3 _0 y$ l" Y6 K& \1 e integral=integral+err;%累计误差
# r0 a& v' \6 O- S, M% s, |! A lasterr=err;. q3 b# ?$ [" t8 `( h5 m
end
/ W! O# G# m3 Z$ |0 D, [count=1:1:200;
5 ]! F5 ?& \" {5 R8 kplot(count,u) |
|