PID Control algorithm(to control PWM Duty Cycle based on Current)

[efoote868]

You might want to consider using a feedback loop instead of strictly PID.

Think of it this way - when the error drops to zero, you don't want to set your Duty Cycle to zero, you want to keep it exactly the same.

New Duty Cycle = Old Duty Cycle + Error * Constant.