pidcalc.m

一个很棒的网络控制系统仿真软件

function data = pidcalc(data, r, y)

P = data.K*(r-y);
I = data.Iold;
D = data.Td/(data.N*data.h+data.Td)*data.Dold+data.N*data.K*data.Td/(data.N*data.h+data.Td)*(data.yold-y); 

data.u = P + I + D;
data.Iold = data.Iold + data.K*data.h/data.Ti*(r-y);
data.Dold = D;
data.yold = y;