Fixed the ScaledPV and ScaledSP clamping issue.

Fork of PID by Aaron Berk

Revision:
1:add8ed7b2590
Parent:
0:6e12a3e5af19