pwm控制的算法实现单元程

在需要保持输出电压稳定的场合中，为了得到稳定、精确的输出，常采用闭环控制，
Dn=（1+△Vn/Vref）*Dn-1
其中△Vn=Vref-Vn,Vref为参考电压，Vn为采样的电压，Dn-1为上一次采样电压所对应的占空比，Dn为此次采样电压应该对应的占空比

为了对该系统进行更好地调节，减小稳态误差，提高系统的动态响应速度.引入比例系数Kp. 。在不同公差带内Kp取不同的值，便于对系统进行更精确地控制。同时为了系统稳定，实现积分调节，第n次的占空比以第n-i次为参考(i=1,2,3,.)，则式(2-B)
可改写成:
Dn=[1+Kp*(△Vn/Vref)]*Dn-i(i=1,2,3,.) （式2-5-2）


用算法实现上面公式的vhd程序应该如何编写，请高手帮帮忙。