TMS320F28377D: 基于28377D的并网逆变中，比例谐振PR控制器的问题

最近在做逆变并网，第一次做出于安全考虑，我先把电网用电感电阻代替，我用信号发生器给电压相位信号，输出端接电阻和电感，然后看电流相位和信号电压相位来判断有没有成功，但是现在输出电流和仿真里的快差不多了，但是电流相位却一直在变化，始终无法和电压参考相位同相。锁相环验证过了没有问题，电流采样也没有问题，所以在想是不是PR控制除了问题，对了输出电流大小也无法调节，就感觉给定的电流完全没起作用，附PR控制器函数

有没有大佬可以帮忙看下是不是PR离散转化成代码时出了问题呢。