Fixed the ScaledPV and ScaledSP clamping issue.

Fork of PID by Aaron Berk