Integral state augmentation

Adds integrator states or disturbance estimates to remove steady-state errors.