Re: PID code questions
 

There's a simple solution:
Double-integrate the difference between the previous error and the current error, then (optionally) divide by time. And as for the reset, the I value should be reset at the same time as the time counter.