这是pid控制算法,MATLAB用的PUMA560模型。希望用的到